42 lines
1.5 KiB
Markdown
42 lines
1.5 KiB
Markdown
|
|
|||
|
|
# yaw
|
|||
|
|
```rust
|
|||
|
|
ewn_x_r_ou = cross_product(&rt_hs.ang_vel_en, &rt_hs.r_ou);
|
|||
|
|
|
|||
|
|
|
|||
|
|
rt_hs.plin_vel_eu = rt_hs.plin_vel_eo.clone();
|
|||
|
|
|
|||
|
|
for i in 0..NPN{
|
|||
|
|
|
|||
|
|
tmp_vec0 = cross_product(&rt_hs.p_ang_vel_en.slice(s![PN[i] - 1, 0, ..]).to_owned(), &rt_hs.r_ou);
|
|||
|
|
|
|||
|
|
tmp_vec1 = cross_product(&rt_hs.p_ang_vel_en.slice(s![PN[i] - 1, 0, ..]).to_owned(), &ewn_x_r_ou);
|
|||
|
|
|
|||
|
|
tmp_vec2 = cross_product(&rt_hs.p_ang_vel_en.slice(s![PN[i] - 1, 1, ..]).to_owned(), &rt_hs.r_ou);
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
let update_value = tmp_vec0 + rt_hs.plin_vel_eu.slice(s![PN[i] - 1, 0, ..]);
|
|||
|
|
|
|||
|
|
// Partial linear velocity (and its 1st time derivative) of the nacelle center of mass (point U) in the inertia frame (body E for earth) [-]
|
|||
|
|
|
|||
|
|
rt_hs.plin_vel_eu.slice_mut(s![PN[i] - 1, 0, ..]).assign(&update_value);
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
let update_value = tmp_vec1 + tmp_vec2 + rt_hs.plin_vel_eu.slice(s![PN[i] - 1, 1, ..]);
|
|||
|
|
|
|||
|
|
rt_hs.plin_vel_eu.slice_mut(s![PN[i] - 1, 1, ..]).assign(&update_value);
|
|||
|
|
|
|||
|
|
// Linear acceleration of the nacelle center of mass (point U) in the inertia frame (body E for earth) (excluding QD2T components) [-]
|
|||
|
|
|
|||
|
|
rt_hs.lin_acc_eut = rt_hs.lin_acc_eut.clone() + x.qdt[PN[i] as usize - 1] * rt_hs.plin_vel_eu.slice(s![PN[i] - 1, 1, ..]).to_owned();
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
```
|
|||
|
|
|
|||
|
|
plin_vel_eu
|
|||
|
|
Partial linear velocity (and its 1st time derivative) of the nacelle center of mass (point U) in the inertia frame (body E for earth) [-]
|
|||
|
|
|
|||
|
|
lin_acc_eut
|
|||
|
|
Linear acceleration of the nacelle center of mass (point U) in the inertia frame (body E for earth) (excluding QD2T components) [-]
|