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;
                    }
              }
            }