TRR 2018 / Mbed 2 deprecated biniou-TRR2019-DLVV

Dependencies:   mbed MPU6050

sm_servo.cpp

Committer:
GaspardD
Date:
2019-09-28
Revision:
2:e9d928fd327a
Child:
3:1b7eb426247e

File content as of revision 2:e9d928fd327a:

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