Dependencies:   mbed Motordriver QEI

Committer:
Keisuke_Fujii
Date:
Thu Nov 10 13:29:43 2011 +0000
Revision:
1:19d647492936
Parent:
0:993cd673f077

        

Who changed what in which revision?

UserRevisionLine numberNew 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 }