|
8 | 8 | % total mass of the system is represented by the non-dimensional |
9 | 9 | % constant $\mu$. The reference frame of the system is fixed to the |
10 | 10 | % rotationg frame of the two objects, meaning that the objects have |
11 | | - % fixed constant positions of $(\mu,0,0)^T$ for the first object, and |
12 | | - % $(1 - \mu,0,0)^T$ for the second object. The evolution of the third |
| 11 | + % fixed constant positions of $[-\mu, 0, 0]^T$ for the first object, and |
| 12 | + % $[1 - \mu, 0, 0]^T$ for the second object. The evolution of the third |
13 | 13 | % object of negligent mass is given by the following second-order |
14 | 14 | % non-dimensionalized differential equation: |
15 | 15 | % |
|
19 | 19 | % z'' &= \frac{\partial U}{\partial z}, |
20 | 20 | % $$ |
21 | 21 | % |
22 | | - % where |
| 22 | + % where the energy and distances are defined as, |
23 | 23 | % |
24 | 24 | % $$ |
25 | | - % U &= \frac{1}{2} (x^2 + y^2) + \frac{1 - \mu}{d} + \frac{mu}{r},\\ |
| 25 | + % U &= \frac{1}{2} (x^2 + y^2) + \frac{1 - \mu}{d} + \frac{\mu}{r},\\ |
26 | 26 | % d &= \sqrt{(x + \mu)^2 + y^2 + z^2},\\ |
27 | 27 | % r &= \sqrt{(x - 1 + \mu)^2 + y^2 + z^2}, |
28 | 28 | % $$ |
29 | 29 | % |
30 | | - % and where the system is converted to a differential equation in six |
31 | | - % variables in the standard fashion. The distances $d$ and $r$ can |
32 | | - % cause numerical instability as they approach zero, thus a softening |
33 | | - % factor of $s^2$ is typically added under both of the square-roots. |
| 30 | + % and where the system is converted to a first order differential |
| 31 | + % equation in six variables in the standard fashion as, |
| 32 | + % |
| 33 | + % $$ |
| 34 | + % x' = v_x,\\ |
| 35 | + % y' = v_y,\\ |
| 36 | + % z' = v_z,\\ |
| 37 | + % v_x' = x'',\\ |
| 38 | + % v_y' = y'',\\ |
| 39 | + % v_z' = z'', |
| 40 | + % $$ |
| 41 | + % |
| 42 | + % where the new variables $v_x$, $v_y$, and $v_z$ represent the |
| 43 | + % velocity vector. |
| 44 | + % |
| 45 | + % The distances $d$ and $r$ can cause numerical instability as they |
| 46 | + % approach zero, thus a softening factor of $s^2$ is typically added |
| 47 | + % under both of the square-roots of the distances $d$ and $r$. |
34 | 48 | % |
35 | 49 | % When the object under consideration is on an orbit that is co-planar |
36 | 50 | % to the orbit of the two other objects, then the system of equations |
|
40 | 54 | % constant of the system, |
41 | 55 | % |
42 | 56 | % $$ |
43 | | - % J = 2U - x'^2 - y'^2 - z'^2, |
| 57 | + % J = 2U - v_x^2 - v_y^2 - v_z^2, |
44 | 58 | % $$ |
45 | 59 | % |
46 | 60 | % is preserved throughout the evolution of the equations, though this |
47 | | - % is typically not true numerically. |
| 61 | + % is typically not true numerically. The Jacobi constant is provided as |
| 62 | + % a function. |
| 63 | + % |
| 64 | + % For state estimation purposes a radar measurement is also provided, |
| 65 | + % |
| 66 | + % $$ |
| 67 | + % h(x, y, z, v_x, v_y, v_z) = \begin{bmatrix} |
| 68 | + % \sqrt{(x - s_x)^2 + (y - s_y)^2 + (z - s_z)^2}\\ |
| 69 | + % \frac{(x - s_x) \cdot v_x + (y - s_y) \cdot v_y + (z - s_z) \cdot v_z} |
| 70 | + % {\sqrt{(x - s_x)^2 + (y - s_y)^2 + (z - s_z)^2}}\\ |
| 71 | + % \tan^{-1} \frac{y}{x + \mu}\\ |
| 72 | + % \tan^{-1} \frac{z}{\sqrt{(x - s_x)^2 + (y - s_y)^2 + (z - s_z)^2}} |
| 73 | + % \end{bmatrix} |
| 74 | + % $$ |
| 75 | + % |
| 76 | + % where $s_x$, $s_y$, and $s_z$ are the locations of the radar sensor, |
| 77 | + % the first term is the range to the object from the sensor, the second |
| 78 | + % term is the rate of change of the range (range-rate), and the third |
| 79 | + % and fourth terms are the two angles the radar must be pointing. In |
| 80 | + % the planar case, the fourth term is absent. |
48 | 81 | % |
49 | 82 | % Notes |
50 | 83 | % ----- |
|
0 commit comments