// ============================================================ // XIAO ESP32-C6 + PCA9685 + MG90S Servo Control // Board: Seeed XIAO ESP32-C6 // Library: Adafruit PWM Servo Driver (install via Library Manager) // I2C: SDA = D4 (GPIO22) | SCL = D5 (GPIO23) // ============================================================ #include #include // --- PCA9685 object (default I2C address 0x40) --- Adafruit_PWMServoDriver pca = Adafruit_PWMServoDriver(0x40); // --- MG90S pulse width constants (in PCA9685 ticks @ 50 Hz) --- // At 50 Hz, 1 period = 20 ms = 4096 ticks // MG90S: 500 µs = 0°, 1500 µs = 90°, 2500 µs = 180° #define SERVO_FREQ 50 // 50 Hz standard for servos #define SERVO_MIN 102 // ~500 µs → 0° #define SERVO_MAX 512 // ~2500 µs → 180° // --- Which PCA9685 channel is each servo on --- #define SERVO_CH_0 0 // Change to match your wiring // Add more: #define SERVO_CH_1 1, etc. // ============================================================ // Helper: convert angle (0–180°) to PCA9685 tick value // ============================================================ uint16_t angleToPulse(float angle) { angle = constrain(angle, 0.0, 180.0); return (uint16_t)(SERVO_MIN + (angle / 180.0) * (SERVO_MAX - SERVO_MIN)); } // ============================================================ // Helper: move servo on a given channel to a target angle // ============================================================ void setServoAngle(uint8_t channel, float angle) { uint16_t pulse = angleToPulse(angle); pca.setPWM(channel, 0, pulse); Serial.print("CH"); Serial.print(channel); Serial.print(" → "); Serial.print(angle, 1); Serial.println("°"); } // ============================================================ // Helper: smooth sweep between two angles // channel – PCA9685 channel number // fromAngle – starting angle (0–180) // toAngle – ending angle (0–180) // stepDelay – milliseconds between each 1° step // ============================================================ void sweepServo(uint8_t channel, float fromAngle, float toAngle, uint16_t stepDelay) { float step = (toAngle > fromAngle) ? 1.0 : -1.0; for (float a = fromAngle; (step > 0) ? (a <= toAngle) : (a >= toAngle); a += step) { setServoAngle(channel, a); delay(stepDelay); } } // ============================================================ // setup() // ============================================================ void setup() { Serial.begin(115200); while (!Serial) delay(10); // Wait for serial monitor Serial.println("=== XIAO ESP32-C6 + PCA9685 + MG90S ==="); // Start I2C on XIAO ESP32-C6 default pins Wire.begin(); // Initialise PCA9685 pca.begin(); pca.setOscillatorFrequency(27000000); // Internal oscillator (adjust if drifting) pca.setPWMFreq(SERVO_FREQ); delay(100); // Centre all servos at startup Serial.println("Centering servo(s)..."); setServoAngle(SERVO_CH_0, 90.0); delay(500); } // ============================================================ // loop() – demo: sweep 0° → 180° → 0°, repeat // ============================================================ void loop() { // --- Sweep to 0° --- Serial.println("Sweeping to 0°"); sweepServo(SERVO_CH_0, 90.0, 0.0, 15); delay(500); // --- Sweep to 180° --- Serial.println("Sweeping to 180°"); sweepServo(SERVO_CH_0, 0.0, 180.0, 15); delay(500); // --- Return to centre --- Serial.println("Returning to 90°"); sweepServo(SERVO_CH_0, 180.0, 90.0, 15); delay(1000); // ------------------------------------------------------- // To control via Serial Monitor instead, comment out the // sweep above and uncomment the block below. // Send e.g. "0,45" to move CH0 to 45° // "1,120" to move CH1 to 120° // ------------------------------------------------------- /* if (Serial.available()) { String cmd = Serial.readStringUntil('\n'); cmd.trim(); int comma = cmd.indexOf(','); if (comma > 0) { uint8_t ch = (uint8_t)cmd.substring(0, comma).toInt(); float angle = cmd.substring(comma + 1).toFloat(); setServoAngle(ch, angle); } } */ }