Diff: sm_servo.cpp

Revision:

2:e9d928fd327a

Child:

3:1b7eb426247e

diff -r 8faddee0e52f -r e9d928fd327a sm_servo.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/sm_servo.cpp	Sat Sep 28 22:58:02 2019 +0000
@@ -0,0 +1,36 @@
+#include "sm_servo.h"
+
+PwmOut pwm_Servo(PE_9);
+E_STATE_SERVO e_stateServo;
+
+
+void init_sm_servo()
+{
+    pc.printf("init servo with pulse %d us",SERVO_PULSE_MIDDLE_US);
+    pwm_Servo.period_ms(SERVO_PERIOD_DURATION_MS);
+    pwm_Servo.pulsewidth_us(SERVO_PULSE_MIDDLE_US);
+    e_stateServo = SERVO_INIT;
+}
+
+void update_sm_servo()
+{
+ E_STATE_SERVO next_state;
+
+    switch(e_stateServo) {
+        case SERVO_INIT:
+            next_state = SERVO_COMMAND;
+            break;
+        case SERVO_COMMAND:
+            break;
+        default:
+        break;
+         }
+
+    e_stateServo = next_state;
+    return;
+}
+
+void output_sm_servo()
+{
+return;
+}
\ No newline at end of file