Jamie Bignell / Mbed 2 deprecated Nucleo_blink_led

test

Dependencies:   mbed

Dependents:   MouseHybridSenseCode

findLineFunc.cpp

Committer:
JamieBignell
Date:
2018-03-11
Revision:
5:dfea493f7a12
Child:
6:a652deaae134

File content as of revision 5:dfea493f7a12:

#include <mbed.h>
#include <funcdef.h>

void findLineFunc()
{
    //TURN RIGHT UNTIL SENSOR A6, POSITION 6, BEATS THERSHOLD
    while (((sensorPin[6]).read_u16()>>4) < (sensorThreshold[6]))  
    {
        //LEFT WHEEL STARTS TURN  
        leftMotorVal.pulsewidth_us(300); 
        rightMotorVal.pulsewidth_us(0);  
    }
    //CONTINUE FOR A BIT, THEN STOP MOTORS AND RETURN
    wait_ms(100);
    leftMotorVal.pulsewidth_us(0); 
    rightMotorVal.pulsewidth_us(0);
    return;       
}