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);
    }
}