#include "pbot.h" pbot PBOT; void setup() { // put your setup code here, to run once: PBOT.BEGIN(); } void loop() { // put your main code here, to run repeatedly: if( PBOT.COL1_RIGHT() == HIGH && PBOT.COL2_CENTER() == LOW && PBOT.COL3_LEFT() == HIGH) { fwd(); delay (2000); right_full(); delay (3000); } } void fwd(){ PBOT.DIRECTION(MOTOR_A,MOTOR_FWD); PBOT.DIRECTION(MOTOR_B,MOTOR_FWD); PBOT.SPEED(MOTOR_A, 80); PBOT.SPEED(MOTOR_B, 80); } void back(){ PBOT.DIRECTION(MOTOR_A,MOTOR_REV); PBOT.DIRECTION(MOTOR_B,MOTOR_REV); PBOT.SPEED(MOTOR_A, 80); PBOT.SPEED(MOTOR_B, 80); } void left(){ PBOT.DIRECTION(MOTOR_A,MOTOR_FWD); PBOT.DIRECTION(MOTOR_B,MOTOR_FWD); PBOT.SPEED(MOTOR_A, 0); PBOT.SPEED(MOTOR_B, 80); } void left_full(){ PBOT.DIRECTION(MOTOR_A,MOTOR_REV); PBOT.DIRECTION(MOTOR_B,MOTOR_FWD); PBOT.SPEED(MOTOR_A, 80); PBOT.SPEED(MOTOR_B, 80); } void right(){ PBOT.DIRECTION(MOTOR_A,MOTOR_FWD); PBOT.DIRECTION(MOTOR_B,MOTOR_FWD); PBOT.SPEED(MOTOR_A, 80); PBOT.SPEED(MOTOR_B, 0); } void right_full(){ PBOT.DIRECTION(MOTOR_A,MOTOR_FWD); PBOT.DIRECTION(MOTOR_B,MOTOR_REV); PBOT.SPEED(MOTOR_A, 80); PBOT.SPEED(MOTOR_B, 80); } void stop(){ PBOT.SPEED(MOTOR_A, 0); PBOT.SPEED(MOTOR_B, 0); } Please correct the code above. instruction: if the robot detects a wall in its right and left sensor, move forward for 2 seconds then rotate clockwise for 3 seconds.
#include "pbot.h"
pbot PBOT;
void setup() {
// put your setup code here, to run once:
PBOT.BEGIN();
}
void loop() {
// put your main code here, to run repeatedly:
if( PBOT.COL1_RIGHT() == HIGH && PBOT.COL2_CENTER() == LOW && PBOT.COL3_LEFT() == HIGH) {
fwd();
delay (2000);
right_full();
delay (3000);
}
}
void fwd(){
PBOT.DIRECTION(MOTOR_A,MOTOR_FWD);
PBOT.DIRECTION(MOTOR_B,MOTOR_FWD);
PBOT.SPEED(MOTOR_A, 80);
PBOT.SPEED(MOTOR_B, 80);
}
void back(){
PBOT.DIRECTION(MOTOR_A,MOTOR_REV);
PBOT.DIRECTION(MOTOR_B,MOTOR_REV);
PBOT.SPEED(MOTOR_A, 80);
PBOT.SPEED(MOTOR_B, 80);
}
void left(){
PBOT.DIRECTION(MOTOR_A,MOTOR_FWD);
PBOT.DIRECTION(MOTOR_B,MOTOR_FWD);
PBOT.SPEED(MOTOR_A, 0);
PBOT.SPEED(MOTOR_B, 80);
}
void left_full(){
PBOT.DIRECTION(MOTOR_A,MOTOR_REV);
PBOT.DIRECTION(MOTOR_B,MOTOR_FWD);
PBOT.SPEED(MOTOR_A, 80);
PBOT.SPEED(MOTOR_B, 80);
}
void right(){
PBOT.DIRECTION(MOTOR_A,MOTOR_FWD);
PBOT.DIRECTION(MOTOR_B,MOTOR_FWD);
PBOT.SPEED(MOTOR_A, 80);
PBOT.SPEED(MOTOR_B, 0);
}
void right_full(){
PBOT.DIRECTION(MOTOR_A,MOTOR_FWD);
PBOT.DIRECTION(MOTOR_B,MOTOR_REV);
PBOT.SPEED(MOTOR_A, 80);
PBOT.SPEED(MOTOR_B, 80);
}
void stop(){
PBOT.SPEED(MOTOR_A, 0);
PBOT.SPEED(MOTOR_B, 0);
}
Please correct the code above.
instruction: if the robot detects a wall in its right and left sensor, move forward for 2 seconds then rotate clockwise for 3 seconds.
Step by step
Solved in 2 steps
