DeviceHWTriggerMode.py 2.5 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394
  1. from pickle import FALSE, TRUE
  2. import sys
  3. sys.path.append('../../../')
  4. from API.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 uri:' + str(device_info.uri))
  28. else:
  29. print(' failed:' + ret)
  30. exit()
  31. else:
  32. print("there are no camera found")
  33. exit()
  34. if VzConnectStatus.Connected.value != device_info.status:
  35. print("connect statu:",device_info.status)
  36. print("Call VZ_OpenDeviceByUri with connect status :",VzConnectStatus.Connected.value)
  37. exit()
  38. else:
  39. print("uri: "+str(device_info.uri))
  40. print("alias: "+str(device_info.alias))
  41. print("connectStatus: "+str(device_info.status))
  42. ret = camera.VZ_OpenDeviceByUri(device_info.uri)
  43. if ret == 0:
  44. print("open device successful")
  45. else:
  46. print('VZ_OpenDeviceByUri failed: ' + str(ret))
  47. ret = camera.VZ_StartStream()
  48. if ret == 0:
  49. print("start stream successful")
  50. else:
  51. print("VZ_StartStream failed:",ret)
  52. ret = camera.VZ_SetWorkMode(VzWorkMode.HardwareTriggerMode)
  53. if ret != 0:
  54. print("VZ_SetWorkMode failed:",ret)
  55. for i in range(300000):
  56. ret, frameready = camera.VZ_GetFrameReady(c_uint16(1000))
  57. if ret !=0:
  58. print("VZ_GetFrameReady failed:",ret)
  59. continue
  60. if frameready.depth:
  61. ret,frame = camera.VZ_GetFrame(VzFrameType.VzDepthFrame)
  62. if ret == 0:
  63. print("depth id:",frame.frameIndex)
  64. else:
  65. print("depth error:",ret)
  66. ret = camera.VZ_SetWorkMode(VzWorkMode.ActiveMode)
  67. if ret != 0:
  68. print("VZ_SetWorkMode failed:",ret)
  69. ret = camera.VZ_StopStream()
  70. if ret == 0:
  71. print("stop stream successful")
  72. else:
  73. print('VZ_StopStream failed: ' + str(ret))
  74. ret = camera.VZ_CloseDevice()
  75. if ret == 0:
  76. print("close device successful")
  77. else:
  78. print('VZ_CloseDevice failed: ' + str(ret))