void drive_test(){ int leftDistance = readLeft(); if(leftDistance > 80) { leftBackward(30); rightBackward(30); } else if( leftDistance < 70 ) { rightForward(30); leftForward(30); } }
void goBackward(){ rightBackward(); leftBackward(); }
void turnRight(){ rightBackward(); leftForward(); }
void pivotBackwardLeft(){ rightBackward(); __delay_cycles(6000000); stop(); }