Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- import time
- import DobotAPI
- import DobotTypes
- from DobotControl import DobotControl
- class Robot(DobotControl):
- def __init__(self):
- super().__init__()
- if __name__ == '__main__':
- dobot = Robot()
- dobot.setAddr(Robot.search()[0])
- dobot.startRobot()
- #Write Your Code Here
- dobot.setARM(1) #0=Left 1=Right Arm
- dobot.setspeed(30,50)
- while True:
- sw1 = dobot.input_pin(10) #PIN 10 11 12 13
- dobot.output_pin(3,0)
- if sw1[0] == 0:
- dobot.output_pin(3,1)
- dobot.output_pin(2,0)
- dobot.moveTo(400.0000,0.0000,230.0000,0.0000) #x,y,z,r,Home position
- dobot.output_pin(18,1)
- dobot.output_pin(2,1)
- sw2 = dobot.input_pin(11)
- dobot.output_pin(3,0)
- if sw2[0] == 0:
- dobot.output_pin(3,1)
- dobot.output_pin(2,0)
- dobot.moveTo(327.4610,174.2116,80.8291,6.6419) #x,y,z,r,Home position
- dobot.output_pin(18,0)
- dobot.output_pin(2,1)
- sw3 = dobot.input_pin(12)
- dobot.output_pin(3,0)
- if sw3[0] == 0:
- dobot.output_pin(3,1)
- dobot.output_pin(2,0)
- dobot.moveTo(372.8180,6.3338,80.8291,5.9219) #x,y,z,r,Home position
- dobot.output_pin(2,1)
- sw4 = dobot.input_pin(13)
- dobot.output_pin(3,0)
- if sw4[0] == 0:
- dobot.output_pin(3,1)
- dobot.output_pin(2,0)
- dobot.moveTo(153.6960,149.2723,80.8291,92.7223) #x,y,z,r,Home position
- dobot.output_pin(2,1)
- #sw5 = dobot.input_pin(10,11)
- #dobot.output_pin(3,0)
- #if sw5[0] == 0:
- #dobot.output_pin(3,1)
- #dobot.output_pin(2,0)
- #dobot.moveTo(153.6960,149.2723,80.8291,92.7223)#x,y,z,r,Home position
- #dobot.output_pin(2,1)
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement