Voor Maarten
Dependencies: MODSERIAL Servo mbed
main.cpp@0:c41f256db1d4, 2017-10-20 (annotated)
- Committer:
- Jannes
- Date:
- Fri Oct 20 10:12:45 2017 +0000
- Revision:
- 0:c41f256db1d4
Standard Servo Test
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Jannes | 0:c41f256db1d4 | 1 | // Continuously sweep the servo through it's full range |
Jannes | 0:c41f256db1d4 | 2 | #include "mbed.h" |
Jannes | 0:c41f256db1d4 | 3 | #include "Servo.h" |
Jannes | 0:c41f256db1d4 | 4 | #include "MODSERIAL.h" |
Jannes | 0:c41f256db1d4 | 5 | |
Jannes | 0:c41f256db1d4 | 6 | InterruptIn button3(D10); |
Jannes | 0:c41f256db1d4 | 7 | Servo myservo(D9); |
Jannes | 0:c41f256db1d4 | 8 | int k=0; |
Jannes | 0:c41f256db1d4 | 9 | |
Jannes | 0:c41f256db1d4 | 10 | //Other |
Jannes | 0:c41f256db1d4 | 11 | MODSERIAL pc(USBTX, USBRX); |
Jannes | 0:c41f256db1d4 | 12 | |
Jannes | 0:c41f256db1d4 | 13 | int main() { |
Jannes | 0:c41f256db1d4 | 14 | myservo.calibrate(0.005,60); |
Jannes | 0:c41f256db1d4 | 15 | pc.baud(115200); |
Jannes | 0:c41f256db1d4 | 16 | while(1) { |
Jannes | 0:c41f256db1d4 | 17 | for(int i=0; i<100; i++) { |
Jannes | 0:c41f256db1d4 | 18 | myservo = i/100; |
Jannes | 0:c41f256db1d4 | 19 | wait(0.1); |
Jannes | 0:c41f256db1d4 | 20 | float Posi = myservo.read(); |
Jannes | 0:c41f256db1d4 | 21 | pc.printf("\r Position = %.4f \n",Posi); |
Jannes | 0:c41f256db1d4 | 22 | } |
Jannes | 0:c41f256db1d4 | 23 | for(int i=100; i>0; i--) { |
Jannes | 0:c41f256db1d4 | 24 | myservo = i/100; |
Jannes | 0:c41f256db1d4 | 25 | wait(0.1); |
Jannes | 0:c41f256db1d4 | 26 | float Posi = myservo.read(); |
Jannes | 0:c41f256db1d4 | 27 | pc.printf("\r Position = %.4f \n",Posi); |
Jannes | 0:c41f256db1d4 | 28 | } |
Jannes | 0:c41f256db1d4 | 29 | } |
Jannes | 0:c41f256db1d4 | 30 | } |