st-ten-1/src/components/hikrobot_dll.py

233 lines
9.9 KiB
Python

import ctypes
import struct
from ctypes import *
import sys
MV_MAX_DEVICE_NUM=256
MV_VS_OK=0x00000000
CHUNK_MASK_IMAGE_PORT=60005536
CHUNK_RESULT_PORT=60005537
mv_lib = ctypes.windll.LoadLibrary("src/test/hikrobot_sc/bin/MvVisionSensorControl.dll")
# define structures
from ctypes import *
class MvVSGvspPixelType(c_int):
MVVS_PixelType_Undefined = 0xFFFFFFFF
MVVS_PixelType_Mono1p = (0x0037)
MVVS_PixelType_Mono2p = (0x0038)
MVVS_PixelType_Mono4p = (0x0039)
MVVS_PixelType_Mono8 = (0x0001)
MVVS_PixelType_Mono8_Signed = (0x0002)
MVVS_PixelType_Mono10 = (0x0003)
MVVS_PixelType_Mono10_Packed = (0x0004)
MVVS_PixelType_Mono12 = (0x0005)
MVVS_PixelType_Mono12_Packed = (0x0006)
MVVS_PixelType_Mono14 = (0x0025)
MVVS_PixelType_Mono16 = (0x0007)
MVVS_PixelType_BayerGR8 = (0x0008)
MVVS_PixelType_BayerRG8 = (0x0009)
MVVS_PixelType_BayerGB8 = (0x000A)
MVVS_PixelType_BayerBG8 = (0x000B)
MVVS_PixelType_BayerGR10 = (0x000C)
MVVS_PixelType_BayerRG10 = (0x000D)
MVVS_PixelType_BayerGB10 = (0x000E)
MVVS_PixelType_BayerBG10 = (0x000F)
MVVS_PixelType_BayerGR12 = (0x0010)
MVVS_PixelType_BayerRG12 = (0x0011)
MVVS_PixelType_BayerGB12 = (0x0012)
MVVS_PixelType_BayerBG12 = (0x0013)
MVVS_PixelType_BayerGR10_Packed = (0x0026)
MVVS_PixelType_BayerRG10_Packed = (0x0027)
MVVS_PixelType_BayerGB10_Packed = (0x0028)
MVVS_PixelType_BayerBG10_Packed = (0x0029)
MVVS_PixelType_BayerGR12_Packed = (0x002A)
MVVS_PixelType_BayerRG12_Packed = (0x002B)
MVVS_PixelType_BayerGB12_Packed = (0x002C)
MVVS_PixelType_BayerBG12_Packed = (0x002D)
MVVS_PixelType_BayerGR16 = (0x002E)
MVVS_PixelType_BayerRG16 = (0x002F)
MVVS_PixelType_BayerGB16 = (0x0030)
MVVS_PixelType_BayerBG16 = (0x0031)
MVVS_PixelType_RGB8_Packed = (0x0014)
MVVS_PixelType_BGR8_Packed = (0x0015)
MVVS_PixelType_RGBA8_Packed = (0x0016)
MVVS_PixelType_BGRA8_Packed = (0x0017)
MVVS_PixelType_RGB10_Packed = (0x0018)
MVVS_PixelType_BGR10_Packed = (0x0019)
MVVS_PixelType_RGB12_Packed = (0x001A)
MVVS_PixelType_BGR12_Packed = (0x001B)
MVVS_PixelType_RGB16_Packed = (0x0033)
MVVS_PixelType_BGR16_Packed = (0x004B)
MVVS_PixelType_RGBA16_Packed = (0x0064)
MVVS_PixelType_BGRA16_Packed = (0x0051)
MVVS_PixelType_RGB10V1_Packed = (0x001C)
MVVS_PixelType_RGB10V2_Packed = (0x001D)
MVVS_PixelType_RGB12V1_Packed = (0X0034)
MVVS_PixelType_RGB565_Packed = (0x0035)
MVVS_PixelType_BGR565_Packed = (0X0036)
MVVS_PixelType_YUV411_Packed = (0x001E)
MVVS_PixelType_YUV422_Packed = (0x001F)
MVVS_PixelType_YUV422_YUYV_Packed = (0x0032)
MVVS_PixelType_YUV444_Packed = (0x0020)
MVVS_PixelType_YCBCR8_CBYCR = (0x003A)
MVVS_PixelType_YCBCR422_8 = (0x003B)
MVVS_PixelType_YCBCR422_8_CBYCRY = (0x0043)
MVVS_PixelType_YCBCR411_8_CBYYCRYY = (0x003C)
MVVS_PixelType_YCBCR601_8_CBYCR = (0x003D)
MVVS_PixelType_YCBCR601_422_8 = (0x003E)
MVVS_PixelType_YCBCR601_422_8_CBYCRY = (0x0044)
MVVS_PixelType_YCBCR601_411_8_CBYYCRYY = (0x003F)
MVVS_PixelType_YCBCR709_8_CBYCR = (0x0040)
MVVS_PixelType_YCBCR709_422_8 = (0x0041)
MVVS_PixelType_YCBCR709_422_8_CBYCRY = (0x0045)
MVVS_PixelType_YCBCR709_411_8_CBYYCRYY = (0x0042)
MVVS_PixelType_RGB8_Planar = (0x0021)
MVVS_PixelType_RGB10_Planar = (0x0022)
MVVS_PixelType_RGB12_Planar = (0x0023)
MVVS_PixelType_RGB16_Planar = (0x0024)
MVVS_PixelType_Jpeg = (0x0001)
class MV_VS_DATA(Structure):
_fields_ = [
("pImage", POINTER(c_char)), # Pointer of Image
("nImageLen", c_uint), # The Length of Image
("nImageWidth", c_uint), # Image Width
("nImageHeight", c_uint), # Image Height
("nImageNum", c_uint64), # Image Number
("enPixelType", c_int), # Pixel Type (assuming MvVSGvspPixelType is an enum)
("nDevTimeStampHigh", c_uint), # Timestamp high 32 bits
("nDevTimeStampLow", c_uint), # Timestamp low 32 bits
("nReserved0", c_uint), # Reserved, 8-byte aligned
("nHostTimeStamp", c_int64), # Host-generated timestamp
("pChunkData", POINTER(c_char)), # Chunk data
("nChunkDataLen", c_uint), # Chunk Length
("nReserved", c_uint * 64), # Reserved
]
class MV_VS_DEVICE_INFO(ctypes.Structure):
_fields_ = [
("nMajorVer", ctypes.c_ushort), # GigE protocol Major Version
("nMinorVer", ctypes.c_ushort), # GigE protocol Minor Version
("nMacAddrHigh", ctypes.c_uint), # High MAC Address
("nMacAddrLow", ctypes.c_uint), # Low MAC Address
("nIpCfgOption", ctypes.c_uint), # Supported IP Configuration Options
("nIpCfgCurrent", ctypes.c_uint), # IP Configuration
("nCurrentIp", ctypes.c_uint), # Current IP
("nCurrentSubNetMask", ctypes.c_uint), # Current Subnet Mask
("nDefultGateWay", ctypes.c_uint), # Current Gateway
("chManufacturerName", ctypes.c_char * 32), # Manufacturer Name
("chModelName", ctypes.c_char * 32), # Model Name
("chDeviceVersion", ctypes.c_char * 32), # Device Version
("chManufacturerSpecificInfo", ctypes.c_char * 48), # Manufacturer Specific Info
("chSerialNumber", ctypes.c_char * 16), # Serial Number
("chUserDefinedName", ctypes.c_char * 16), # User Defined Name
("nNetExport", ctypes.c_uint), # IP address of connected network port
("nReserved", ctypes.c_uint * 8), # Reserved
]
class MV_VS_DEVICE_INFO_LIST(ctypes.Structure):
_fields_ = [
("nDeviceNum", ctypes.c_uint), # Online Device Number
("pDeviceInfo", ctypes.POINTER(MV_VS_DEVICE_INFO) * MV_MAX_DEVICE_NUM), # Device info array
]
# Define function signatures
mv_lib.MV_VS_GetResultData.argtypes = [c_void_p, POINTER(MV_VS_DATA), c_int]
mv_lib.MV_VS_GetResultData.restype = c_int
mv_lib.MV_VS_ReleaseResultData.argtypes = [ctypes.c_void_p, ctypes.POINTER(MV_VS_DATA)]
mv_lib.MV_VS_ReleaseResultData.restype = ctypes.c_int
mv_lib.MV_VS_EnumDevices.argtypes = [POINTER(MV_VS_DEVICE_INFO_LIST)]
mv_lib.MV_VS_EnumDevices.restype = c_int
mv_lib.MV_VS_CreateHandle.argtypes = [POINTER(c_void_p), c_void_p] # Assuming pHandle is a void* and pstDeviceInfo is a struct
mv_lib.MV_VS_CreateHandle.restype = c_int
mv_lib.MV_VS_Login.argtypes = [c_void_p, c_char_p, c_char_p]
mv_lib.MV_VS_Login.restype = c_int
mv_lib.MV_VS_SetBoolValue.argtypes = [c_void_p, c_char_p, c_bool]
mv_lib.MV_VS_SetBoolValue.restype = c_int
mv_lib.MV_VS_SetEnumValue.argtypes = [c_void_p, c_char_p, c_uint]
mv_lib.MV_VS_SetEnumValue.restype = c_int
mv_lib.MV_VS_StartRun.argtypes = [c_void_p] # handle
mv_lib.MV_VS_StartRun.restype = c_int
def MV_VS_GetFrame(handle):
nRet = MV_VS_OK
stFrameData = MV_VS_DATA()
nRet = mv_lib.MV_VS_GetResultData(handle, byref(stFrameData), 2000)
if nRet == MV_VS_OK:
# Print frame information
print(
f"Frame Width: [{stFrameData.nImageWidth}], Height: [{stFrameData.nImageHeight}], ImageLen: [{stFrameData.nImageLen}]")
# Process chunk data
currentDataTag = 0
while stFrameData.nChunkDataLen > currentDataTag:
chunkLength = \
struct.unpack_from("<I", stFrameData.pChunkData, stFrameData.nChunkDataLen - 4 - currentDataTag)[0]
chunkID = struct.unpack_from("<I", stFrameData.pChunkData, stFrameData.nChunkDataLen - 8 - currentDataTag)[
0]
print(f"chunkLength [{chunkLength}], chunkID: [{chunkID}]")
if chunkLength <= 0 or chunkLength > stFrameData.nChunkDataLen - 8 - currentDataTag:
# Handle exception
break
if chunkID == CHUNK_RESULT_PORT: # Result data in JSON format
chResultInfo = ctypes.cast(
stFrameData.pChunkData + (stFrameData.nChunkDataLen - 8 - chunkLength - currentDataTag),
ctypes.POINTER(ctypes.c_char))
print(f"chResultInfo [{chResultInfo.value.decode()}] end")
elif chunkID == CHUNK_MASK_IMAGE_PORT: # Mask image data
maskModID = struct.unpack_from("<I", stFrameData.pChunkData,
stFrameData.nChunkDataLen - 8 - chunkLength - currentDataTag)[0]
maskModFormat = struct.unpack_from("<I", stFrameData.pChunkData,
stFrameData.nChunkDataLen - 8 - chunkLength - currentDataTag + 4)[0]
maskModWidth = struct.unpack_from("<I", stFrameData.pChunkData,
stFrameData.nChunkDataLen - 8 - chunkLength - currentDataTag + 8)[0]
maskModHeight = struct.unpack_from("<I", stFrameData.pChunkData,
stFrameData.nChunkDataLen - 8 - chunkLength - currentDataTag + 12)[0]
print(
f"Mask ModID[{maskModID}], ModFormat[{maskModFormat}], ModWidth[{maskModWidth}], ModHeight[{maskModHeight}], ")
chMaskModImageData = ctypes.cast(
stFrameData.pChunkData + (stFrameData.nChunkDataLen - 8 - chunkLength - currentDataTag + 16),
ctypes.POINTER(ctypes.c_char))
print(f"Mask data length [{chunkLength - 16}]")
currentDataTag += 8 + chunkLength
else:
print(f"Get frame buffer fail! nRet [0x{nRet:x}]")
# Release frame buffer
nRet = mv_lib.MV_VS_ReleaseResultData(handle, ctypes.byref(stFrameData))
if nRet != MV_VS_OK:
print(f"Release frame buffer fail! nRet [0x{nRet:x}]")
else:
print(f"MV_VS_GetResultData fail! nRet [0x{nRet & 0xFFFFFFFF:x}]")