Skip to main content

integrate_orientation

Function integrate_orientation 

Source
pub fn integrate_orientation(q: [f32; 4], omega: [f32; 3], dt: f32) -> [f32; 4]
Expand description

Integrate a quaternion orientation q by angular velocity omega (rad/s) over time step dt (seconds).

Uses the first-order approximation q' = normalize(q + 0.5 * dt * Ω⊗q).