here's a basic way to get the servos running back and not really forth. Next to come, integration of the servo.
main.cpp@0:f8b0e15576fe, 2014-10-16 (annotated)
- Committer:
- jkangwi
- Date:
- Thu Oct 16 18:45:41 2014 +0000
- Revision:
- 0:f8b0e15576fe
This sucker may actually work;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
jkangwi | 0:f8b0e15576fe | 1 | #include "mbed.h" |
jkangwi | 0:f8b0e15576fe | 2 | #include "Servo.h" |
jkangwi | 0:f8b0e15576fe | 3 | |
jkangwi | 0:f8b0e15576fe | 4 | |
jkangwi | 0:f8b0e15576fe | 5 | |
jkangwi | 0:f8b0e15576fe | 6 | Servo myservo1(p21); //top |
jkangwi | 0:f8b0e15576fe | 7 | Servo myservo2(p22); //bottom |
jkangwi | 0:f8b0e15576fe | 8 | |
jkangwi | 0:f8b0e15576fe | 9 | int main() |
jkangwi | 0:f8b0e15576fe | 10 | { |
jkangwi | 0:f8b0e15576fe | 11 | while(1) { |
jkangwi | 0:f8b0e15576fe | 12 | |
jkangwi | 0:f8b0e15576fe | 13 | float servopos; |
jkangwi | 0:f8b0e15576fe | 14 | //servopos=0.38; |
jkangwi | 0:f8b0e15576fe | 15 | |
jkangwi | 0:f8b0e15576fe | 16 | |
jkangwi | 0:f8b0e15576fe | 17 | |
jkangwi | 0:f8b0e15576fe | 18 | while(servopos=servopos+0.03; servopos<=.67) { |
jkangwi | 0:f8b0e15576fe | 19 | servopos=servopos+0.03; |
jkangwi | 0:f8b0e15576fe | 20 | myservo1=servopos+.28; |
jkangwi | 0:f8b0e15576fe | 21 | myservo2=servopos; |
jkangwi | 0:f8b0e15576fe | 22 | printf("Servo 1 position %.2f Servo 2 position %.2f\n\r", servopos, (servopos)); |
jkangwi | 0:f8b0e15576fe | 23 | } |
jkangwi | 0:f8b0e15576fe | 24 | while(servopos>=.39) { |
jkangwi | 0:f8b0e15576fe | 25 | servopos=servopos-.03; |
jkangwi | 0:f8b0e15576fe | 26 | myservo1=servopos+.24; |
jkangwi | 0:f8b0e15576fe | 27 | myservo2=servopos; |
jkangwi | 0:f8b0e15576fe | 28 | printf("Servo 1 position %.2f Servo 2 position %.2f\n\r", servopos, (servopos)); |
jkangwi | 0:f8b0e15576fe | 29 | } |
jkangwi | 0:f8b0e15576fe | 30 | |
jkangwi | 0:f8b0e15576fe | 31 | } |
jkangwi | 0:f8b0e15576fe | 32 | } |