Advertisement
Guest User

Untitled

a guest
Jun 18th, 2019
78
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.70 KB | None | 0 0
  1. try:
  2. s = ""
  3. vision_server_client.send("g".encode()) # send 'g' to get response
  4. clock.tick(5)
  5. s = vision_server_client.recv(10000) # there must be a better way to do this
  6. markersDict = json.loads(s.decode())
  7. except:
  8. continue
  9.  
  10. aruco_markers = markersDict["aruco"]
  11.  
  12. for m in aruco_markers:
  13. x = int(m['center']['x'])
  14. y = int(m['center']['y'])
  15. s = int(m['size'])
  16. h = (m['heading'])
  17. marker_id = int(m['ID'])
  18. corners = m['markerCorners']
  19.  
  20. try:
  21. xm, ym, zm, roll_marker, pitch_marker, yaw_marker = getMarkerAttitude(corners, 10) # for extra info, openCV needed
  22. except:
  23. pass
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement