kevin ANTUNES
/
megotkevin
projet megot
Fork of Servo_HelloWorld by
main.cpp@2:d9a738c0e226, 2017-05-10 (annotated)
- Committer:
- Kevin_16
- Date:
- Wed May 10 10:40:42 2017 +0000
- Revision:
- 2:d9a738c0e226
- Parent:
- 1:40d2fd0b99e6
megot
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
simon | 1:40d2fd0b99e6 | 1 | // Hello World to sweep a servo through its full range |
simon | 1:40d2fd0b99e6 | 2 | |
simon | 1:40d2fd0b99e6 | 3 | #include "mbed.h" |
simon | 1:40d2fd0b99e6 | 4 | #include "Servo.h" |
simon | 1:40d2fd0b99e6 | 5 | |
Kevin_16 | 2:d9a738c0e226 | 6 | // init pin for Nucleo-L476RG |
Kevin_16 | 2:d9a738c0e226 | 7 | // Servo myservo(PB_3); |
Kevin_16 | 2:d9a738c0e226 | 8 | |
Kevin_16 | 2:d9a738c0e226 | 9 | // init pin for Nucleo-L432KC |
Kevin_16 | 2:d9a738c0e226 | 10 | Servo myservo(D6); |
Kevin_16 | 2:d9a738c0e226 | 11 | |
Kevin_16 | 2:d9a738c0e226 | 12 | AnalogIn ain (A2); |
simon | 1:40d2fd0b99e6 | 13 | |
simon | 1:40d2fd0b99e6 | 14 | int main() { |
Kevin_16 | 2:d9a738c0e226 | 15 | |
Kevin_16 | 2:d9a738c0e226 | 16 | float p = 0.0; |
Kevin_16 | 2:d9a738c0e226 | 17 | float pRead; |
Kevin_16 | 2:d9a738c0e226 | 18 | |
Kevin_16 | 2:d9a738c0e226 | 19 | // myservo.position(0); |
Kevin_16 | 2:d9a738c0e226 | 20 | while(1){ |
Kevin_16 | 2:d9a738c0e226 | 21 | /*myservo.write(0); |
Kevin_16 | 2:d9a738c0e226 | 22 | wait(5); |
Kevin_16 | 2:d9a738c0e226 | 23 | myservo.write(1); |
Kevin_16 | 2:d9a738c0e226 | 24 | wait(5);*/ |
Kevin_16 | 2:d9a738c0e226 | 25 | //myservo.position(90); |
Kevin_16 | 2:d9a738c0e226 | 26 | //myservo.write(p); |
Kevin_16 | 2:d9a738c0e226 | 27 | //pRead = myservo.read(); |
Kevin_16 | 2:d9a738c0e226 | 28 | // printf("val = %f \n",pRead); |
Kevin_16 | 2:d9a738c0e226 | 29 | //wait(0.8); |
Kevin_16 | 2:d9a738c0e226 | 30 | /*if(p > 0.9) |
Kevin_16 | 2:d9a738c0e226 | 31 | p=0.0; |
Kevin_16 | 2:d9a738c0e226 | 32 | else |
Kevin_16 | 2:d9a738c0e226 | 33 | p+=0.1;*/ |
Kevin_16 | 2:d9a738c0e226 | 34 | if (ain == 1) |
Kevin_16 | 2:d9a738c0e226 | 35 | { |
Kevin_16 | 2:d9a738c0e226 | 36 | myservo.write(1); |
Kevin_16 | 2:d9a738c0e226 | 37 | // myservo.position(180); |
Kevin_16 | 2:d9a738c0e226 | 38 | wait(2); |
Kevin_16 | 2:d9a738c0e226 | 39 | // myservo.position(0); |
Kevin_16 | 2:d9a738c0e226 | 40 | myservo.write(0); |
Kevin_16 | 2:d9a738c0e226 | 41 | } |
simon | 1:40d2fd0b99e6 | 42 | } |
Kevin_16 | 2:d9a738c0e226 | 43 | |
simon | 1:40d2fd0b99e6 | 44 | } |