test
Dependencies: MbedJSONValue DISCO_L475VG_IOT01A_wifi mbed-http
Diff: ServoMove.cpp
- Revision:
- 0:065178c282bd
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/ServoMove.cpp Tue Jan 01 11:48:52 2019 +0000 @@ -0,0 +1,38 @@ +#include "ServoMove.h" +PwmOut servo(PA_6); +Serial pc1(USBTX, USBRX); + +void ServoConvert(double cnv) +{ + if (cnv > 144) { + servo.pulsewidth_us(1000); //0deg + pc1.printf("cnv1 =%f\n\r",cnv); + } else if(cnv >108 && cnv <144) { + servo.pulsewidth_us(1100); + pc1.printf("cnv2 =%f\n\r",cnv); + } else if (cnv >72 && cnv <108) { + servo.pulsewidth_us(1200); + pc1.printf("cnv3 =%f\n\r",cnv); + } else if (cnv > 36&& cnv <72) { + servo.pulsewidth_us(1300); + pc1.printf("cnv4 =%f\n\r",cnv); + } else if(cnv > 0&& cnv <36) { + servo.pulsewidth_us(1400); + pc1.printf("cnv5 =%f\n\r",cnv); + } else if(cnv > -36&& cnv <0) { + servo.pulsewidth_us(1500); + pc1.printf("cnv6 =%f\n\r",cnv); + } else if(cnv > -72&& cnv <-36) { + servo.pulsewidth_us(1600); + pc1.printf("cnv7 =%f\n\r",cnv); + } else if(cnv > -108&& cnv <-72) { + servo.pulsewidth_us(1700); + pc1.printf("cnv8 =%f\n\r",cnv); + } else if(cnv > -144&& cnv <-108) { + servo.pulsewidth_us(1800); + pc1.printf("cnv9 =%f\n\r",cnv); + } else if(cnv > -180&& cnv <-144) { + servo.pulsewidth_us(1900); + pc1.printf("cnv10 =%f\n\r",cnv); + } +} \ No newline at end of file