spacecruft
/
farmbot-arduino-firmware
1
0
Fork 0
Code Issues Pull Requests Releases Activity

added servo command

pull/16/head
TimEvWw 2014-11-05 20:54:49 -01:00
parent 772fec2b7d
commit 2be1f6ce23
2 changed files with 21 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

25
src/ServoControl.cpp
View File

@ -1,5 +1,4 @@
#include "ServoControl.h"
#include "Servo.h"
/*
@ -27,13 +26,29 @@ int ServoControl::attach() {
servos[1].attach(SERVO_1_PIN);
}
int ServoControl::setAngle(int motor, int angle) {
int ServoControl::setAngle(int pin, int angle) {
switch(motor) {
case 1:
/*
Serial.print("R99");
Serial.print(" ");
Serial.print("SERVO");
Serial.print(" ");
Serial.print("pin");
Serial.print(" ");
Serial.print(pin);
Serial.print(" ");
Serial.print("angle");
Serial.print(" ");
Serial.print(angle);
Serial.print(" ");
Serial.print("\n");
*/
switch(pin) {
case 4:
servos[0].write(angle);
break;
case 2:
case 5:
servos[1].write(angle);
break;
default:

2
src/ServoControl.h
View File

@ -19,7 +19,7 @@ public:
static ServoControl* getInstance();
int attach();
int setAngle(int motor, int angle);
int setAngle(int pin, int angle);
private:
ServoControl();
ServoControl(ServoControl const&);