test program

Dependencies:   LSM9DS1_Library2 MotorV2 SRF05 Tracker2 mbed nRF24L01P

Fork of DUMP_TRUCK_SPR2017 by Terrabots

main.cpp

Committer:
simplyellow
Date:
2017-03-14
Revision:
11:87f30625b213
Parent:
10:cf77da9be0b8
Child:
13:112b6543909a

File content as of revision 11:87f30625b213:

#include "DumpTruck.h"
DumpTruck dump(1);

/*
test code for driving and stopping when an object gets too close
to the dump truck.
*/

int main() {
    
    while(1) {        
        printf("%f\r\n",(float)dump.detect());
        if(dump.detect()) {
            dump.stop();
        } else {
            dump.drive(0.5f);
        }
    }
    
}