Forráskód Böngészése

调整海康相机模块的c导出函数,避免后期与大华相机模块的c导出函数同名,导致同时使用时出现问题

niujiuru 1 napja
szülő
commit
b30c0a756f

+ 100 - 0
camera/takephoto.go

@@ -0,0 +1,100 @@
+package camera
+
+import (
+	"fmt"
+	"os"
+	"os/exec"
+	"syscall"
+	"time"
+
+	"github.com/vishvananda/netlink"
+	"hnyfkj.com.cn/rtu/linux/baseapp"
+)
+
+// 相机模块的名称
+const MODULE_NAME = "TakePhoto"
+
+// 配置连接网口相机的网卡ip
+func SetupEth1ForGigeCamera(cidr string) error {
+	link, err := netlink.LinkByName("eth1")
+	if err != nil {
+		return err
+	}
+
+	if err = netlink.LinkSetUp(link); err != nil {
+		return err
+	}
+
+	addr, err := netlink.ParseAddr(cidr)
+	if err != nil {
+		return err
+	}
+
+	if err = netlink.AddrAdd(link, addr); err != nil && err != syscall.EEXIST {
+		return err
+	}
+
+	return nil
+}
+
+// 打开或关闭网口相机的电源
+func PowerOnGigeCamera(on bool) error {
+	_ = os.WriteFile("/sys/class/gpio/unexport", []byte("22"), 0644)
+	if err := os.WriteFile("/sys/class/gpio/export", []byte("22"), 0644); err != nil {
+		return err
+	}
+	time.Sleep(50 * time.Millisecond)
+	if err := os.WriteFile("/sys/class/gpio/gpio22/direction", []byte("out"), 0644); err != nil {
+		return err
+	}
+	val := "0"
+	if on {
+		val = "1"
+	}
+	if err := os.WriteFile("/sys/class/gpio/gpio22/value", []byte(val), 0644); err != nil {
+		return err
+	}
+	return nil
+}
+
+func PingOnce(host string, timeoutSec int) error {
+	cmd := exec.Command("ping", "-c", "1", "-W", fmt.Sprint(timeoutSec), host)
+	return cmd.Run()
+}
+
+func ModuleInit(supportsGigeCamera bool, eth1CIDR, gigeCameraIP string) bool {
+	if supportsGigeCamera {
+		if err := SetupEth1ForGigeCamera(eth1CIDR); err != nil {
+			baseapp.Logger.Errorf("[%s] 网口相机初始化失败: 设置\"eth1\"地址失败: %v!!", MODULE_NAME, err)
+			return false
+		}
+
+		err := PingOnce(gigeCameraIP, 1)
+		if err == nil {
+			goto initOK
+		}
+
+		err = PowerOnGigeCamera(true)
+		if err != nil {
+			baseapp.Logger.Errorf("[%s] 网口相机初始化失败: 通过 GPIO22 上电失败: %v!!", MODULE_NAME, err)
+			return false
+		}
+
+		for range 10 {
+			err = PingOnce(gigeCameraIP, 1)
+			if err == nil {
+				break
+			}
+			time.Sleep(1 * time.Second)
+		}
+
+		if err != nil {
+			baseapp.Logger.Errorf("[%s] 网口相机初始化失败: 连通性检测(ping)失败: %v!!", MODULE_NAME, err)
+			return false
+		}
+	}
+
+initOK: // Todo:
+
+	return true
+}

+ 6 - 6
hk_takephoto/bridge.go

@@ -28,20 +28,20 @@ type SImgMark struct {
 
 // 获取系统当前USBFS内存大小(MB), 成功返回: >=0, 失败返回: <0值
 func getSysUsbfsMemCurrentSize() int {
-	ret := int(C.GetSysUsbfsMemCurrentSize())
+	ret := int(C.HK_GetSysUsbfsMemCurrentSize())
 	return ret
 }
 
 // 设置系统新的USBFS内存大小(MB), 成功返回: 0值, 失败返回: <0值
 func setSysUsbfsMemSize(val int) int {
 	setNewV := C.int(val)
-	ret := int(C.SetSysUsbfsMemSize(setNewV))
+	ret := int(C.HK_SetSysUsbfsMemSize(setNewV))
 	return ret
 }
 
 // 获取当前已连接的海康相机的数量, 成功返回: >=0, 失败返回: <0值
 func GetHKCameraCount() int {
-	ret := int(C.GetHKCameraCount())
+	ret := int(C.HK_GetCameraCount())
 	return ret
 }
 
@@ -59,10 +59,10 @@ func TakePhoto(imgType int, saveImgPath string, timeout int) (SImgMark, error) {
 	path := C.CString(saveImgPath)
 	defer C.free(unsafe.Pointer(path))
 
-	var imgMark C.SImgMark
-	ret := int(C.TakePhoto(C.EImgType(imgType), path, C.int(timeout), &imgMark))
+	var imgMark C.HKImgMark
+	ret := int(C.HK_TakePhoto(C.HKImgType(imgType), path, C.int(timeout), &imgMark))
 	if ret != 0 {
-		return SImgMark{}, fmt.Errorf("an error occurred while calling the C.TakePhoto() function(%d)", ret)
+		return SImgMark{}, fmt.Errorf("an error occurred while calling the C.HK_TakePhoto() function(%d)", ret)
 	}
 
 	return SImgMark{

+ 9 - 9
hk_takephoto/takephoto.c

@@ -21,7 +21,7 @@ static MV_CAM_TRIGGER_MODE setTriggerMode = MV_TRIGGER_MODE_ON; /// 默认: 打
 #define AE_EXP_STABLE_FRAMES    4 // 相机处于自动曝光模式时, 累计曝光值稳定的帧数
 
 // 保存照片
-static int SavePhoto(HANDLE hCam, MV_FRAME_OUT *pFrame, EImgType imgType, const char *imgFile);
+static int SavePhoto(HANDLE hCam, MV_FRAME_OUT *pFrame, HKImgType imgType, const char *imgFile);
 
 // 拍照回调
 typedef struct
@@ -29,7 +29,7 @@ typedef struct
   HANDLE      hCam;           // 打开相机的句柄
   uint32_t    camType;        // 相机类型:U、网
   char manuName[MAX_LINE_CHARS]; //制造厂商名称
-  EImgType    saveImgType;    // 保存图像的类型
+  HKImgType    saveImgType;   // 保存图像的类型
   const char *saveImgPath;    // 保存图像的路径
   bool        isExposureAuto; // 自动曝光:是/否
   struct timespec expTime0;   // 曝光开始的时间
@@ -121,10 +121,10 @@ getp:
 //                 , 但时间不确定; 拍照成功、超时或发生错误
 //                 时会自动结束任务(相机持续无数据的时间).
 // "pImgMark"    - 输出本次拍照图像的水印信息, 可以设置NULL
-int TakePhoto(EImgType imgType, const char *saveImgPath, int timeout, SImgMark *pImgMark)
+int HK_TakePhoto(HKImgType imgType, const char *saveImgPath, int timeout, HKImgMark *pImgMark)
 {
   int fd; char runDir[MAX_PATH_CHARS] = { 0 }, lockFile[MAX_PATH_CHARS+32] = { 0 };
-  int ret, index = 0; SImgMark imgMark = { 0 }; HANDLE hCam = NULL; PthotoProcCtx ctx = { 0 };
+  int ret, index = 0; HKImgMark imgMark = { 0 }; HANDLE hCam = NULL; PthotoProcCtx ctx = { 0 };
   MV_CC_DEVICE_INFO_LIST devList = { 0 }; MV_CC_DEVICE_INFO *pDevInfo; MVCC_ENUMVALUE exposureMode =  { 0 };
 
   // 1, 占用锁定, 避免同时间拍照
@@ -280,7 +280,7 @@ findp:
     MVCC_FLOATVALUE fv = { 0 };
     MV_CC_GetFloatValue(hCam, "ExposureTime", &fv);
     imgMark.imgExposureTime = fv.fCurValue;
-    if(pImgMark) memcpy(pImgMark, &imgMark, sizeof(SImgMark));
+    if(pImgMark) memcpy(pImgMark, &imgMark, sizeof(HKImgMark));
   }
 
   // 6, 任务结束, 释放相关的资源
@@ -301,7 +301,7 @@ end_p:
 }
 
 // 保存照片
-static int SavePhoto(HANDLE hCam, MV_FRAME_OUT *pFrame, EImgType imgType, const char *imgFile)
+static int SavePhoto(HANDLE hCam, MV_FRAME_OUT *pFrame, HKImgType imgType, const char *imgFile)
 {
   MV_SAVE_IMAGE_PARAM_EX3 saveParams = { 0 }; MVCC_INTVALUE_EX iv;
   char *filename1 = (char *)imgFile, *filename2 = NULL; int ret; char ext[5];
@@ -364,7 +364,7 @@ end_p:
 }
 
 // 获取系统当前USBFS内存大小(MB), 成功返回: >=0, 失败返回: <0值
-int GetSysUsbfsMemCurrentSize()
+int HK_GetSysUsbfsMemCurrentSize()
 {
   const char *usbfsFile = "/sys/module/usbcore/parameters/usbfs_memory_mb";
   char buf[MAX_LINE_CHARS]; int val = -1;
@@ -378,7 +378,7 @@ int GetSysUsbfsMemCurrentSize()
 }
 
 // 设置系统新的USBFS内存大小(MB), 成功返回: 0值, 失败返回: <0值
-int SetSysUsbfsMemSize(int val)
+int HK_SetSysUsbfsMemSize(int val)
 {
   const char *usbfsFile = "/sys/module/usbcore/parameters/usbfs_memory_mb";
   char buf[MAX_LINE_CHARS]; sprintf(buf, "%d\n", val);
@@ -387,7 +387,7 @@ int SetSysUsbfsMemSize(int val)
 }
 
 // 获取当前已连接的海康相机的数量, 成功返回: >=0, 失败返回: <0值
-int GetHKCameraCount()
+int HK_GetCameraCount()
 {
   MV_CC_DEVICE_INFO_LIST devList = { 0 };
   int ret;

+ 0 - 56
hk_takephoto/takephoto.go

@@ -1,54 +1,14 @@
 package hk_takephoto
 
 import (
-	"os"
-	"syscall"
 	"time"
 
-	"github.com/vishvananda/netlink"
 	"hnyfkj.com.cn/rtu/linux/baseapp"
 )
 
 // 相机模块的名称
 const MODULE_NAME = "HikrobotTakePhoto"
 
-func setupIface(iface, cidr string) error {
-	link, err := netlink.LinkByName(iface)
-	if err != nil {
-		return err
-	}
-
-	if err = netlink.LinkSetUp(link); err != nil {
-		return err
-	}
-
-	addr, err := netlink.ParseAddr(cidr)
-	if err != nil {
-		return err
-	}
-
-	if err = netlink.AddrAdd(link, addr); err != nil && err != syscall.EEXIST {
-		return err
-	}
-
-	return nil
-}
-
-func powerOnGigeCamera() error {
-	_ = os.WriteFile("/sys/class/gpio/unexport", []byte("22"), 0644)
-	if err := os.WriteFile("/sys/class/gpio/export", []byte("22"), 0644); err != nil {
-		return err
-	}
-	time.Sleep(50 * time.Millisecond)
-	if err := os.WriteFile("/sys/class/gpio/gpio22/direction", []byte("out"), 0644); err != nil {
-		return err
-	}
-	if err := os.WriteFile("/sys/class/gpio/gpio22/value", []byte("1"), 0644); err != nil {
-		return err
-	}
-	return nil
-}
-
 // 相机模块初始化, 设置必要的运行环境参数, 只有成功才能进行后续的拍照操作
 func ModuleInit() bool {
 	myUsbfsMemSize := 200 // 单位: 兆字节
@@ -73,21 +33,5 @@ func ModuleInit() bool {
 		return false
 	}
 
-	if err := powerOnGigeCamera(); err != nil { // RTU板子上连接的网口相机电源由GPIO22控制, 默认是关闭的, 若相机由RTU板供电,需打开
-		baseapp.Logger.Errorf(
-			"[%s] 打开网口相机的电源失败: %v",
-			MODULE_NAME, err,
-		)
-		return false
-	}
-
-	if err := setupIface("eth1", "192.168.100.123/24"); err != nil { // 通过"eth1"连接网口相机, 相机IP地址必须与"eth1"在同一网段
-		baseapp.Logger.Errorf(
-			"[%s] 设置网口%s的IP地址失败: %v",
-			MODULE_NAME, "eth1", err,
-		)
-		return false
-	}
-
 	return true
 }

+ 6 - 6
hk_takephoto/takephoto.h

@@ -14,14 +14,14 @@ typedef struct
   char camModelName[MAX_LINE_CHARS]; // 相机型号名
   char camSerialNum[MAX_LINE_CHARS]; // 相机序列号
   float imgExposureTime; // 拍照曝光时间, 单位: us
-} SImgMark;
+} HKImgMark;
 
 // 图像类型
 typedef enum
 {
   IMG_TYPE_BMP = 1, // 拍照输出".bmp"格式的图像文件
 	IMG_TYPE_JPG = 2, // 拍照输出".jpg"格式的图像文件
-} EImgType;
+} HKImgType;
 
 #ifdef __cplusplus
 extern "C"
@@ -29,13 +29,13 @@ extern "C"
 #endif
 
 // 获取系统当前USBFS内存大小(MB), 成功返回: >=0, 失败返回: <0值
-int GetSysUsbfsMemCurrentSize();
+int HK_GetSysUsbfsMemCurrentSize();
 
 // 设置系统新的USBFS内存大小(MB), 成功返回: 0值, 失败返回: <0值
-int SetSysUsbfsMemSize(int val);
+int HK_SetSysUsbfsMemSize(int val);
 
 // 获取当前已连接的海康相机的数量, 成功返回: >=0, 失败返回: <0值
-int GetHKCameraCount();
+int HK_GetCameraCount();
 
 // 单次执行相机拍照, 并保存到文件, 成功返回: 0值, 失败返回:非0值
 // "imgType"     - 获取图像类型
@@ -45,7 +45,7 @@ int GetHKCameraCount();
 //                 , 但时间不确定; 拍照成功、超时或发生错误
 //                 时会自动结束任务(相机持续无数据的时间).
 // "pImgMark"    - 输出本次拍照图像的水印信息, 可以设置NULL
-int TakePhoto(EImgType imgType, const char *saveImgPath, int timeout, SImgMark *pImgMark);
+int HK_TakePhoto(HKImgType imgType, const char *saveImgPath, int timeout, HKImgMark *pImgMark);
 
 #ifdef __cplusplus
 }

+ 4 - 4
hk_takephoto/takephoto_test.c

@@ -5,17 +5,17 @@
 // 主函数入口, 测试拍照
 int main(int argc,char *argv[])
 {
-  int ret = 0; unsigned long stime, wtime, etime; SImgMark imgMark = { 0 };
+  int ret = 0; unsigned long stime, wtime, etime; HKImgMark imgMark = { 0 };
   char filename[MAX_PATH_CHARS] = { 0 }; int timeout = 5*60;
 
-  if(GetSysUsbfsMemCurrentSize() < 200) ret = SetSysUsbfsMemSize(200);
+  if(HK_GetSysUsbfsMemCurrentSize() < 200) ret = HK_SetSysUsbfsMemSize(200);
   if(0 != ret)
   {
     sw_log_error("Failed to set system usbfs's memory size, ret=%d!!", ret);
     return ret;
   }
 
-  sw_log_info("Get HK camera count: %d", GetHKCameraCount());
+  sw_log_info("Get HK camera count: %d", HK_GetCameraCount());
 
   sw_log_info("Photo taking...");
   for(int i = 0; i < 9; i++)
@@ -23,7 +23,7 @@ int main(int argc,char *argv[])
     sprintf(filename, "test%d.jpg", i+1);
 
     xgettickcount(&stime);
-    ret = TakePhoto(IMG_TYPE_JPG, filename, timeout, &imgMark);
+    ret = HK_TakePhoto(IMG_TYPE_JPG, filename, timeout, &imgMark);
     xgettickcount(&etime);
 
     wtime = etime - stime;