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,1000);
- turn_right(65,400);
- go_forward(100,1000);
- turn_right(65,400);
- go_forward(100,1000);
- turn_right(65,400);
- go_forward(100,1000);
- 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);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement