Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- //#include <LiquidCrystal_I2C.h>
- //#include <Servo.h>
- //#include <LCD.h>
- //#include <delay.h>
- //#include <Wire.h>
- #include <ServoEx.h>
- ServoEx servo_bdil;
- ServoEx servo_arm;
- ServoEx servo_joint;
- //LiquidCrystal_I2C lcd(12, 11, 5, 4, 3, 2);
- void setup()
- {
- servo_bdil.attach(3);
- servo_arm.attach(10);
- servo_joint.attach(11);
- //lcd.begin(16, 2);
- //lcd.print("hello, world!");
- /*
- servo_bdil.detach();
- servo_arm.detach();
- servo_joint.detach();
- */
- }
- void loop()
- {
- Serial.print("Starting");
- servo_bdil.write(0);
- delay(6000);
- servo_arm.write(110);// starts at 110 needs to be here to initialise
- delay(1000);
- servo_joint.write(120); //initialise
- servo_arm.write(110);
- delay(3000); //change if needed time miliseconds
- servo_arm.write(15);
- servo_joint.write(0);
- delay(4000);//wait for bdil
- //starts at 0
- servo_arm.write(15);
- servo_bdil.write(60);//place bdil on solder
- delay(5000); //place wires
- servo_bdil.write(180);
- delay(6000);//big dely
- servo_arm.write(15);
- servo_joint.write(0);
- delay(3000);
- servo_arm.write(15);
- delay(2000);
- servo_bdil.write(120);//place bdil on cables
- delay(2000);//medium delay
- servo_arm.write(110);//back to start
- delay(2000);//medium delay
- servo_joint.write(120);
- delay(1000);//medium delay
- for (int i=0; i<4;i++)
- {
- servo_joint.write(100);
- delay(500);
- servo_joint.write(120);//X3
- delay(500);
- }
- delay(1000);
- servo_joint.write(120);
- Serial.print("Ending");
- servo_bdil.detach();
- servo_arm.detach();
- servo_joint.detach();
- int j = 1;
- while (j>-1)
- {
- j = j++;
- j=j%5;
- delay(5000);
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement