Jamie Bignell / Mbed 2 deprecated Nucleo_blink_led

test

Dependencies:   mbed

Dependents:   MouseHybridSenseCode

findLineFunc.cpp

Committer:
JamieBignell
Date:
2018-04-01
Revision:
6:a652deaae134
Parent:
5:dfea493f7a12
Child:
7:11dd5581c763

File content as of revision 6:a652deaae134:

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

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