Diff: ServoRun.cpp

Revision:

1:7530b7eb757a

Child:

4:217334c3a5b2

diff -r 5a9619496af2 -r 7530b7eb757a ServoRun.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/ServoRun.cpp	Thu May 28 02:30:39 2020 +0000
@@ -0,0 +1,47 @@
+#include "mbed.h"
+#include "max32630fthr.h"
+#include "USBSerial.h"
+#include "I2CSlave.h"
+#include "CmdHandler.h"
+#include "DUT_RegConfig.h"
+#include "AVDD_CONFIG.h"
+#include "ServoRun.h"
+
+extern DigitalOut PULSE;
+extern DigitalOut DI;
+
+uint32_t servo_run = 0;
+
+void ServoRunThread(void)
+{    
+    uint32_t step = 0;
+    
+    while(1)
+    {    
+        if(servo_run)
+        {
+            step = servo_run * 40;
+            while(step--)
+            {
+                PULSE = 1;
+                wait_ms(1);
+                PULSE = 0;
+                wait_ms(1);
+            }  
+            servo_run = 0;          
+        }        
+        wait_ms(100);
+    }    
+}
+
+void ServoRun(uint8_t dir, uint32_t mm)
+{
+     DI = dir;
+     servo_run = mm;   
+}
+
+uint32_t CheckUntil(void)
+{
+    return servo_run;
+}
+