Advertisement
big_cee223

Robotics

Sep 15th, 2024
96
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
Python 1.69 KB | Software | 0 0
  1. import time
  2.  
  3. import DobotAPI
  4. import DobotTypes
  5. from DobotControl import DobotControl
  6.  
  7. class Robot(DobotControl):
  8.     def __init__(self):
  9.         super().__init__()
  10.  
  11. if __name__ == '__main__':
  12.     dobot = Robot()
  13.     dobot.setAddr(Robot.search()[0])
  14.     dobot.startRobot()
  15.  
  16.     #Write Your Code Here
  17. dobot.setARM(1) #0=Left 1=Right Arm
  18. dobot.setspeed(30,50)
  19.  
  20. while True:
  21.     sw1 = dobot.input_pin(10) #PIN 10 11 12 13
  22.     dobot.output_pin(3,0)
  23.     if sw1[0] == 0:
  24.         dobot.output_pin(3,1)
  25.         dobot.output_pin(2,0)
  26.         dobot.moveTo(400.0000,0.0000,230.0000,0.0000) #x,y,z,r,Home position
  27.         dobot.output_pin(18,1)
  28.         dobot.output_pin(2,1)
  29.     sw2 = dobot.input_pin(11)
  30.     dobot.output_pin(3,0)
  31.     if sw2[0] == 0:
  32.         dobot.output_pin(3,1)
  33.         dobot.output_pin(2,0)
  34.         dobot.moveTo(327.4610,174.2116,80.8291,6.6419) #x,y,z,r,Home position
  35.         dobot.output_pin(18,0)
  36.         dobot.output_pin(2,1)
  37.     sw3 = dobot.input_pin(12)
  38.     dobot.output_pin(3,0)
  39.     if sw3[0] == 0:
  40.         dobot.output_pin(3,1)
  41.         dobot.output_pin(2,0)
  42.         dobot.moveTo(372.8180,6.3338,80.8291,5.9219) #x,y,z,r,Home position
  43.         dobot.output_pin(2,1)
  44.     sw4 = dobot.input_pin(13)
  45.     dobot.output_pin(3,0)
  46.     if sw4[0] == 0:
  47.         dobot.output_pin(3,1)
  48.         dobot.output_pin(2,0)
  49.         dobot.moveTo(153.6960,149.2723,80.8291,92.7223) #x,y,z,r,Home position
  50.         dobot.output_pin(2,1)
  51.     #sw5 = dobot.input_pin(10,11)
  52.     #dobot.output_pin(3,0)
  53.     #if sw5[0] == 0:
  54.         #dobot.output_pin(3,1)
  55.         #dobot.output_pin(2,0)
  56.         #dobot.moveTo(153.6960,149.2723,80.8291,92.7223)#x,y,z,r,Home position
  57.         #dobot.output_pin(2,1)
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement