![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
a
Dependencies: MotorDriver_SU mbed
linetrace.cpp
- Committer:
- 12f2030a
- Date:
- 2014-10-16
- Revision:
- 0:47cd78404bd9
File content as of revision 0:47cd78404bd9:
#include "mbed.h" #include "MotorDriver_SU.h" DigitalIn sensor1(); DigitalIn sensor2(); DigitalOut led1(); DigitalOut led2(); MotorDriver_SU motor(MOTOR_DOUBLE); MotorDriver_SU lift(MOTOR_SINGLE); int main(){ while(1){ if(sensor1 == 0 && sensor2 == 0){ motor.Drive(0,CW,3000); motor.Drive(1,CW,3000); lift.Drive(0,CW,3000); led1 = 1; } else if(sensor1 == 0 && sensor2 == 1){ motor.Drive(0,CW,3000); motor.Drive(1,CCW,1500); led1 = 0; } else if(snsor1 == 1 && sensor2 == 0){ motor.Drive(0,CCW,1500); motor.Drive(1,CW,3000); led2 = 1; } else if(sensor == 1 && sensor ==1){ motor.Drive(0,CCW,3000); motor.Drive(1,CCW,3000); led2 = 0; } } }