Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <atx.h>
- #define LFM 0
- #define LBM 1
- #define RFM 5
- #define RBM 4
- void setup()
- {
- sw1_press();
- }
- void loop()
- {
- go_forward(100,1200);
- turn_right(70,750);
- go_forward(100,1200);
- turn_left(70,750);
- go_forward(100,1300);
- turn_left(70,750);
- go_forward(100,1200);
- turn_left(70,700);
- go_forward(100,1200);
- turn_left(70,700);
- go_forward(100,1200);
- turn_right(70,750);
- go_forward(100,1200);
- turn_right(70,750);
- go_forward(100,1200);
- sw1_press();
- }
- void go_forward(int power,int ms)
- {
- motor(LFM,power);
- motor(LBM,power);
- motor(RFM,power);
- motor(RBM,power);
- delay(ms);
- motor_stop(ALL);
- }
- void turn_right(int power,int ms)
- {
- motor(LFM,power);
- motor(LBM,power);
- motor(RFM,-power);
- motor(RBM,-power);
- delay(ms);
- motor_stop(ALL);
- }
- void turn_left(int power,int ms)
- {
- motor(LFM,-power);
- motor(LBM,-power);
- motor(RFM,power);
- motor(RBM,power);
- delay(ms);
- motor_stop(ALL);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement