Drive.c
· 744 B · C
Raw
// pause
ao();
msleep(2000);"
// forward
motor (0,100);
motor (3,100);
msleep (250);"
// 90 degree turn right
motor(0,0);
motor(3,100);
msleep (1500);"
// 90 degree turn Left
motor(0,100);
motor(3,0);
msleep (1500);
/*Counts "ticks"-complete wheel rotation
Your motors have approximately 1820 ticks per revolution
*/
// motor position counter
clear_motor_position_counter(3);
while (get_motor_position_counter(3) < 4000)
{
motor(3,50);
motor (0,50);
}
ao();
//if using MAV
void Move(int l_power,int r_power,int time)
{mav(0,l_power);
mav(3,r_power);
msleep(time);
ao();
sleep(100); }
| 1 | // pause |
| 2 | ao(); |
| 3 | msleep(2000);" |
| 4 | |
| 5 | |
| 6 | // forward |
| 7 | motor (0,100); |
| 8 | motor (3,100); |
| 9 | msleep (250);" |
| 10 | |
| 11 | |
| 12 | // 90 degree turn right |
| 13 | motor(0,0); |
| 14 | motor(3,100); |
| 15 | msleep (1500);" |
| 16 | |
| 17 | |
| 18 | // 90 degree turn Left |
| 19 | motor(0,100); |
| 20 | motor(3,0); |
| 21 | msleep (1500); |
| 22 | |
| 23 | |
| 24 | /*Counts "ticks"-complete wheel rotation |
| 25 | Your motors have approximately 1820 ticks per revolution |
| 26 | */ |
| 27 | // motor position counter |
| 28 | clear_motor_position_counter(3); |
| 29 | while (get_motor_position_counter(3) < 4000) |
| 30 | { |
| 31 | motor(3,50); |
| 32 | motor (0,50); |
| 33 | } |
| 34 | ao(); |
| 35 | |
| 36 | |
| 37 | //if using MAV |
| 38 | void Move(int l_power,int r_power,int time) |
| 39 | {mav(0,l_power); |
| 40 | mav(3,r_power); |
| 41 | msleep(time); |
| 42 | ao(); |
| 43 | sleep(100); } |
Comments
No comments yet.
Log in to leave a comment.