mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-21 02:23:34 +08:00
removed comments and fixed some euler bugs
This commit is contained in:
@@ -468,10 +468,6 @@ void AttitudeEstimatorQ::task_main()
|
||||
struct vehicle_attitude_s att = {};
|
||||
att.timestamp = sensors.timestamp;
|
||||
|
||||
//att.roll = euler(0);
|
||||
//att.pitch = euler(1);
|
||||
//att.yaw = euler(2);
|
||||
|
||||
att.rollspeed = _rates(0);
|
||||
att.pitchspeed = _rates(1);
|
||||
att.yawspeed = _rates(2);
|
||||
@@ -483,11 +479,6 @@ void AttitudeEstimatorQ::task_main()
|
||||
///* copy offsets */
|
||||
//memcpy(&att.rate_offsets, _gyro_bias.data, sizeof(att.rate_offsets));
|
||||
|
||||
//Matrix<3, 3> R = _q.to_dcm();
|
||||
|
||||
///* copy rotation matrix */
|
||||
//memcpy(&att.R[0], R.data, sizeof(att.R));
|
||||
//att.R_valid = true;
|
||||
memcpy(&att.q[0], _q.data, sizeof(att.q));
|
||||
att.q_valid = true;
|
||||
|
||||
|
||||
Reference in New Issue
Block a user