#include "Main.h"

void main (void)
{
// Variable & Char declaration
char front_bumper;
char rear_bumper;

front_bumper = GetDigitalInput ( 1 ); // Current front bumper state
rear_bumper = GetDigitalInput ( 1 ); // Current back bumper state
PrintToScreen ( "Front Bumper =%d\n", front_bumper ); // Print the front state
PrintToScreen ( "Back Bumper =%d\n", rear_bumper ); // Print the back state
JoystickToMotor ( 1, 1, 1, 0 );

if (front_bumper == 0) // Turns off the bot (front)
{

SetMotor( 1, 0);
SetMotor( 10, 0);
}
if (rear_bumper == 0) // Turns off the bot (back)
{

SetMotor( 1, 0);
SetMotor( 10, 0);
}
Arcade2( 1, 2, 1, 1, 10, 1, 0); // Motor config (TODO: Compare Tank2)
}