FYP

Dependencies:   LSM6DSL

Fork of humanoid by Junjie Wang

Committer:
ha731548874
Date:
Thu May 24 08:29:52 2018 +0000
Revision:
4:45bd9ba6c0da
Parent:
3:1345f959c490
NYP_humaniod_FYP

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mr_wang 0:0ea84b3cf851 1 #include "mbed.h"
mr_wang 0:0ea84b3cf851 2 #include "rtos.h"
ha731548874 4:45bd9ba6c0da 3 //#include "kondo1.h"
ha731548874 4:45bd9ba6c0da 4 #include "kondo2.h"
ha731548874 4:45bd9ba6c0da 5 //#include "kondo3.h"
mr_wang 3:1345f959c490 6 #include "servo.h"
mr_wang 0:0ea84b3cf851 7 #include "accgyro.h"
mr_wang 0:0ea84b3cf851 8 DigitalOut led2(LED2);
mr_wang 3:1345f959c490 9 Thread event_thread;
mr_wang 3:1345f959c490 10 Thread ACCGYRO_thread;
ha731548874 4:45bd9ba6c0da 11 //Thread KONDO1_thread;
ha731548874 4:45bd9ba6c0da 12 Thread KONDO2_thread;
ha731548874 4:45bd9ba6c0da 13 //Thread KONDO3_thread;
ha731548874 4:45bd9ba6c0da 14 //Thread KONDO1_Degrees_Set_thread;
ha731548874 4:45bd9ba6c0da 15 Thread KONDO2_Degrees_Set_thread;
ha731548874 4:45bd9ba6c0da 16 //Thread KONDO3_Degrees_Set_thread;
mr_wang 3:1345f959c490 17 EventQueue event_queue;
mr_wang 0:0ea84b3cf851 18 int main()
ha731548874 2:7d574b1ab3cd 19 {
mr_wang 3:1345f959c490 20 ACCGYRO_thread.start(ACCGYRO_init);
ha731548874 4:45bd9ba6c0da 21 // KONDO1_thread.start(KONDO1_init);
ha731548874 4:45bd9ba6c0da 22 KONDO2_thread.start(KONDO2_init);
ha731548874 4:45bd9ba6c0da 23 // KONDO3_thread.start(KONDO3_init);
ha731548874 4:45bd9ba6c0da 24 // KONDO1_Degrees_Set_thread.start(KONDO1_Degrees_Set);
ha731548874 4:45bd9ba6c0da 25 KONDO2_Degrees_Set_thread.start(KONDO2_Degrees_Set);
ha731548874 4:45bd9ba6c0da 26 // KONDO3_Degrees_Set_thread.start(KONDO3_Degrees_Set);
mr_wang 0:0ea84b3cf851 27 while(1)
mr_wang 0:0ea84b3cf851 28 {
mr_wang 0:0ea84b3cf851 29 led2 = !led2;
mr_wang 0:0ea84b3cf851 30 wait(1);
mr_wang 0:0ea84b3cf851 31 }
mr_wang 0:0ea84b3cf851 32 }