Skip to content

armgit / flix

Public Imported from GitHub
0

Making an ESP32-based quadcopter from scratch

Simplify motors pwm calculation using unified value for all motors

Oleg Kalachev31d382dd86f9
diff --git a/flix/motors.ino b/flix/motors.ino
index 937d8e4..1f21bfd 100644
--- a/flix/motors.ino
+++ b/flix/motors.ino
@@ -9,16 +9,13 @@
#define MOTOR_1_PIN 13
#define MOTOR_2_PIN 14
#define MOTOR_3_PIN 15
-
#define PWM_FREQUENCY 200
#define PWM_RESOLUTION 8
-
#define PWM_NEUTRAL 1500
-
-const uint16_t pwmMin[] = {1600, 1600, 1600, 1600};
-const uint16_t pwmMax[] = {2300, 2300, 2300, 2300};
-const uint16_t pwmReverseMin[] = {1390, 1440, 1440, 1440};
-const uint16_t pwmReverseMax[] = {1100, 1100, 1100, 1100};
+#define PWM_MIN 1600
+#define PWM_MAX 2300
+#define PWM_REVERSE_MIN 1440
+#define PWM_REVERSE_MAX 1100
void setupMotors() {
Serial.println("Setup Motors");
@@ -43,9 +40,9 @@ uint16_t getPWM(float val, int n) {
if (val == 0) {
return PWM_NEUTRAL;
} else if (val > 0) {
- return mapff(val, 0, 1, pwmMin[n], pwmMax[n]);
+ return mapff(val, 0, 1, PWM_MIN, PWM_MAX);
} else {
- return mapff(val, 0, -1, pwmReverseMin[n], pwmReverseMax[n]);
+ return mapff(val, 0, -1, PWM_REVERSE_MIN, PWM_REVERSE_MAX);
}
}