Dependencies: mbed Motordriver QEI
main.cpp@1:19d647492936, 2011-11-10 (annotated)
- Committer:
- Keisuke_Fujii
- Date:
- Thu Nov 10 13:29:43 2011 +0000
- Revision:
- 1:19d647492936
- Parent:
- 0:993cd673f077
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Keisuke_Fujii | 1:19d647492936 | 1 | #include "library.h" |
Keisuke_Fujii | 1:19d647492936 | 2 | #include "motor.h" |
Keisuke_Fujii | 1:19d647492936 | 3 | #include "servo.h" |
Keisuke_Fujii | 0:993cd673f077 | 4 | |
Keisuke_Fujii | 0:993cd673f077 | 5 | int main( int argc, char **argv ) |
Keisuke_Fujii | 0:993cd673f077 | 6 | { |
Keisuke_Fujii | 1:19d647492936 | 7 | char s; |
Keisuke_Fujii | 0:993cd673f077 | 8 | float d = 0.5; |
Keisuke_Fujii | 1:19d647492936 | 9 | |
Keisuke_Fujii | 1:19d647492936 | 10 | setSystemFrequency( 0x3, 0x1, 12, 1 ); // M=12, N=1, 96MHz |
Keisuke_Fujii | 1:19d647492936 | 11 | |
Keisuke_Fujii | 0:993cd673f077 | 12 | device.baud( 115200 ); |
Keisuke_Fujii | 1:19d647492936 | 13 | servo.baud( 115200 ); |
Keisuke_Fujii | 1:19d647492936 | 14 | led1.period_us( 10 ); |
Keisuke_Fujii | 1:19d647492936 | 15 | led2.period_us( 10 ); |
Keisuke_Fujii | 0:993cd673f077 | 16 | right_pwm.period_us( 10 ); |
Keisuke_Fujii | 0:993cd673f077 | 17 | left_pwm.period_us( 10 ); |
Keisuke_Fujii | 1:19d647492936 | 18 | enable.write( 1.0 ); |
Keisuke_Fujii | 1:19d647492936 | 19 | led1.write( 1.0 ); |
Keisuke_Fujii | 1:19d647492936 | 20 | led2.write( 1.0 ); |
Keisuke_Fujii | 0:993cd673f077 | 21 | |
Keisuke_Fujii | 1:19d647492936 | 22 | device.printf("Start:'0'\n"); |
Keisuke_Fujii | 1:19d647492936 | 23 | while( s != 0 ) |
Keisuke_Fujii | 0:993cd673f077 | 24 | { |
Keisuke_Fujii | 1:19d647492936 | 25 | s = device.getc(); |
Keisuke_Fujii | 0:993cd673f077 | 26 | } |
Keisuke_Fujii | 1:19d647492936 | 27 | //control_servo(); |
Keisuke_Fujii | 1:19d647492936 | 28 | qei(); |
Keisuke_Fujii | 0:993cd673f077 | 29 | } |