Skip to content

armgit / flix

Public Imported from GitHub
0

Making an ESP32-based quadcopter from scratch

Move yaw dead zone handling from mavlink to control subsystem So yaw dead zone works the same for rc and mavlink.

Oleg Kalachevd757ffa8530b
diff --git a/flix/control.ino b/flix/control.ino
index 4de742c..9e047d8 100644
--- a/flix/control.ino
+++ b/flix/control.ino
@@ -75,6 +75,8 @@ void interpretControls() {
if (controlThrottle < 0.05 && controlYaw > 0.95) armed = true; // arm gesture
if (controlThrottle < 0.05 && controlYaw < -0.95) armed = false; // disarm gesture
+ if (abs(controlYaw) < 0.1) controlYaw = 0; // yaw dead zone
+
thrustTarget = controlThrottle;
if (mode == STAB) {
diff --git a/flix/mavlink.ino b/flix/mavlink.ino
index cf69de3..4436c92 100644
--- a/flix/mavlink.ino
+++ b/flix/mavlink.ino
@@ -11,7 +11,6 @@
#define SYSTEM_ID 1
#define MAVLINK_RATE_SLOW 1
#define MAVLINK_RATE_FAST 10
-#define MAVLINK_CONTROL_YAW_DEAD_ZONE 0.1f
bool mavlinkConnected = false;
String mavlinkPrintBuffer;
@@ -105,8 +104,6 @@ void handleMavlink(const void *_msg) {
controlYaw = m.r / 1000.0f;
controlMode = NAN;
controlTime = t;
-
- if (abs(controlYaw) < MAVLINK_CONTROL_YAW_DEAD_ZONE) controlYaw = 0;
}
if (msg.msgid == MAVLINK_MSG_ID_PARAM_REQUEST_LIST) {