def __init__(self,
blink_control=None,
serialtouse=None,
config_file_name="AR0135_1280x964_ext_trigger_M.json"):
if not os.path.exists(config_file_name):
print("Config file does not exist.")
exit()
devices_num, index, serials = ArducamSDK.Py_ArduCam_scan()
print("Found %d devices" % devices_num)
self.indextouse = None
for i in range(devices_num):
datas = serials[i]
serial = ""
for it, d in enumerate(datas[0:12]):
serial = serial + "%c" % d
if (it % 4) == 3 and it < 11: serial = serial + "-"
if serialtouse is None:
if i == 0: usethis = True
else:
if serial == serialtouse: usethis = True
if usethis: self.indextouse = i
print("Index:", index[i], "Serial:", serial, "Use:", usethis)
time.sleep(2)
self.handle = self.camera_initFromFile(config_file_name)
if self.handle != None:
ret_val = ArducamSDK.Py_ArduCam_setMode(
self.handle, ArducamSDK.EXTERNAL_TRIGGER_MODE)
if (ret_val == ArducamSDK.USB_BOARD_FW_VERSION_NOT_SUPPORT_ERROR):
print("USB_BOARD_FW_VERSION_NOT_SUPPORT_ERROR")
exit(0)
self.prs = QB()
self.blink_control = blink_control
signal.signal(signal.SIGTERM, sigint_handler)
if __name__ == "__main__":
config_file_name = ""
if len(sys.argv) > 1:
config_file_name = sys.argv[1]
if not os.path.exists(config_file_name):
print "Config file does not exist."
exit()
else:
showHelp()
exit()
devices_num, index, serials = ArducamSDK.Py_ArduCam_scan()
print "Found %d devices" % devices_num
for i in range(devices_num):
datas = serials[i]
serial = "%c%c%c%c-%c%c%c%c-%c%c%c%c" % (datas[0], datas[1], datas[2], datas[3],
datas[4], datas[5], datas[6], datas[7],
datas[8], datas[9], datas[10], datas[11])
print "Index:", index[i], "Serial:", serial
time.sleep(2)
for i in range(devices_num):
handle = camera_initFromFile(config_file_name, i)
if handle != None:
ret_val = ArducamSDK.Py_ArduCam_setMode(handle, ArducamSDK.EXTERNAL_TRIGGER_MODE)
if (ret_val == ArducamSDK.USB_BOARD_FW_VERSION_NOT_SUPPORT_ERROR):
def camera_initFromFile(fialeName):
global cfg,handle,Width,Height,color_mode
#load config file
config = json.load(open(fialeName,"r"))
camera_parameter = config["camera_parameter"]
Width = int(camera_parameter["SIZE"][0])
Height = int(camera_parameter["SIZE"][1])
BitWidth = camera_parameter["BIT_WIDTH"]
ByteLength = 1
if BitWidth > 8 and BitWidth <= 16:
ByteLength = 2
FmtMode = int(camera_parameter["FORMAT"][0])
color_mode = (int)(camera_parameter["FORMAT"][1])
print "color mode",color_mode
I2CMode = camera_parameter["I2C_MODE"]
I2cAddr = int(camera_parameter["I2C_ADDR"],16)
TransLvl = int(camera_parameter["TRANS_LVL"])
cfg = {"u32CameraType":0x4D091031,
"u32Width":Width,"u32Height":Height,
"usbType":0,
"u8PixelBytes":ByteLength,
"u16Vid":0,
"u32Size":0,
"u8PixelBits":BitWidth,
"u32I2cAddr":I2cAddr,
"emI2cMode":I2CMode,
"emImageFmtMode":FmtMode,
"u32TransLvl":TransLvl }
# ArducamSDK.
if serial_selection == None:
ret,handle,rtn_cfg = ArducamSDK.Py_ArduCam_autoopen(cfg)
else:
index = None
num_cam, cam_list, cam_serial = ArducamSDK.Py_ArduCam_scan()
for i in range(num_cam):
datas = cam_serial[i]
camera_serial = "%c%c%c%c-%c%c%c%c-%c%c%c%c"%(datas[0],datas[1],datas[2],datas[3],
datas[4],datas[5],datas[6],datas[7],
datas[8],datas[9],datas[10],datas[11])
if camera_serial == str(serial_selection):
print("Arducam " + str(serial_selection) + " found")
index = i
break
if index == None:
print("Arducam " + str(serial_selection) + " not found")
exit()
time.sleep(3)
ret,handle,rtn_cfg = ArducamSDK.Py_ArduCam_open(cfg,i)
if ret == 0:
usb_version = rtn_cfg['usbType']
print "USB VERSION:",usb_version
#config board param
configBoard(config["board_parameter"])
if usb_version == ArducamSDK.USB_1 or usb_version == ArducamSDK.USB_2:
configBoard(config["board_parameter_dev2"])
if usb_version == ArducamSDK.USB_3:
configBoard(config["board_parameter_dev3_inf3"])
if usb_version == ArducamSDK.USB_3_2:
configBoard(config["board_parameter_dev3_inf2"])
writeSensorRegs(config["register_parameter"])
if usb_version == ArducamSDK.USB_3:
writeSensorRegs(config["register_parameter_dev3_inf3"])
if usb_version == ArducamSDK.USB_3_2:
writeSensorRegs(config["register_parameter_dev3_inf2"])
rtn_val,datas = ArducamSDK.Py_ArduCam_readUserData(handle,0x400-16, 16)
print "Serial: %c%c%c%c-%c%c%c%c-%c%c%c%c"%(datas[0],datas[1],datas[2],datas[3],
datas[4],datas[5],datas[6],datas[7],
datas[8],datas[9],datas[10],datas[11])
return True
else:
print "open fail,rtn_val = ",ret
return False
def camera_initFromFile(fileName):
global cfg, handle, Width, Height, color_mode
#load config file
config = arducam_config_parser.LoadConfigFile(fileName)
camera_parameter = config.camera_param.getdict()
Width = camera_parameter["WIDTH"]
Height = camera_parameter["HEIGHT"]
BitWidth = camera_parameter["BIT_WIDTH"]
ByteLength = 1
if BitWidth > 8 and BitWidth <= 16:
ByteLength = 2
FmtMode = camera_parameter["FORMAT"][0]
color_mode = camera_parameter["FORMAT"][1]
print "color mode", color_mode
I2CMode = camera_parameter["I2C_MODE"]
I2cAddr = camera_parameter["I2C_ADDR"]
TransLvl = camera_parameter["TRANS_LVL"]
cfg = {
"u32CameraType": 0x00,
"u32Width": Width,
"u32Height": Height,
"usbType": 0,
"u8PixelBytes": ByteLength,
"u16Vid": 0,
"u32Size": 0,
"u8PixelBits": BitWidth,
"u32I2cAddr": I2cAddr,
"emI2cMode": I2CMode,
"emImageFmtMode": FmtMode,
"u32TransLvl": TransLvl
}
# ArducamSDK.
if serial_selection == None:
ret, handle, rtn_cfg = ArducamSDK.Py_ArduCam_autoopen(cfg)
else:
index = None
num_cam, cam_list, cam_serial = ArducamSDK.Py_ArduCam_scan()
for i in range(num_cam):
datas = cam_serial[i]
camera_serial = "%c%c%c%c-%c%c%c%c-%c%c%c%c" % (
datas[0], datas[1], datas[2], datas[3], datas[4], datas[5],
datas[6], datas[7], datas[8], datas[9], datas[10], datas[11])
if camera_serial == str(serial_selection):
print("Arducam " + str(serial_selection) + " found")
index = i
break
if index == None:
print("Arducam " + str(serial_selection) + " not found")
exit()
time.sleep(3)
ret, handle, rtn_cfg = ArducamSDK.Py_ArduCam_open(cfg, i)
if ret == 0:
usb_version = rtn_cfg['usbType']
print "USB VERSION:", usb_version
configs = config.configs
configs_length = config.configs_length
for i in range(configs_length):
type = configs[i].type
if ((type >> 16) & 0xFF) != 0 and (
(type >> 16) & 0xFF) != usb_version:
continue
if type & 0xFFFF == arducam_config_parser.CONFIG_TYPE_REG:
ArducamSDK.Py_ArduCam_writeSensorReg(handle,
configs[i].params[0],
configs[i].params[1])
elif type & 0xFFFF == arducam_config_parser.CONFIG_TYPE_DELAY:
time.sleep(float(configs[i].params[0]) / 1000)
elif type & 0xFFFF == arducam_config_parser.CONFIG_TYPE_VRCMD:
configBoard(configs[i])
rtn_val, datas = ArducamSDK.Py_ArduCam_readUserData(
handle, 0x400 - 16, 16)
print "Serial: %c%c%c%c-%c%c%c%c-%c%c%c%c" % (
datas[0], datas[1], datas[2], datas[3], datas[4], datas[5],
datas[6], datas[7], datas[8], datas[9], datas[10], datas[11])
return True
else:
print "open fail,rtn_val = ", ret
return False
def camera_initFromFile(fialeName):
global acfg,handle,Width,Height,color_mode,save_raw
#load config file
config = json.load(open(fialeName,"r"))
print(fialeName)
# print(config)
camera_parameter = config["camera_parameter"]
Width = int(camera_parameter["SIZE"][0])
Height = int(camera_parameter["SIZE"][1])
BitWidth = camera_parameter["BIT_WIDTH"]
ByteLength = 1
if BitWidth > 8 and BitWidth <= 16:
ByteLength = 2
save_raw = True
FmtMode = int(camera_parameter["FORMAT"][0])
color_mode = (int)(camera_parameter["FORMAT"][1])
print(camera_parameter)
print(Width)
print(Height)
print(BitWidth)
print(FmtMode)
# print(BitWidth)
print("color mode",color_mode)
I2CMode = camera_parameter["I2C_MODE"]
I2cAddr = int(camera_parameter["I2C_ADDR"],16)
TransLvl = int(camera_parameter["TRANS_LVL"])
acfg = {"u32CameraType":0x4D091031,
"u32Width":Width,"u32Height":Height,
"usbType":0,
"u8PixelBytes":ByteLength,
"u16Vid":0,
"u32Size":0,
"u8PixelBits":BitWidth,
"u32I2cAddr":I2cAddr,
"emI2cMode":I2CMode,
"emImageFmtMode":FmtMode,
"u32TransLvl":TransLvl }
print("\nbanana\n")
# usb_version = rtn_acfg['usbType']
# print(usb_version)
#Return vale: number of supported cameras,indexs,serials
# a, b, c = ArducamSDK.Py_ArduCam_scan()
# print(a) #2
# print(b) #[0,1]
# print(c)
# camnum = ArducamSDK.Py_ArduCam_scan()
# print(camnum)
# print(camnum[1][0])
# print(camnum[1][1])
# input("p")
#Serial: AU3S-1830-0003 <= USB 3.0 MT9J001
#Bus 001 Device 009: ID 04b4:03f1 Cypress Semiconductor Corp.
#Serial: AU2S-1843-0016
#Bus 001 Device 010: ID 52cb:52cb
#4.2.1.3 Py_ArduCam_open( acfg,index)
#Param 1: ArduCamCfg structure instance
#Param 2: index of the camera, handle,acfg
ArducamSDK.Py_ArduCam_scan()
print("scanning")
time.sleep(3)
ret,handle,rtn_cfg = ArducamSDK.Py_ArduCam_open(acfg,cameraID)
time.sleep(3)
# ret = ArducamSDK.Py_ArduCam_open(acfg,1)
# print(ret)
# input("p")
#4.2.1.1 Py_ArduCam_autoopen(acfg )
#Return vale: error code, handle,acfg
# ret,handle,rtn_cfg = ArducamSDK.Py_ArduCam_autoopen(acfg)
print(ret)
print(handle)
print(rtn_cfg)
if ret == 0:
#ArducamSDK.Py_ArduCam_writeReg_8_8(handle,0x46,3,0x00)
usb_version = rtn_cfg['usbType']
print("USB VERSION:",usb_version)
#config board param
configBoard(config["board_parameter"])
if usb_version == ArducamSDK.USB_1 or usb_version == ArducamSDK.USB_2:
configBoard(config["board_parameter_dev2"])
if usb_version == ArducamSDK.USB_3:
configBoard(config["board_parameter_dev3_inf3"])
if usb_version == ArducamSDK.USB_3_2:
configBoard(config["board_parameter_dev3_inf2"])
writeSensorRegs(config["register_parameter"])
if usb_version == ArducamSDK.USB_3:
writeSensorRegs(config["register_parameter_dev3_inf3"])
if usb_version == ArducamSDK.USB_3_2:
writeSensorRegs(config["register_parameter_dev3_inf2"])
rtn_val,datas = ArducamSDK.Py_ArduCam_readUserData(handle,0x400-16, 16)
print("Serial: %c%c%c%c-%c%c%c%c-%c%c%c%c"%(datas[0],datas[1],datas[2],datas[3],
datas[4],datas[5],datas[6],datas[7],
datas[8],datas[9],datas[10],datas[11]))
return True
else:
print("open fail,rtn_val = ",ret)
return False