Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

SITL: log airspeed in SIM2

This commit is contained in:
Andrew Tridgell 2022-01-26 17:33:38 +11:00
parent 13f7e12d2a
commit 7643c5d3f3
1 changed files with 5 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
libraries/SITL/SIM_Aircraft.cpp
View File

@ -475,13 +475,15 @@ void Aircraft::fill_fdm(struct sitl_fdm &fdm)
// @Field: VN: Velocity north
// @Field: VE: Velocity east
// @Field: VD: Velocity down
// @Field: As: Airspeed
Vector3d pos = get_position_relhome();
Vector3f vel = get_velocity_ef();
AP::logger().WriteStreaming("SIM2", "TimeUS,PN,PE,PD,VN,VE,VD",
"Qdddfff",
AP::logger().WriteStreaming("SIM2", "TimeUS,PN,PE,PD,VN,VE,VD,As",
"Qdddffff",
AP_HAL::micros64(),
pos.x, pos.y, pos.z,
vel.x, vel.y, vel.z);
vel.x, vel.y, vel.z,
airspeed_pitot);
}
}