Advertisement
Guest User

4m20

a guest
Nov 15th, 2019
103
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.52 KB | None | 0 0
  1. import serial
  2. import time
  3.  
  4. port = 30010
  5. ee_port = "COM7"
  6.  
  7. if ee_port!=False:
  8. ee = serial.Serial(ee_port, 9600) # open serial port
  9.  
  10. def serial_send(cmd, var, wait):
  11. ipt = ""
  12. ee.reset_input_buffer()
  13. ee.write(str.encode(cmd + chr(var + 48) + "\n"))
  14. # wait for cmd acknowledgement
  15. while True:
  16. ipt = bytes.decode(ee.readline())
  17. # print("gripper data: ", ipt)
  18. if ipt == "received\r\n":
  19. break
  20. # wait for cmd completion
  21. if wait == True:
  22. while True:
  23. ipt = bytes.decode(ee.readline())
  24. # print("gripper data: ", ipt)
  25. if ipt == "done\r\n":
  26. # print("Completed gripper CMD")
  27. break
  28. return ipt
  29.  
  30. while ee.isOpen()==False:
  31. print("Waiting for hand")
  32. print("Serial port opened :)")
  33.  
  34. ee.send_break()
  35. time.sleep(1) # This is needed to allow MBED to send back command in time!
  36. ipt = bytes.decode(ee.readline())
  37. print("Connected to",ipt)
  38.  
  39. if ipt=="Rotary Gripper\r\n":
  40. print("Pump recognised")
  41. elif ipt=="Basic Gripper\r\n":
  42. print("Gripper recognised")
  43. else:
  44. print("NO GRIPPER DETECTED")
  45.  
  46. print('Moving on...')
  47. while 1:
  48. ipt = input('command for gripper?: ')
  49. if ipt == 'o':
  50. serial_send("G", 0, True)
  51. elif ipt == 'c':
  52. serial_send("G", 1, True)
  53. else:
  54. break
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement