mirror of
https://github.com/okalachev/flix.git
synced 2025-08-17 17:16:10 +00:00
Use natural order of ino files includes in simulation
In Arduino, ino files are included in alphabetical order. Cleanup unused function declarations in simulation, add missing. Rename flu to frd function to match the code style.
This commit is contained in:
@@ -43,7 +43,7 @@ void sendMavlink() {
|
||||
lastFast = t;
|
||||
|
||||
const float zeroQuat[] = {0, 0, 0, 0};
|
||||
Quaternion attitudeFRD = FLU2FRD(attitude); // MAVLink uses FRD coordinate system
|
||||
Quaternion attitudeFRD = fluToFrd(attitude); // MAVLink uses FRD coordinate system
|
||||
mavlink_msg_attitude_quaternion_pack(SYSTEM_ID, MAV_COMP_ID_AUTOPILOT1, &msg,
|
||||
time, attitudeFRD.w, attitudeFRD.x, attitudeFRD.y, attitudeFRD.z, rates.x, rates.y, rates.z, zeroQuat);
|
||||
sendMessage(&msg);
|
||||
@@ -206,7 +206,7 @@ void mavlinkPrint(const char* str) {
|
||||
}
|
||||
|
||||
// Convert Forward-Left-Up to Forward-Right-Down quaternion
|
||||
inline Quaternion FLU2FRD(const Quaternion &q) {
|
||||
inline Quaternion fluToFrd(const Quaternion &q) {
|
||||
return Quaternion(q.w, q.x, -q.y, -q.z);
|
||||
}
|
||||
|
||||
|
Reference in New Issue
Block a user