40 lines
689 B
C++
40 lines
689 B
C++
#include <Servo.h>
|
|
|
|
const int PIN_SERVO = 6;
|
|
Servo servo;
|
|
|
|
/*
|
|
----------------------------------------------------
|
|
Servo - Arduino
|
|
-
|
|
Red - 5V
|
|
Black - GND
|
|
Yellow - PWM Pin (9 in this example)
|
|
|
|
Using TowerPro SG-5010 - default 93
|
|
TowerPro MG-995 -
|
|
as servos for development
|
|
----------------------------------------------------
|
|
*/
|
|
|
|
void setup() {
|
|
Serial.begin(57600);
|
|
Serial.flush();
|
|
|
|
Servo_init();
|
|
}
|
|
|
|
void loop() {
|
|
delay(1000);
|
|
servo.write(153);
|
|
delay(1000);
|
|
servo.write(93);
|
|
}
|
|
|
|
void Servo_init () {
|
|
servo.attach(PIN_SERVO);
|
|
int angle = servo.read();
|
|
Serial.print("Default angle: ");
|
|
Serial.println(angle);
|
|
}
|