DIFF= 360-ABSDIFF;
LMotor_Speed = 2;
RMotor_Speed = 1;}
else{/*Left turn*/
DIFF = 360-ABSDIFF;
LMotor_Speed = 1;
RMotor_Speed = 2;}
}
Motor();
}
for (i = 1; i <= 25000; i++);
/*Forward movement.*/
if (DIST > 20){/*Move forward*/
LMotor_Speed = 2;
RMotor_Speed = 2;
Motor();
for (i = 1; i <= 150000; i++);}
else{/*Motors Stop*/
LMotor_Speed = 1.5;
RMotor_Speed = 1.5;
Motor();}
yield;
}
//EXIT FROM LOOP DANCE
/*Motors Stop*/
LMotor_Speed = 1.5;
RMotor_Speed = 1.5;
Motor();
for (i = 1; i <= 50000; i++);
/*Right Turn*/
LMotor_Speed = 2;
RMotor_Speed = 1;
Motor();
Comentarios a estos manuales