Context
On the following drawing, a platform is hung from the ceiling not exactly from its centre of gravity. Because of this it can't sustain an arbitrary orientation for long; I want to increase its stiffness with the use of 3 orthogonal fast spinning flywheels, but before building those flywheels I need to know how big they need to be by making a dynamic model... 
... And I have been unable to model the gyroscopic effect [Edit: end removed for clarity].
Question
How can I model the 3 flywheels reaction to (themselves and) the gravity torque, be it through a rate increment or a torque (to inject in the plant model)?
Implementing Lelesquiz's answer
Top level equations: Euler-Lagrange
The goal is to solve for each timestep for the angles (ϕ,θ,ψ) using the equations, in inertial frame: ddt(∂L∂˙ϕ)−∂L∂ϕ=(Mg−3∑k=1Mwk)⋅∂ωb∂˙ϕ
ddt(∂L∂˙θ)−∂L∂θ=(Mg−3∑k=1Mwk)⋅∂ωb∂˙θ
ddt(∂L∂˙ψ)−∂L∂ψ=(Mg−3∑k=1Mwk)⋅∂ωb∂˙ψ
Where
Mg is the gravity torque,
Mwk is the motor torque applied on the flywheel k (opposite of what's applied on the platform), and
ωb is the platform rate vector in inertial frame. 3 other equations based on
αk, the angles of the flywheels, should have been added to completely characterize the system but the rates of the wheels are inputs, measured directly. The torques on the wheels are inputs as well (and the command of the closed loop system).
Knowing that the lagrangian L=T−U in the inertial frame.
Kinetic energy T
T(ϕ,θ,ψ,˙ϕ,˙θ,˙ψ)=123∑k=1(NTk,Ri[IwO,Ri]Nk,Ri)+12(mbvTb,Rivb,Ri+ωTb,Ri[IbG,Ri]ωb,Ri)
Where
mb is the mass of the system (with wheels on),
vb the velocity vector of the center of gravity of the system,
ωb the system's rate vector (wheels not spinning) and
[IbG] the inertia matrix of the system about its center of gravity (which needs to be transported from the guimbal centre 0),
[IwO] the inertia matrix of the flywheels about their axis, and
Nk the rate vector of the flywheels in the inertial frame.
[IwO,Ri]=[Rib][Jw000Jw000Jw][Rbi]
vb=ωb,Ri×Δb,Ri
[IbG,Ri]=[Rib][IbO,Rb][Rbi]+mb(Δ2by,Ri+Δ2bz,Ri−Δbx,RiΔby,Ri−Δbx,RiΔbz,Ri−Δbx,RiΔby,RiΔ2bx,Ri+Δ2bz,Ri−Δby,RiΔbz,Ri−Δbx,RiΔbz,Ri−Δby,RiΔbz,RiΔ2bx,Ri+Δ2by,Ri)
Δb,Ri being the guimbal centre - center of gravity vector of the system expressed in the inertial frame. See below "Euler angle expressions" for the transformation body-inertial $\boldsymbol{
_i}=\boldsymbol{[R_{ib}]}\boldsymbol{_b}$.Potential energy U
U(ϕ,θ,ψ)=−mgRi.Δb,Ri
The minus sign comes from the fact U is minimum with the guimbal-CG vector pointing downward (dot product positive).
Euler angles expressions
The Euler angles 313 have been selected as a coordinate system, which gives the rotation matrix from inertial frame (0XiYiZi) to body frame (0XbYbZb): RRbRi(ϕ,θ,ψ)=[cosψsinψ0−sinψcosψ0001][1000cosθsinθ0−sinθcosθ][cosϕsinϕ0−sinϕcosϕ0001]
The rate vector is obtained by summing the projections on each axis of the inertial frame the
˙ϕ,˙θ,˙ψ vectors):
wb,Ri=[˙θcosϕ+˙ψsinθsinϕ˙θsinϕ+˙ψsinθcosϕ˙ϕ+˙ψcosθ]
Problem
The kinetic energy of the wheels is independent on the Euler angles, so the rates of the wheels have no effect, which is wrong! Since it's absolutely normal that no matter the rotation matrix the norm of the wheels rates vector does not change, the kinetic energy expression or even the top level equations must be wrong.
No comments:
Post a Comment