project
Dependencies: MbedJSONValue DISCO_L475VG_IOT01A_wifi mbed-http
ServoMove.cpp@0:8bcd728684c5, 2019-01-07 (annotated)
- Committer:
- Eason0505
- Date:
- Mon Jan 07 11:19:49 2019 +0000
- Revision:
- 0:8bcd728684c5
IoT Project code
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Eason0505 | 0:8bcd728684c5 | 1 | #include "ServoMove.h" |
Eason0505 | 0:8bcd728684c5 | 2 | PwmOut servo(PA_6); |
Eason0505 | 0:8bcd728684c5 | 3 | Serial pc1(USBTX, USBRX); |
Eason0505 | 0:8bcd728684c5 | 4 | |
Eason0505 | 0:8bcd728684c5 | 5 | void ServoConvert(double cnv) |
Eason0505 | 0:8bcd728684c5 | 6 | { |
Eason0505 | 0:8bcd728684c5 | 7 | if (cnv > 144) { |
Eason0505 | 0:8bcd728684c5 | 8 | servo.pulsewidth_us(1000); //0deg |
Eason0505 | 0:8bcd728684c5 | 9 | pc1.printf("cnv1 =%f\n\r",cnv); |
Eason0505 | 0:8bcd728684c5 | 10 | } else if(cnv >108 && cnv <144) { |
Eason0505 | 0:8bcd728684c5 | 11 | servo.pulsewidth_us(1100); |
Eason0505 | 0:8bcd728684c5 | 12 | pc1.printf("cnv2 =%f\n\r",cnv); |
Eason0505 | 0:8bcd728684c5 | 13 | } else if (cnv >72 && cnv <108) { |
Eason0505 | 0:8bcd728684c5 | 14 | servo.pulsewidth_us(1200); |
Eason0505 | 0:8bcd728684c5 | 15 | pc1.printf("cnv3 =%f\n\r",cnv); |
Eason0505 | 0:8bcd728684c5 | 16 | } else if (cnv > 36&& cnv <72) { |
Eason0505 | 0:8bcd728684c5 | 17 | servo.pulsewidth_us(1300); |
Eason0505 | 0:8bcd728684c5 | 18 | pc1.printf("cnv4 =%f\n\r",cnv); |
Eason0505 | 0:8bcd728684c5 | 19 | } else if(cnv > 0&& cnv <36) { |
Eason0505 | 0:8bcd728684c5 | 20 | servo.pulsewidth_us(1400); |
Eason0505 | 0:8bcd728684c5 | 21 | pc1.printf("cnv5 =%f\n\r",cnv); |
Eason0505 | 0:8bcd728684c5 | 22 | } else if(cnv > -36&& cnv <0) { |
Eason0505 | 0:8bcd728684c5 | 23 | servo.pulsewidth_us(1500); |
Eason0505 | 0:8bcd728684c5 | 24 | pc1.printf("cnv6 =%f\n\r",cnv); |
Eason0505 | 0:8bcd728684c5 | 25 | } else if(cnv > -72&& cnv <-36) { |
Eason0505 | 0:8bcd728684c5 | 26 | servo.pulsewidth_us(1600); |
Eason0505 | 0:8bcd728684c5 | 27 | pc1.printf("cnv7 =%f\n\r",cnv); |
Eason0505 | 0:8bcd728684c5 | 28 | } else if(cnv > -108&& cnv <-72) { |
Eason0505 | 0:8bcd728684c5 | 29 | servo.pulsewidth_us(1700); |
Eason0505 | 0:8bcd728684c5 | 30 | pc1.printf("cnv8 =%f\n\r",cnv); |
Eason0505 | 0:8bcd728684c5 | 31 | } else if(cnv > -144&& cnv <-108) { |
Eason0505 | 0:8bcd728684c5 | 32 | servo.pulsewidth_us(1800); |
Eason0505 | 0:8bcd728684c5 | 33 | pc1.printf("cnv9 =%f\n\r",cnv); |
Eason0505 | 0:8bcd728684c5 | 34 | } else if(cnv > -180&& cnv <-144) { |
Eason0505 | 0:8bcd728684c5 | 35 | servo.pulsewidth_us(1900); |
Eason0505 | 0:8bcd728684c5 | 36 | pc1.printf("cnv10 =%f\n\r",cnv); |
Eason0505 | 0:8bcd728684c5 | 37 | } |
Eason0505 | 0:8bcd728684c5 | 38 | } |