10 VEHICLE INERTIAL DYNAMICS 73 10 VEHICLE INERTIAL DYNAMICS We consider the rigid body dynamics with a coordinate system affixed on the body. We will develop equations useful for the simulation of vehicles, as well as for understanding the signals measured by an inertial measurement unit (IMU). A common frame for boats, submarines, aircraft, terrestrial wheeled and other vehicles has the body-referenced x-axis forward, y-axis to port (left), and z-axis up. This will be the sense of our body-referenced coordinate system here. 10.1 Momentum of a Particle Since the body moves with respect to an inertial frame, dynamics expressed in the body-referenced frame need extra attention. First, linear momentum for a particle obeys the equality F = d (mv)dt A rigid body consists of a large number of these small particles, which can be indexed. The summations we use below can be generalized to integrals quite easily. We have F i + R i = d (mivi) ,dt where F i is the external force acting on the particle and R i is the net force exerted by all the other surrounding particles (internal forces). Since the collection of particles is not driven apart by the internal forces, we must have equal and opposite internal forces such that N R i =0. i=1 Then summing up all the particle momentum equations gives N N d F i = (mivi) . dti=1 i=1 Note that the particle velocities are not independent, because the particles are rigidly at-tached. Now consider a body reference frame, with origin 0, in which the particle i resides at body-referenced radius vector r; the body translates and rotates, and we now consider how the momentum equation depends on this motion. 10 VEHICLE INERTIAL DYNAMICS 74 x y z Figure 2: Convention for the body-referenced coordinate system on a vehicle: x is forward, y is sway to the left, and z is heave upwards. Looking forward from the vehicle ”helm,” roll about the x axis is positive counterclockwise, pitch about the y-axis is positive bow-down, and yaw about the z-axis is positive turning left. 10.2 Linear Momentum in a Moving Frame The expression for total velocity may be inserted into the summed linear to give momentum equation N N d F i = (mi(vo + ω × ri))dti=1 i=1 N∂vo d = m + ω × miri ,∂t dt i=1 Nwhere m = i=1 mi, and vi = vo + ω × ri. Further defining the center of gravity vector rG such that N mrG = miri, i=1 we have N ∂ d F i = mvo + m (ω × rG). ∂t dt i=1 Using the expansion for total derivative again, the complete vector equation in body coor-dinates is F = N = m ∂vo + ω × vo + dω × rG + ω × (ω × rG) . ∂t dti=1 Now we list some conventions that will be used from here on: vo = {u, v, w} (body-referenced velocity) = 10 VEHICLE INERTIAL DYNAMICS 75 rG = {xG,yG,zg} (body-referenced location of center of mass) ω = {p, q, r} (rotation vector, in body coordinates) F = {X, Y, Z} (external force, body coordinates). The last term in the previous equation simplifies using the vector triple product identity ω × (ω × rG)=(· rG)ω − (ω rG,ω · ω) and the resulting three linear momentum equations are X = m ∂u + qw − rv + dqzG − dryG +(qyG + rzG)p − (q 2 + r 2)xG∂t dt dt Y = m ∂v + ru − pw + drxG − dpzG +(rzG + pxG)q − (r 2 + p 2)yG∂t dt dt Z = m ∂w + pv − qu + dpyG − dqxG +(pxG + qyG)r − (p 2 + q 2)zG . ∂t dt dt Note that about half of the terms here are due to the mass center being in a different location than the reference frame origin, i.e., rG 0. 10.3 Example: Mass on a String Consider a mass on a string, being swung around around in a circle at speed U, with radius r. The centrifugal force can be computed in at least three different ways. The vector equation at the start is ∂vo dω F = m + ω × vo + × rG + ω × (ω × rG) . ∂t dt 10.3.1 Moving Frame Affixed to Mass Affixing a reference frame on the mass, with the local x oriented forward and y inward towards the circle center, gives vo = {U, 0, 0}T ω = {0, 0,U/r}T rG = {0, 0, 0}T ∂voT = {0, 0, 0}∂t ∂ω T = {0, 0, 0} ,∂t10 VEHICLE INERTIAL DYNAMICS 76 such that F = mω ×vo = m{0,U2/r, 0}T . The force of the string pulls in on the mass to create the circular motion. 10.3.2 Rotating Frame Attached to Pivot Point Affixing the moving reference frame to the pivot point of the string, with the same orientation as above but allowing it to rotate with the string, we have Tvo ω rG ∂vo ∂t = = = = {0, 0, 0}{0, 0,U/r}T {0,r, 0}T {0, 0, 0}T ∂ω ∂t = T{0, 0, 0} , giving the same result: F = mω × (ω ×rG)= m{0,U2/r, 0}T . 10.3.3 Stationary Frame A frame fixed in inertial space, and momentarily coincident with the frame on the mass (10.3.1), can also be used for the calculation. In this case, as the string travels through a small arc δψ, vector subtraction gives δv = {0,U sin δψ, 0}T {0,Uδψ, 0}T . Since ψ˙= U/r, it follows easily that in the fixed frame dv/dt = {0,U2/r, 0}T , as before. 10.4 Angular Momentum For angular momentum, the summed particle equation is N N d (M i + ri × F i)= ri × (mivi),dti=1 i=1 10 VEHICLE INERTIAL DYNAMICS 77 where M i is an external moment on the particle i. Similar to the case for linear momentum, summed internal moments cancel. We have N N N ∂vo ∂ω (M i + ri × F i) = miri × + ω × vo + miri × × ri + ∂t ∂ti=1 i=1 i=1 N miri × (ω × (ω × ri)). i=1 The summation in the first term of the right-hand side is recognized simply as mrG, and the first term becomes ∂vomrG × + ω × vo . ∂t The second term expands as (using the triple product) N N ∂ω ∂ω ∂ω miri × × ri = mi (ri · ri) − · ri ri∂t ∂t∂ti=1 i=1 ⎧ ⎫ ⎪N 2 + zi 2)˙ ˙+ zir˙)xi) ⎪ ⎨ i=1 mi ((yi p − (yiq⎬ N 2 2= i=1 mi ((xi + zi )˙q − (xip˙+ zir˙)yi) . ⎪ ⎪ ⎩N ⎭ i=1 mi ((xi 2 + yi 2)˙r − (xip˙+ yiq˙)zi)
View Full Document
Unlocking...