DeviceSearchAndConnect.py 1.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566
  1. from pickle import FALSE, TRUE
  2. import sys
  3. sys.path.append('../../../')
  4. from Tof3DCamera.VzenseDS_api import *
  5. import time
  6. camera = VzenseTofCam()
  7. camera_count = camera.VZ_GetDeviceCount()
  8. retry_count = 100
  9. while camera_count==0 and retry_count > 0:
  10. retry_count = retry_count-1
  11. camera_count = camera.VZ_GetDeviceCount()
  12. time.sleep(1)
  13. print("scaning...... ",retry_count)
  14. device_info=VzDeviceInfo()
  15. if camera_count > 1:
  16. ret,device_infolist=camera.VZ_GetDeviceInfoList(camera_count)
  17. if ret==0:
  18. device_info = device_infolist[0]
  19. for info in device_infolist:
  20. print('cam uri: ' + str(info.uri))
  21. else:
  22. print(' failed:' + ret)
  23. exit()
  24. elif camera_count == 1:
  25. ret,device_info=camera.VZ_GetDeviceInfo()
  26. if ret==0:
  27. print('cam productName:' + str(device_info.productName))
  28. print('cam uri:' + str(device_info.uri))
  29. print('cam alias:' + str(device_info.alias))
  30. print('cam serialNumber:' + str(device_info.serialNumber))
  31. print('cam ip:' + str(device_info.ip))
  32. print('cam status:' + str(device_info.status))
  33. else:
  34. print(' failed:' + ret)
  35. exit()
  36. else:
  37. print("there are no camera found")
  38. exit()
  39. if VzConnectStatus.Connected.value != device_info.status:
  40. print("connect statu:",device_info.status)
  41. print("Call VZ_OpenDeviceByUri with connect status :",VzConnectStatus.Connected.value)
  42. exit()
  43. else:
  44. print("uri: "+str(device_info.uri))
  45. print("alias: "+str(device_info.alias))
  46. print("connectStatus: "+str(device_info.status))
  47. ret = camera.VZ_OpenDeviceByUri(device_info.uri)
  48. if ret == 0:
  49. print("open device successful")
  50. else:
  51. print('VZ_OpenDeviceByUri failed: ' + str(ret))
  52. ret = camera.VZ_CloseDevice()
  53. if ret == 0:
  54. print("close device successful")
  55. else:
  56. print('VZ_CloseDevice failed: ' + str(ret))