Mirrors_Framework/paparazzi
1
0
Fork 0
mirror of https://github.com/paparazzi/paparazzi.git synced 2026-06-05 06:54:49 +08:00
Code Issues Actions 26 Packages Projects Releases Wiki Activity

[rotorcraft] fix stabilization_attitude_ref_idx_set_omega_*

Browse Source
This commit is contained in:
Felix Ruess
2014-07-03 22:45:46 +02:00
parent 25c1b4e13a
commit 32c531f070
1 changed files with 6 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files
sw/airborne/firmwares/rotorcraft/stabilization/stabilization_attitude_ref_quat_float.c
+6 -6
View File
@@ -75,18 +75,18 @@ static inline void update_ref_quat_from_eulers(void) {
}
void stabilization_attitude_ref_idx_set_omega_p(uint8_t idx, float omega) {
stab_att_ref_model[i].omega.p = omega;
two_omega_squared[i].p = 2 * omega * omega;
stab_att_ref_model[idx].omega.p = omega;
two_omega_squared[idx].p = 2 * omega * omega;
}
void stabilization_attitude_ref_idx_set_omega_q(uint8_t idx, float omega) {
stab_att_ref_model[i].omega.q = omega;
two_omega_squared[i].q = 2 * omega * omega;
stab_att_ref_model[idx].omega.q = omega;
two_omega_squared[idx].q = 2 * omega * omega;
}
void stabilization_attitude_ref_idx_set_omega_r(uint8_t idx, float omega) {
stab_att_ref_model[i].omega.r = omega;
two_omega_squared[i].r = 2 * omega * omega;
stab_att_ref_model[idx].omega.r = omega;
two_omega_squared[idx].r = 2 * omega * omega;
}
void stabilization_attitude_ref_set_omega_p(float omega) {