A_NYP_humanoid
Fork of A_NYP_humanoid by
main.cpp
- Committer:
- mr_wang
- Date:
- 2018-04-30
- Revision:
- 0:0ea84b3cf851
File content as of revision 0:0ea84b3cf851:
#include "mbed.h"
#include "rtos.h"
#include "accgyro.h"
//Serial pc(USBTX, USBRX);
DigitalOut led2(LED2);
Thread eventthread;
EventQueue eventqueue;
int main()
{
ACCGYRO_init();
eventthread.start(callback(&eventqueue, &EventQueue::dispatch_forever));
//ACCGYRO_thread.start(ACCGYRO_init);
//Thread::wait(osWaitForever);
eventqueue.call_every(1000, ACCGYRO_task);
//q.dispatch();
//eventqueue.call_every(1000,printf,"LSM6DSL [acc/mg]: %6ld\r\n", ACCGYRO_get_gyro_x());
//q.dispatch();
while(1)
{
eventqueue.call(printf,"LSM6DSL [acc/mg]: %6ld\r\n", ACCGYRO_get_gyro_x());
led2 = !led2;
wait(1);
//q.dispatch();
//q.call(printf, "*\n");
//printf("*");
//Thread::wait(1000);
//printf("LSM6DSL [acc/mg]: %6ld\r\n", ACCGYRO_get_gyro_x());
//printf("LSM6DSL [gyro/mdps]: %6ld, %6ld, %6ld\r\n", axes[0], axes[1], axes[2]);
}
}
