Diff: ServoMove.cpp

Revision:

0:8bcd728684c5

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/ServoMove.cpp	Mon Jan 07 11:19:49 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