main.cpp

00001 #include "mbed.h"
00002 #include "StepperMotor.h"
00003 
00004 BusOut          leds( LED4, LED3, LED2, LED1 );
00005 StepperMotor    m( p21, p22, p23, p24 );
00006 
00007 int main() {
00008     m.set_sync_mode( StepperMotor::SYNCHRONOUS );
00009     m.set_power_ctrl( true );
00010 
00011     while ( 1 ) {
00012     
00013         leds    = 1;
00014         m.go_angle( 120 );
00015         wait( 0.5 );
00016 
00017         leds    = 2;
00018         m.go_angle( 240 );
00019         wait( 0.5 );
00020 
00021         leds    = 3;
00022         m.go_angle( 0 );
00023         wait( 0.5 );
00024 
00025         leds    = 4;
00026         m.go_angle( 240 );
00027         wait( 0.5 );
00028 
00029         leds    = 5;
00030         m.go_angle( 120 );
00031         wait( 0.5 );
00032 
00033         leds    = 6;
00034         m.go_angle( 0 );
00035         wait( 0.5 );
00036     }
00037 }