Lin ShengKun / Mbed OS NYP_FYP

FYP

Dependencies:   LSM6DSL

Fork of humanoid by Junjie Wang

main.cpp

Committer:
ha731548874
Date:
2018-05-24
Revision:
4:45bd9ba6c0da
Parent:
3:1345f959c490

File content as of revision 4:45bd9ba6c0da:

#include "mbed.h"
#include "rtos.h"
//#include "kondo1.h"
#include "kondo2.h"
//#include "kondo3.h"
#include "servo.h"
#include "accgyro.h"
DigitalOut led2(LED2);
Thread event_thread;
Thread ACCGYRO_thread;
//Thread KONDO1_thread;
Thread KONDO2_thread;
//Thread KONDO3_thread;
//Thread KONDO1_Degrees_Set_thread;
Thread KONDO2_Degrees_Set_thread;
//Thread KONDO3_Degrees_Set_thread;
EventQueue event_queue;
int main()
{   
    ACCGYRO_thread.start(ACCGYRO_init);
//    KONDO1_thread.start(KONDO1_init);
    KONDO2_thread.start(KONDO2_init);
//    KONDO3_thread.start(KONDO3_init);
//    KONDO1_Degrees_Set_thread.start(KONDO1_Degrees_Set);
    KONDO2_Degrees_Set_thread.start(KONDO2_Degrees_Set);
//    KONDO3_Degrees_Set_thread.start(KONDO3_Degrees_Set);
    while(1)
    {
        led2 = !led2;
        wait(1);
    }
}