79 lines
5.5 KiB
Plaintext
79 lines
5.5 KiB
Plaintext
|
<!DOCTYPE html>
|
||
|
|
<html lang="en">
|
||
|
|
<head>
|
||
|
|
<meta charset="UTF-8">
|
||
|
|
<meta name="generator" content="TempleOS V5.03">
|
||
|
|
<meta name="viewport" content="width=device-width">
|
||
|
|
<link rel="stylesheet" href="/style/templeos.css">
|
||
|
|
<script src="/script/templeos.js"></script>
|
||
|
|
<style type="text/css">
|
||
|
|
.cF0{color:#000000;background-color:#ffffff;}
|
||
|
|
.cF1{color:#0000aa;background-color:#ffffff;}
|
||
|
|
.cF2{color:#00aa00;background-color:#ffffff;}
|
||
|
|
.cF3{color:#00aaaa;background-color:#ffffff;}
|
||
|
|
.cF4{color:#aa0000;background-color:#ffffff;}
|
||
|
|
.cF5{color:#aa00aa;background-color:#ffffff;}
|
||
|
|
.cF6{color:#aa5500;background-color:#ffffff;}
|
||
|
|
.cF7{color:#aaaaaa;background-color:#ffffff;}
|
||
|
|
.cF8{color:#555555;background-color:#ffffff;}
|
||
|
|
.cF9{color:#5555ff;background-color:#ffffff;}
|
||
|
|
.cFA{color:#55ff55;background-color:#ffffff;}
|
||
|
|
.cFB{color:#55ffff;background-color:#ffffff;}
|
||
|
|
.cFC{color:#ff5555;background-color:#ffffff;}
|
||
|
|
.cFD{color:#ff55ff;background-color:#ffffff;}
|
||
|
|
.cFE{color:#ffff55;background-color:#ffffff;}
|
||
|
|
.cFF{color:#ffffff;background-color:#ffffff;}
|
||
|
|
</style>
|
||
|
|
</head>
|
||
|
|
<body>
|
||
|
|
<pre id="content">
|
||
|
|
<a name="l1"></a><span class=cF1>U0</span><span class=cF0> MyDerivative(</span><span class=cF9>CMathODE</span><span class=cF0> *ode,</span><span class=cF1>F64</span><span class=cF0>,</span><span class=cF9>COrder2D3</span><span class=cF0> *,</span><span class=cF9>COrder2D3</span><span class=cF0> *)
|
||
|
|
<a name="l2"></a>{
|
||
|
|
<a name="l3"></a></span><span class=cF2>//The forces due to springs and drag are</span><span class=cF0>
|
||
|
|
<a name="l4"></a> </span><span class=cF2>//automatically handled by the</span><span class=cF0>
|
||
|
|
<a name="l5"></a> </span><span class=cF2>//ode code. We can add new forces</span><span class=cF0>
|
||
|
|
<a name="l6"></a> </span><span class=cF2>//here.</span><span class=cF0>
|
||
|
|
<a name="l7"></a> </span><span class=cF9>CTask</span><span class=cF0> *task=ode->win_task;
|
||
|
|
<a name="l8"></a> </span><span class=cF1>F64</span><span class=cF0> d,dd;
|
||
|
|
<a name="l9"></a> </span><span class=cF9>CD3</span><span class=cF0> p,p2;
|
||
|
|
<a name="l10"></a> MyMass *tmpm1,*tmpm2;
|
||
|
|
<a name="l11"></a>
|
||
|
|
<a name="l12"></a> </span><span class=cF2>//Collisions</span><span class=cF0>
|
||
|
|
<a name="l13"></a> tmpm1=ode->next_mass;
|
||
|
|
<a name="l14"></a> </span><span class=cF1>while</span><span class=cF0> (tmpm1!=&ode->next_mass) </span><span class=cF7>{</span><span class=cF0>
|
||
|
|
<a name="l15"></a> tmpm2=tmpm1->next;
|
||
|
|
<a name="l16"></a> </span><span class=cF1>while</span><span class=cF0> (tmpm2!=&ode->next_mass) {
|
||
|
|
<a name="l17"></a> </span><span class=cF5>D3Sub</span><span class=cF0>(&p,&tmpm2->state->x,&tmpm1->state->x);
|
||
|
|
<a name="l18"></a> dd=</span><span class=cF5>D3NormSqr</span><span class=cF0>(&p);
|
||
|
|
<a name="l19"></a> </span><span class=cF1>if</span><span class=cF0> (dd<=</span><span class=cF5>Sqr</span><span class=cF7>(</span><span class=cF0>tmpm1->radius+tmpm2->radius</span><span class=cF7>)</span><span class=cF0>) </span><span class=cF7>{</span><span class=cF0>
|
||
|
|
<a name="l20"></a> d=</span><span class=cF5>Sqrt</span><span class=cF0>(dd)+0.0001;
|
||
|
|
<a name="l21"></a> dd=10.0*</span><span class=cF5>Sqr</span><span class=cF0>(</span><span class=cF5>Sqr</span><span class=cF7>(</span><span class=cF5>Sqr</span><span class=cF0>(tmpm1->radius+tmpm2->radius)-dd</span><span class=cF7>)</span><span class=cF0>);
|
||
|
|
<a name="l22"></a> </span><span class=cF5>D3MulEqu</span><span class=cF0>(&p,dd/d);
|
||
|
|
<a name="l23"></a> </span><span class=cF5>D3AddEqu</span><span class=cF0>(&tmpm2->DstateDt->DxDt,&p);
|
||
|
|
<a name="l24"></a> </span><span class=cF5>D3SubEqu</span><span class=cF0>(&tmpm1->DstateDt->DxDt,&p);
|
||
|
|
<a name="l25"></a> </span><span class=cF7>}</span><span class=cF0>
|
||
|
|
<a name="l26"></a> tmpm2=tmpm2->next;
|
||
|
|
<a name="l27"></a> }
|
||
|
|
<a name="l28"></a> tmpm1=tmpm1->next;
|
||
|
|
<a name="l29"></a> </span><span class=cF7>}</span><span class=cF0>
|
||
|
|
<a name="l30"></a>
|
||
|
|
<a name="l31"></a> tmpm1=ode->next_mass;
|
||
|
|
<a name="l32"></a> </span><span class=cF1>while</span><span class=cF0> (tmpm1!=&ode->next_mass) </span><span class=cF7>{</span><span class=cF0>
|
||
|
|
<a name="l33"></a> </span><span class=cF1>if</span><span class=cF0> (!</span><span class=cF7>(</span><span class=cF0>tmpm1->flags&</span><span class=cF3>MSF_FIXED</span><span class=cF7>)</span><span class=cF0>)
|
||
|
|
<a name="l34"></a> tmpm1->DstateDt->DyDt+=10.0*tmpm1->mass; </span><span class=cF2>//Gravity</span><span class=cF0>
|
||
|
|
<a name="l35"></a> tmpm1=tmpm1->next;
|
||
|
|
<a name="l36"></a> </span><span class=cF7>}</span><span class=cF0>
|
||
|
|
<a name="l37"></a>
|
||
|
|
<a name="l38"></a> </span><span class=cF1>if</span><span class=cF0> (cursor_mass) </span><span class=cF7>{</span><span class=cF0>
|
||
|
|
<a name="l39"></a> p2.x=</span><span class=cFB>ms</span><span class=cF0>.pos.x-task->pix_left-task->scroll_x;
|
||
|
|
<a name="l40"></a> p2.y=</span><span class=cFB>ms</span><span class=cF0>.pos.y-task->pix_top-task->scroll_y;
|
||
|
|
<a name="l41"></a> p2.z=0;
|
||
|
|
<a name="l42"></a> </span><span class=cF5>D3Sub</span><span class=cF0>(&p,&p2,&cursor_mass->state->x);
|
||
|
|
<a name="l43"></a> d=10.0*</span><span class=cF5>D3NormSqr</span><span class=cF0>(&p);
|
||
|
|
<a name="l44"></a> </span><span class=cF5>D3MulEqu</span><span class=cF0>(&p,d);
|
||
|
|
<a name="l45"></a> </span><span class=cF5>D3AddEqu</span><span class=cF0>(&cursor_mass->DstateDt->DxDt,&p);
|
||
|
|
<a name="l46"></a> </span><span class=cF7>}</span><span class=cF0>
|
||
|
|
<a name="l47"></a>}
|
||
|
|
</span></pre></body>
|
||
|
|
</html>
|