Initial commit: TXW82x FPV v2.7.0.7-42229 SDK + project sources

sdk/lib/sysevt_usb/sysevt_usb.c

@@ -0,0 +1,144 @@
+#include "basic_include.h"
+#include "rtthread.h"
+#include "sysevt_usb/sysevt_usb.h"
+
+
+#define SYSEVT_USB_MALLOC   os_malloc
+#define SYSEVT_USB_ZALLOC   os_zalloc
+#define SYSEVT_USB_FREE     os_free
+
+/* ------------ SYSTEM EVENT USB VIDEO CLASS ------------ */
+
+#include "usbh_video.h"
+static struct sysevt_usbh_video_priv_data *g_sysevt_usbh_video_data = NULL;
+
+int system_event_usbh_video_init()
+{
+    if (!g_sysevt_usbh_video_data) {
+        g_sysevt_usbh_video_data = SYSEVT_USB_ZALLOC(sizeof(struct sysevt_usbh_video_priv_data) * CONFIG_SYSEVT_USB_VIDEO_MAX_NUM);
+        if (g_sysevt_usbh_video_data) {
+            // 初始化默认值
+            os_strcpy(g_sysevt_usbh_video_data[0].video_dev_name, "/dev/video0");
+            g_sysevt_usbh_video_data[0].status = SYSEVT_USB_STATUS_DISCONNECT;
+
+            os_strcpy(g_sysevt_usbh_video_data[1].video_dev_name, "/dev/video1");
+            g_sysevt_usbh_video_data[1].status = SYSEVT_USB_STATUS_DISCONNECT;
+
+        } else {
+            os_printf("sysevt_usbh_video_data malloc failed\n");
+            return RET_ERR;
+        }
+    }
+
+    return RET_OK;
+}
+
+int system_event_usbh_video_deinit()
+{
+    if (g_sysevt_usbh_video_data) {
+        SYSEVT_USB_FREE(g_sysevt_usbh_video_data);
+        g_sysevt_usbh_video_data = NULL;
+    }
+    return RET_OK;
+}
+
+int system_event_usbh_video_update_info(int dev_num, const char* dev_name, uint32_t uvc_format, uint32_t width, uint32_t height)
+{
+    if (dev_num < 0 || dev_num >= CONFIG_SYSEVT_USB_VIDEO_MAX_NUM) {
+        goto __exit_err;
+    }
+
+    if (!g_sysevt_usbh_video_data) {
+        goto __exit_err;
+    }
+
+    if (dev_name) {
+        os_strncpy(g_sysevt_usbh_video_data[dev_num].video_dev_name, dev_name, sizeof(g_sysevt_usbh_video_data[dev_num].video_dev_name) - 1);
+    }
+    g_sysevt_usbh_video_data[dev_num].uvc_format = uvc_format;
+    g_sysevt_usbh_video_data[dev_num].width      = width;
+    g_sysevt_usbh_video_data[dev_num].height     = height;
+
+    return RET_OK;
+
+__exit_err:
+    return RET_ERR;
+}
+
+int system_event_usbh_video_get_info(int dev_num, struct sysevt_usbh_video_priv_data *info)
+{
+    if (dev_num < 0 || dev_num >= CONFIG_SYSEVT_USB_VIDEO_MAX_NUM) {
+        goto __exit_err;
+    }
+
+    if (!g_sysevt_usbh_video_data) {
+        goto __exit_err;
+    }
+
+    os_memcpy(info, &g_sysevt_usbh_video_data[dev_num], sizeof(struct sysevt_usbh_video_priv_data));
+    return RET_OK;
+
+__exit_err:
+    return RET_ERR;
+}
+
+int system_event_usbh_video_new_event(int dev_num, enum SYSEVT_USB_SUBEVT subevt)
+{
+    if (dev_num < 0 || dev_num >= CONFIG_SYSEVT_USB_VIDEO_MAX_NUM) {
+        goto __exit_err;
+    }
+
+    if (!g_sysevt_usbh_video_data) {
+        goto __exit_err;
+    }
+
+    if (subevt == SYSEVT_USB_DEVICE_CONNECT) {
+        g_sysevt_usbh_video_data[dev_num].status = SYSEVT_USB_STATUS_CONNECT;
+    } 
+    else if (subevt == SYSEVT_USB_DEVICE_DISCONNECT) {
+        g_sysevt_usbh_video_data[dev_num].status = SYSEVT_USB_STATUS_DISCONNECT;
+    } 
+    else {
+        goto __exit_err;
+    }
+
+    sys_event_new(SYS_EVENT(SYS_EVENT_USB, subevt), (uint32)&g_sysevt_usbh_video_data[dev_num]);
+
+    return RET_OK;
+
+__exit_err:
+    return RET_ERR;
+}
+
+void system_event_usbh_video_hdl(uint32 event_id, uint32 data, uint32 priv)
+{
+    switch (event_id) {
+        case SYS_EVENT(SYS_EVENT_USB, SYSEVT_USB_DEVICE_CONNECT):
+        {
+            struct sysevt_usbh_video_priv_data *video_data = (struct sysevt_usbh_video_priv_data *)data;
+            os_printf("----- SYSEVT_USB_DEVICE_CONNECT: dev_name=%s, format=0x%X, %u x %u ----- \n",
+                      video_data->video_dev_name,
+                      video_data->uvc_format,
+                      video_data->width,
+                      video_data->height);
+            extern void usb_event_connect_hdl(void);
+            usb_event_connect_hdl();
+        }
+            break;
+
+        case SYS_EVENT(SYS_EVENT_USB, SYSEVT_USB_DEVICE_DISCONNECT):
+        {
+            struct sysevt_usbh_video_priv_data *video_data = (struct sysevt_usbh_video_priv_data *)data;
+            os_printf("----- SYSEVT_USB_DEVICE_DISCONNECT: dev_name=%s ----- \n",
+                      video_data->video_dev_name);
+            extern void usb_event_disconnect_hdl(void);
+            usb_event_disconnect_hdl();
+        }
+            break;
+
+        default:
+            break;
+
+    }
+}
+

sdk/lib/sysevt_usb/sysevt_usb.h

@@ -0,0 +1,32 @@
+#ifndef __SYSEVT_USB_H_
+#define __SYSEVT_USB_H_
+
+#include "lib/common/sysevt.h"
+
+enum sysevt_usb_status
+{
+    SYSEVT_USB_STATUS_CONNECT       = BIT(1),
+    SYSEVT_USB_STATUS_DISCONNECT    = BIT(2),
+};
+
+
+/* ------------ SYSTEM EVENT USB VIDEO CLASS ------------ */
+struct sysevt_usbh_video_priv_data
+{
+    char video_dev_name[16];
+    uint32_t uvc_format;
+    uint32_t width;
+    uint32_t height;
+    uint32_t status;
+};
+
+#define CONFIG_SYSEVT_USB_VIDEO_MAX_NUM 2
+
+int system_event_usbh_video_init();
+int system_event_usbh_video_deinit();
+int system_event_usbh_video_update_info(int dev_num, const char* dev_name, uint32_t uvc_format, uint32_t width, uint32_t height);
+int system_event_usbh_video_get_info(int dev_num, struct sysevt_usbh_video_priv_data *info);
+int system_event_usbh_video_new_event(int dev_num, enum SYSEVT_USB_SUBEVT subevt);
+void system_event_usbh_video_hdl(uint32 event_id, uint32 data, uint32 priv);
+
+#endif