Ecuaciones de movimiento con cuaternión
Θω⃗ ˙ω~z⃗ z⃗ ˙R=τ⃗ −ω~Θω⃗ con:=⎡⎣⎢0ωz−ωy−ωz0ωXωy−ωX0⎤⎦⎥ω⃗ Velocidad angular Θ = Θ (z⃗ )Tensor de inerciaτ⃗ =τ⃗ (z⃗ ,z⃗ ˙, t )Pares externos y=⎡⎣⎢⎢⎢abCd⎤⎦⎥⎥⎥,Vector de cuaternión 4 × 1 con: z⃗ Tz⃗ = 1Cinemático=12[0ω⃗ −ω⃗ Tω~]z⃗ Matriz de rotación R=⎡⎣⎢a2+b2−C2−d22una d+ 2b c− 2un c + 2bd _− 2una d+ 2b ca2+C2−d2−b22un segundo + 2cd _2un c + 2bd _− 2un segundo + 2cd _a2+d2−b2−C2⎤⎦⎥y RTR = yo( 1 )( 2 )
Simulación
Para cumplir con el requisito de quez⃗ Tz⃗ = 1
extendemos la ecuación (2) con un "elemento controlador P"
z⃗ ˙=12[0ω⃗ −ω⃗ Tω~]z⃗ +PAG2( 1 -z⃗ Tz⃗ )z⃗ Pasos de los cálculos:Paso I: Dar la condición inicial para t = 0 ⇒ω⃗ ( 0 ),z⃗ ( 0 )Paso II resolver la ecuación (1) para ω⃗ ˙Paso III ω⃗ = ∫ω⃗ ˙dt +ω⃗ ( 0 )Paso IV calcular ecuación (3)Paso Vz⃗ = ∫z⃗ ˙dt +z⃗ ( 0 )( 3 )
Juan Alexiou
paoloh
Juan Alexiou
rad/sec
. No estoy familiarizado con este término. Estoy familiarizado con la multiplicación jacobiana inversa