Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <atx.h>
- void setup()
- {
- sw1_press();
- }
- void loop()
- {
- int i = analogRead(2);
- lcd ("#c%d",i);
- if(i>600)
- {
- motor_stop(ALL);
- sw1_press();
- }
- else
- {
- forward(20);
- }
- }
- void forward(int power)
- {
- motor(0,power);
- motor(1,power);
- motor(2,power);
- motor(3,power);
- }
- void spin_left(int power)
- {
- motor(0,-power);
- motor(1,-power);
- motor(2,power);
- motor(3,power);
- }
- void spin_right(int power)
- {
- motor(0,power);
- motor(1,power);
- motor(2,-power);
- motor(3,-power);
- }
- void forwardt(int power,int ms)
- {
- motor(0,power);
- motor(1,power);
- motor(2,power);
- motor(3,power);
- delay(ms);
- motor_stop(ALL);
- }
- void spin_leftt(int power,int ms)
- {
- motor(0,-power);
- motor(1,-power);
- motor(2,power);
- motor(3,power);
- delay(ms);
- motor_stop(ALL);
- }
- void spin_rightt(int power,int ms)
- {
- motor(0,power);
- motor(1,power);
- motor(2,-power);
- motor(3,-power);
- delay(ms);
- motor_stop(ALL);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement