Lin ShengKun
/
NYP_FYP
FYP
Fork of humanoid by
main.cpp@4:45bd9ba6c0da, 2018-05-24 (annotated)
- 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?
User | Revision | Line number | New 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 | } |