RGBResolutionChange.py 3.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117
  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_SetColorResolution(640, 480)
  53. time.sleep(2)
  54. if ret != 0:
  55. print("VZ_SetColorResolution failed:",ret)
  56. for i in range(30):
  57. ret, frameready = camera.VZ_GetFrameReady(c_uint16(1000))
  58. if ret !=0:
  59. print("VZ_GetFrameReady failed:",ret)
  60. continue
  61. if frameready.color:
  62. ret,frame = camera.VZ_GetFrame(VzFrameType.VzColorFrame)
  63. if ret == 0:
  64. if frame.width == 640 and frame.height == 480:
  65. print("rgb id:",frame.frameIndex)
  66. else:
  67. print("rgb width ",frame.width," height ",frame.height)
  68. else:
  69. print("rgb error:",ret)
  70. ret = camera.VZ_SetColorResolution(1600, 1200)
  71. time.sleep(2)
  72. if ret != 0:
  73. print("VZ_SetColorResolution failed:",ret)
  74. for i in range(30):
  75. ret, frameready = camera.VZ_GetFrameReady(c_uint16(1000))
  76. if ret !=0:
  77. print("VZ_GetFrameReady failed:",ret)
  78. continue
  79. if frameready.color:
  80. ret,frame = camera.VZ_GetFrame(VzFrameType.VzColorFrame)
  81. if ret == 0:
  82. if frame.width == 1600 and frame.height == 1200:
  83. print("rgb id:",frame.frameIndex)
  84. else:
  85. print("rgb width ",frame.width," height ",frame.height)
  86. else:
  87. print("rgb error:",ret)
  88. ret = camera.VZ_StopStream()
  89. if ret == 0:
  90. print("stop stream successful")
  91. else:
  92. print('VZ_StopStream failed: ' + str(ret))
  93. ret = camera.VZ_CloseDevice()
  94. if ret == 0:
  95. print("close device successful")
  96. else:
  97. print('VZ_CloseDevice failed: ' + str(ret))