Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <Servo.h>
- Servo servo_pin_11;
- Servo servo_pin_10;
- void Stop();
- void left();
- void Forward(int iDelay);
- void right();
- void setup()
- {
- servo_pin_11.attach(11);
- servo_pin_10.attach(10);
- Forward(4);
- left();
- Forward(4);
- left();
- Forward(3);
- right();
- Forward(3.7);
- right();
- Forward(8);
- right();
- Forward(3.7);
- right();
- Forward(2);
- left();
- Forward(4);
- left();
- Forward(8);
- left();
- Forward(10);
- left();
- Forward(2);
- left();
- Forward(8);
- Stop();
- }
- void loop()
- {
- }
- void Stop()
- {
- servo_pin_11.write( 90 );
- servo_pin_10.write( 90 );
- delay( 999 );
- }
- void right()
- {
- servo_pin_11.write( 135 );
- servo_pin_10.write( 135 );
- delay( 310 );
- }
- void Forward(int iDelay)
- {
- servo_pin_11.write( 135 );
- servo_pin_10.write( 45 );
- delay( 480*iDelay );
- }
- void left()
- {
- servo_pin_11.write( 45 );
- servo_pin_10.write( 45 );
- delay( 310 );
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement