1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798 |
- from pickle import FALSE, TRUE
- import sys
- sys.path.append('../../../')
- from API.VzenseDS_api import *
- import time
- camera = VzenseTofCam()
- camera_count = camera.VZ_GetDeviceCount()
- retry_count = 100
- while camera_count==0 and retry_count > 0:
- retry_count = retry_count-1
- camera_count = camera.VZ_GetDeviceCount()
- time.sleep(1)
- print("scaning...... ",retry_count)
- device_info=VzDeviceInfo()
- if camera_count > 1:
- ret,device_infolist=camera.VZ_GetDeviceInfoList(camera_count)
- if ret==0:
- device_info = device_infolist[0]
- for info in device_infolist:
- print('cam uri: ' + str(info.uri))
- else:
- print(' failed:' + ret)
- exit()
- elif camera_count == 1:
- ret,device_info=camera.VZ_GetDeviceInfo()
- if ret==0:
- print('cam uri:' + str(device_info.uri))
- else:
- print(' failed:' + ret)
- exit()
- else:
- print("there are no camera found")
- exit()
- if VzConnectStatus.Connected.value != device_info.status:
- print("connect statu:",device_info.status)
- print("Call VZ_OpenDeviceByUri with connect status :",VzConnectStatus.Connected.value)
- exit()
- else:
- print("uri: "+str(device_info.uri))
- print("alias: "+str(device_info.alias))
- print("connectStatus: "+str(device_info.status))
- ret = camera.VZ_OpenDeviceByUri(device_info.uri)
- if ret == 0:
- print("open device successful")
- else:
- print('VZ_OpenDeviceByUri failed: ' + str(ret))
- ret = camera.VZ_StartStream()
- if ret == 0:
- print("start stream successful")
- else:
- print("VZ_StartStream failed:",ret)
- ret, params = camera.VZ_GetSensorIntrinsicParameters(VzSensorType.VzToFSensor)
- if ret == 0:
- print("VZ_GetSensorIntrinsicParameters VzToFSensor :",
- params.fx,
- params.fy,
- params.cx,
- params.cy,
- params.k1,
- params.k2,
- params.p1,
- params.p2,
- params.k3,
- params.k4,
- params.k5,
- params.k6)
- else:
- print("VZ_GetSensorIntrinsicParameters VzToFSensor failed:",ret)
- ret, gmmgain = camera.VZ_GetIRGMMGain()
- if ret == 0:
- print("VZ_GetIRGMMGain :",gmmgain)
- else:
- print("VZ_GetIRGMMGain failed:",ret)
- ret = camera.VZ_StopStream()
- if ret == 0:
- print("stop stream successful")
- else:
- print('VZ_StopStream failed: ' + str(ret))
- ret = camera.VZ_CloseDevice()
- if ret == 0:
- print("close device successful")
- else:
- print('VZ_CloseDevice failed: ' + str(ret))
-
|