GCS_MAVLink: supply IMU temperature in mavlink extensions

This commit is contained in:
Andrew Tridgell 2019-10-08 14:22:12 +11:00
parent 339da0d07f
commit a832c3bff0
1 changed files with 4 additions and 3 deletions

View File

@ -1601,8 +1601,9 @@ void GCS_MAVLINK::send_raw_imu()
gyro.z * 1000.0f, gyro.z * 1000.0f,
mag.x, mag.x,
mag.y, mag.y,
mag.z, 0, mag.z,
ins.get_temperature(0)*100); 0, // we use SCALED_IMU and SCALED_IMU2 for other IMUs
int16_t(ins.get_temperature(0)*100));
} }
void GCS_MAVLINK::send_scaled_imu(uint8_t instance, void (*send_fn)(mavlink_channel_t chan, uint32_t time_ms, int16_t xacc, int16_t yacc, int16_t zacc, int16_t xgyro, int16_t ygyro, int16_t zgyro, int16_t xmag, int16_t ymag, int16_t zmag, int16_t temperature)) void GCS_MAVLINK::send_scaled_imu(uint8_t instance, void (*send_fn)(mavlink_channel_t chan, uint32_t time_ms, int16_t xacc, int16_t yacc, int16_t zacc, int16_t xgyro, int16_t ygyro, int16_t zgyro, int16_t xmag, int16_t ymag, int16_t zmag, int16_t temperature))
@ -1641,7 +1642,7 @@ void GCS_MAVLINK::send_scaled_imu(uint8_t instance, void (*send_fn)(mavlink_chan
mag.x, mag.x,
mag.y, mag.y,
mag.z, mag.z,
ins.get_temperature(instance)); int16_t(ins.get_temperature(instance)*100));
} }