
test
Dependencies: MbedJSONValue DISCO_L475VG_IOT01A_wifi mbed-http
ServoMove.cpp
- Committer:
- Eason0505
- Date:
- 2019-01-01
- Revision:
- 0:065178c282bd
File content as of revision 0:065178c282bd:
#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); } }