Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-01 13:38:38 -04:00
Code Issues Packages Projects Releases Wiki Activity

Replay: keep airspeed msgs in log

Browse Source
This commit is contained in:
Andrew Tridgell 2015-01-20 09:11:07 +11:00
parent 5a01933b7b
commit ad8480d5f7
2 changed files with 13 additions and 16 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

27
Tools/Replay/LogReader.cpp
View File

@ -77,14 +77,6 @@ struct PACKED log_Plane_Attitude {
uint16_t error_yaw;
};
struct PACKED log_AIRSPEED {
LOG_PACKET_HEADER;
uint32_t timestamp;
float airspeed;
float diffpressure;
int16_t temperature;
};
struct PACKED log_Copter_Attitude {
LOG_PACKET_HEADER;
uint32_t time_ms;
@ -163,7 +155,8 @@ void LogReader::process_plane(uint8_t type, uint8_t *data, uint16_t length)
break;
}
case LOG_PLANE_AIRSPEED_MSG: {
case LOG_PLANE_AIRSPEED_MSG:
case LOG_ARSP_MSG: {
struct log_AIRSPEED msg;
if (sizeof(msg) != length && length != sizeof(msg)+8) {
printf("Bad AIRSPEED length\n");
@ -172,6 +165,7 @@ void LogReader::process_plane(uint8_t type, uint8_t *data, uint16_t length)
memcpy(&msg, data, sizeof(msg));
wait_timestamp(msg.timestamp);
airspeed.setHIL(msg.airspeed, msg.diffpressure, msg.temperature);
dataflash.Log_Write_Airspeed(airspeed);
break;
}
}
@ -359,11 +353,12 @@ bool LogReader::update(uint8_t &type)
case LOG_IMU_MSG: {
struct log_IMU msg;
if(sizeof(msg) != f.length) {
printf("Bad IMU length\n");
if (sizeof(msg) != f.length && sizeof(msg) != f.length+8) {
printf("Bad IMU length %u expected %u\n",
(unsigned)sizeof(msg), (unsigned)f.length);
exit(1);
}
memcpy(&msg, data, sizeof(msg));
memcpy(&msg, data, f.length);
wait_timestamp(msg.timestamp);
if (gyro_mask & 1) {
ins.set_gyro(0, Vector3f(msg.gyro_x, msg.gyro_y, msg.gyro_z));
@ -377,11 +372,12 @@ bool LogReader::update(uint8_t &type)
case LOG_IMU2_MSG: {
struct log_IMU msg;
if(sizeof(msg) != f.length) {
printf("Bad IMU2 length\n");
if (sizeof(msg) != f.length && sizeof(msg) != f.length+8) {
printf("Bad IMU2 length %u expected %u\n",
(unsigned)sizeof(msg), (unsigned)f.length);
exit(1);
}
memcpy(&msg, data, sizeof(msg));
memcpy(&msg, data, f.length);
wait_timestamp(msg.timestamp);
if (gyro_mask & 2) {
ins.set_gyro(1, Vector3f(msg.gyro_x, msg.gyro_y, msg.gyro_z));
@ -528,7 +524,6 @@ bool LogReader::update(uint8_t &type)
break;
}
default:
if (vehicle == VEHICLE_PLANE) {
process_plane(f.type, data, f.length);

2
Tools/Replay/Replay.pde
View File

@ -209,6 +209,8 @@ void setup()
if (arm_time_ms != 0) {
ahrs.set_armed(false);
} else {
ahrs.set_armed(true);
}
barometer.init();