mirror of
https://github.com/paparazzi/paparazzi.git
synced 2026-05-09 22:49:53 +08:00
Merge pull request #2095 from EwoudSmeur/indi_setpoint
Fix INDI rpy setpoint function
This commit is contained in:
@@ -306,9 +306,9 @@ void stabilization_indi_set_failsafe_setpoint(void)
|
||||
void stabilization_indi_set_rpy_setpoint_i(struct Int32Eulers *rpy)
|
||||
{
|
||||
// stab_att_sp_euler.psi still used in ref..
|
||||
memcpy(&stab_att_sp_euler, rpy, sizeof(struct Int32Eulers));
|
||||
stab_att_sp_euler = *rpy;
|
||||
|
||||
quat_from_rpy_cmd_i(&stab_att_sp_quat, &stab_att_sp_euler);
|
||||
int32_quat_of_eulers(&stab_att_sp_quat, &stab_att_sp_euler);
|
||||
}
|
||||
|
||||
/**
|
||||
|
||||
@@ -196,7 +196,7 @@ void stabilization_indi_set_rpy_setpoint_i(struct Int32Eulers *rpy)
|
||||
// stab_att_sp_euler.psi still used in ref..
|
||||
stab_att_sp_euler = *rpy;
|
||||
|
||||
quat_from_rpy_cmd_i(&stab_att_sp_quat, &stab_att_sp_euler);
|
||||
int32_quat_of_eulers(&stab_att_sp_quat, &stab_att_sp_euler);
|
||||
}
|
||||
|
||||
/**
|
||||
|
||||
Reference in New Issue
Block a user