TRR 2018 / Mbed 2 deprecated biniou-TRR2019-DLVV

Dependencies:   mbed MPU6050

main.cpp

Committer:
GaspardD
Date:
2019-09-29
Revision:
4:efa207509f63
Parent:
3:1b7eb426247e
Child:
5:8bbe640528bc

File content as of revision 4:efa207509f63:

#include "sm_esc.h"
#include "sm_servo.h"
#include "sm_sections.h"

int main()
{
    //init timers
    timerSinceStart.start();

    //init_interruptions
    button.fall(&it_pressed);  
    odom.fall(&it_odom);

    //init state machines
    pc.printf("init state machines\r\n");

    output_sm_esc();
    init_sm_servo();

    while(1) {
        
        update_sm_esc();
        update_sm_servo();

        output_sm_esc();
        output_sm_servo();
    }
}