mirror of https://github.com/ArduPilot/ardupilot
Copter: GCS_Mavlink gets gyro direct from imu
This commit is contained in:
parent
f46ff2b44e
commit
3d926a6943
|
@ -115,15 +115,16 @@ static NOINLINE void send_heartbeat(mavlink_channel_t chan)
|
||||||
|
|
||||||
static NOINLINE void send_attitude(mavlink_channel_t chan)
|
static NOINLINE void send_attitude(mavlink_channel_t chan)
|
||||||
{
|
{
|
||||||
|
const Vector3f &gyro = ins.get_gyro();
|
||||||
mavlink_msg_attitude_send(
|
mavlink_msg_attitude_send(
|
||||||
chan,
|
chan,
|
||||||
millis(),
|
millis(),
|
||||||
ahrs.roll,
|
ahrs.roll,
|
||||||
ahrs.pitch,
|
ahrs.pitch,
|
||||||
ahrs.yaw,
|
ahrs.yaw,
|
||||||
omega.x,
|
gyro.x,
|
||||||
omega.y,
|
gyro.y,
|
||||||
omega.z);
|
gyro.z);
|
||||||
}
|
}
|
||||||
|
|
||||||
#if AC_FENCE == ENABLED
|
#if AC_FENCE == ENABLED
|
||||||
|
|
Loading…
Reference in New Issue