@@ -27,33 +27,33 @@ void setup() {
2727 M5.Lcd .print (" Servo Example" );
2828
2929 Wire.begin (21 , 22 , 100000UL );
30+ }
31+ // addr 0x01 mean control the number 1 servo by us
32+ void Servo_write_us (uint8_t number, uint16_t us) {
33+ Wire.beginTransmission (SERVO_ADDR);
34+ Wire.write (0x00 | number);
35+ Wire.write (us & 0x00ff );
36+ Wire.write (us >> 8 & 0x00ff );
37+ Wire.endTransmission ();
38+ }
3039
31- // addr 0x01 mean control the number 1 servo by us
32- void Servo_write_us (uint8_t number, uint16_t us) {
33- Wire.beginTransmission (SERVO_ADDR);
34- Wire.write (0x00 | number);
35- Wire.write (us & 0x00ff );
36- Wire.write (us >> 8 & 0x00ff );
37- Wire.endTransmission ();
38- }
40+ // addr 0x11 mean control the number 1 servo by angle
41+ void Servo_write_angle (uint8_t number, uint8_t angle) {
42+ Wire.beginTransmission (SERVO_ADDR);
43+ Wire.write (0x10 | number);
44+ Wire.write (angle);
45+ Wire.endTransmission ();
46+ }
3947
40- // addr 0x11 mean control the number 1 servo by angle
41- void Servo_write_angle (uint8_t number, uint8_t angle) {
42- Wire.beginTransmission (SERVO_ADDR);
43- Wire.write (0x10 | number);
44- Wire.write (angle);
45- Wire.endTransmission ();
48+ void loop () {
49+ for (uint8_t i = 0 ; i < 12 ; i++) {
50+ Servo_write_us (i, 700 );
51+ // Servo_write_angle(i, 0);
4652 }
47-
48- void loop () {
49- for (uint8_t i = 0 ; i < 12 ; i++) {
50- Servo_write_us (i, 700 );
51- // Servo_write_angle(i, 0);
52- }
53- delay (1000 );
54- for (uint8_t i = 0 ; i < 12 ; i++) {
55- Servo_write_us (i, 2300 );
56- // Servo_write_angle(i, 180);
57- }
58- delay (1000 );
59- }
53+ delay (1000 );
54+ for (uint8_t i = 0 ; i < 12 ; i++) {
55+ Servo_write_us (i, 2300 );
56+ // Servo_write_angle(i, 180);
57+ }
58+ delay (1000 );
59+ }
0 commit comments