void go_left(){ right_stop(); left_forward(); }
void com_menu_program(void){ outchar_com(current_com_character); outchar_com('6'); if(current_com_character == '2') if(current_com_character == '3') if(current_com_character == '7') switch (current_com_character) { case 'W': case 'w': display_2 = "Forward"; posL2 = RESET; Display_Process(); left_forward(3500); right_forward(3000); __delay_cycles(8000000); left_forward(RESET); right_forward(RESET); display_2 = ""; posL4 = RESET; Display_Process(); break; case 'X': case 'x': display_2 = "Reverse"; posL2 = RESET; Display_Process(); left_reverse(3000); right_reverse(3000); __delay_cycles(2500000); left_reverse(0); right_reverse(0); display_2 = ""; posL4 = RESET; break; case 'D': case 'd': display_2 = "Left"; posL2 = RESET; Display_Process(); left_forward(3000); right_reverse(3000); __delay_cycles(2500000); left_forward(0); right_reverse(0); display_2 = ""; posL4 = RESET; break; case 'A': case 'a': display_2 = "Left"; posL2 = RESET; Display_Process(); right_forward(3000); left_reverse(3000); __delay_cycles(2500000); right_forward(0); left_reverse(0); //waitForSeconds(6); display_2 = ""; posL4 = RESET; break; case 'S': display_2 = "Right"; posL2 = RESET; Display_Process(); right_reverse(3000); left_forward(3000); __delay_cycles(2500000); right_reverse(0); left_forward(0); //waitForSeconds(6); display_2 = ""; posL4 = RESET; display_2 = "Right"; posL2 = RESET; Display_Process(); right_reverse(3000); left_forward(3000); __delay_cycles(2500000); right_forward(0); left_reverse(0); //waitForSeconds(6); display_2 = ""; posL4 = RESET; break; case 's': display_2 = "Left"; posL2 = RESET; Display_Process(); right_forward(3000); left_reverse(3000); __delay_cycles(2500000); right_forward(0); left_reverse(0); //waitForSeconds(6); display_2 = ""; posL4 = RESET; display_2 = "Right"; posL2 = RESET; Display_Process(); right_reverse(3000); left_forward(3000); __delay_cycles(2500000); right_reverse(0); left_forward(0); //waitForSeconds(6); display_2 = ""; posL4 = RESET; break; case 'F': follow_toggle = 1; line_int_toggle = 1; Line_Follow(); break; case 'f': follow_toggle = 0; Line_Follow(); right_stop(); left_stop(); break; default: left_forward(0); right_reverse(0); left_reverse(0); right_forward(0); } waitForSeconds(1); current_com_character = 0x00; print_com_CR(); //------------------------------------------------------------------------------ }
void stop() { left_stop(); right_stop(); }