This is our code for our hybrid, and we honestly have no idea what is wrong, it constantly blasts forward, even after a new button is hit
Code:
void Autonomous(void)
{
int move, othermove;
//printf("Time=%lu", Get_Time( ));
if ((rc_dig_in01 + rc_dig_in02 + rc_dig_in03 + rc_dig_in04) > 1)
{
rc_dig_in01 = rc_dig_in02 = rc_dig_in03 = rc_dig_in04 = 0;
}
othermove = move;
if (rc_dig_in01 == 1) {
move = 1;
}
else if (rc_dig_in02 == 1) {
move = 2;
}
else if (rc_dig_in03 == 1) {
move = 3;
}
else if (rc_dig_in04 == 1) {
move = 4;
}
else {
move = othermove;
}
printf("Move: %d In01: %d, In02: %d, In03: %d, In04: %d \r \n", move, rc_dig_in01, rc_dig_in02, rc_dig_in03, rc_dig_in04);
if (move == 0)
{
pwm01 = 127;
pwm02 = 127;
pwm03 = 127;
pwm04 = 127;
}
else if (move == 1) {
pwm01 = 187;
pwm02 = 67;
pwm03 = 187;
pwm04 = 67;
}
else if (move == 2) {
pwm01 = 187;
pwm02 = 187;
pwm03 = 67;
pwm04 = 67;
}
else if (move == 3) {
pwm01 = 67;
pwm02 = 187;
pwm03 = 67;
pwm04 = 187;
}
else if (move == 4) {
pwm01 = 67;
pwm02 = 67;
pwm03 = 187;
pwm04 = 187;
}
else {
pwm01 = 127;
pwm02 = 127;
pwm03 = 127;
pwm04 = 127;
}
}
Any help would be very appreciated.