Junjie Wang / Mbed OS a_NYP_humanoid_copy

NYP_Humanoid_robot_FYP_2018

Dependencies:   LSM6DSL

Fork of b_NYP_humanoid by Junjie Wang

Diff: main.cpp

Revision:
2:7d574b1ab3cd
Parent:
0:0ea84b3cf851
Child:
3:1345f959c490
--- a/main.cpp	Mon Apr 30 11:23:06 2018 +0000
+++ b/main.cpp	Wed May 02 03:33:15 2018 +0000
@@ -8,11 +8,13 @@
 EventQueue eventqueue;
 
 int main()
-{
+{   
+    SERVO_init();
     ACCGYRO_init();
     eventthread.start(callback(&eventqueue, &EventQueue::dispatch_forever));
     //ACCGYRO_thread.start(ACCGYRO_init);
     //Thread::wait(osWaitForever);
+    //eventqueue.call_every(1000, SERVO_task);
     eventqueue.call_every(1000, ACCGYRO_task);
     //q.dispatch();
     //eventqueue.call_every(1000,printf,"LSM6DSL [acc/mg]:        %6ld\r\n", ACCGYRO_get_gyro_x());