I am trying to use the M5Stack Servo module to control a 360° servo. The problem is that as soon as the external power supply is connected the servo rotates in a clockwise direction at a steady speed. I have been able to get the servo to rotate anti-clockwise at a slower speed for a period (3 seconds in the example) by adapting the SERVO sketch as below. However the servo always returns to the constant clockwise speed for the 1 second, whatever angle is used in the first function call. My understandin is that 90° (or 1500 us) should be stop and above 90° clockwise and below 90° anticlockwise and the further from 90° the faster the rotation.
Could someone show me a simple skech to make a 360° servo spin clockwise and then anticlockwise using the M5Stack Servo Module?
/*
Description: Use SERVO Module to control the rotation of 12-channel servo.
*/
#include <Arduino.h>
#include <M5Stack.h>
#include <Wire.h>
#define SERVO_ADDR 0x53
void setup() {
M5.begin(true, false, true);
M5.Power.begin();
M5.Lcd.setTextFont(4);
M5.Lcd.setCursor(70, 100);
M5.Lcd.print("Servo Example");
Wire.begin(21, 22, 100000);
// put your setup code here, to run once:
}
// addr 0x01 mean control the number 1 servo by us
void Servo_write_us(uint8_t number, uint16_t us) {
Wire.beginTransmission(SERVO_ADDR);
Wire.write(0x00 | number);
Wire.write(us & 0x00ff);
Wire.write(us >> 8 & 0x00ff);
Wire.endTransmission();
}
// addr 0x11 mean control the number 1 servo by angle
void Servo_write_angle(uint8_t number, uint8_t angle) {
Wire.beginTransmission(SERVO_ADDR);
Wire.write(0x10 | number);
Wire.write(angle);
Wire.endTransmission();
}
void loop() {
//Servo_write_us(0, 1200);
for(uint8_t i = 0; i < 12; i++){
//Servo_write_us(i, 1000);
Servo_write_angle(i, 100);
}
delay(1000);
for(uint8_t i = 0; i < 12; i++){
//Servo_write_us(i, 2000);
Servo_write_angle(i, 180);
}
delay(3000);
}