mirror/tinyusb
1
0
Fork 0
mirror of https://github.com/hathach/tinyusb.git synced 2025-04-01 19:20:35 +00:00
Code Issues Packages Projects Releases Wiki Activity

Implement some mandatory requests on streaming interface

Browse Source
This commit is contained in:
kkitayam 2021-08-15 18:07:53 +09:00
parent 4995d9cbd2
commit 2b4e02f192
4 changed files with 224 additions and 89 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
examples/device/video_capture/src/usb_descriptors.h
View File

@ -29,7 +29,7 @@
/* Time stamp base clock. It is a deprecated parameter. */ /* Time stamp base clock. It is a deprecated parameter. */
#define UVC_CLOCK_FREQUENCY 27000000 #define UVC_CLOCK_FREQUENCY 27000000
// video capture path /* video capture path */
#define UVC_ENTITY_CAP_INPUT_TERMINAL 0x01 #define UVC_ENTITY_CAP_INPUT_TERMINAL 0x01
#define UVC_ENTITY_CAP_OUTPUT_TERMINAL 0x02 #define UVC_ENTITY_CAP_OUTPUT_TERMINAL 0x02

92
src/class/video/video.h
View File

@ -81,15 +81,13 @@ typedef enum {
} video_subclass_type_t; } video_subclass_type_t;
/* A.3 */ /* A.3 */
typedef enum typedef enum {
{
VIDEO_INT_PROTOCOL_CODE_UNDEF = 0x00, VIDEO_INT_PROTOCOL_CODE_UNDEF = 0x00,
VIDEO_INT_PROTOCOL_CODE_15, VIDEO_INT_PROTOCOL_CODE_15,
} video_interface_protocol_code_t; } video_interface_protocol_code_t;
/* A.5 */ /* A.5 */
typedef enum typedef enum {
{
VIDEO_CS_VC_INTERFACE_VC_DESCRIPTOR_UNDEF = 0x00, VIDEO_CS_VC_INTERFACE_VC_DESCRIPTOR_UNDEF = 0x00,
VIDEO_CS_VC_INTERFACE_HEADER, VIDEO_CS_VC_INTERFACE_HEADER,
VIDEO_CS_VC_INTERFACE_INPUT_TERMINAL, VIDEO_CS_VC_INTERFACE_INPUT_TERMINAL,
@ -98,11 +96,11 @@ typedef enum
VIDEO_CS_VC_INTERFACE_PROCESSING_UNIT, VIDEO_CS_VC_INTERFACE_PROCESSING_UNIT,
VIDEO_CS_VC_INTERFACE_EXTENSION_UNIT, VIDEO_CS_VC_INTERFACE_EXTENSION_UNIT,
VIDEO_CS_VC_INTERFACE_ENCODING_UNIT, VIDEO_CS_VC_INTERFACE_ENCODING_UNIT,
VIDEO_CS_VC_INTERFACE_MAX,
} video_cs_vc_interface_subtype_t; } video_cs_vc_interface_subtype_t;
/* A.6 */ /* A.6 */
typedef enum typedef enum {
{
VIDEO_CS_VS_INTERFACE_VS_DESCRIPTOR_UNDEF = 0x00, VIDEO_CS_VS_INTERFACE_VS_DESCRIPTOR_UNDEF = 0x00,
VIDEO_CS_VS_INTERFACE_INPUT_HEADER, VIDEO_CS_VS_INTERFACE_INPUT_HEADER,
VIDEO_CS_VS_INTERFACE_OUTPUT_HEADER, VIDEO_CS_VS_INTERFACE_OUTPUT_HEADER,
@ -126,8 +124,7 @@ typedef enum
} video_cs_vs_interface_subtype_t; } video_cs_vs_interface_subtype_t;
/* A.8 */ /* A.8 */
typedef enum typedef enum {
{
VIDEO_REQUEST_UNDEF = 0x00, VIDEO_REQUEST_UNDEF = 0x00,
VIDEO_REQUEST_SET_CUR, VIDEO_REQUEST_SET_CUR,
VIDEO_REQUEST_SET_CUR_ALL = 0x11, VIDEO_REQUEST_SET_CUR_ALL = 0x11,
@ -147,16 +144,14 @@ typedef enum
} video_control_request_t; } video_control_request_t;
/* A.9.1 */ /* A.9.1 */
typedef enum typedef enum {
{
VIDEO_VC_CTL_UNDEF = 0x00, VIDEO_VC_CTL_UNDEF = 0x00,
VIDEO_VC_CTL_VIDEO_POWER_MODE, VIDEO_VC_CTL_VIDEO_POWER_MODE,
VIDEO_VC_CTL_REQUEST_ERROR_CODE, VIDEO_VC_CTL_REQUEST_ERROR_CODE,
} video_interface_control_selector_t; } video_interface_control_selector_t;
/* A.9.8 */ /* A.9.8 */
typedef enum typedef enum {
{
VIDEO_VS_CTL_UNDEF = 0x00, VIDEO_VS_CTL_UNDEF = 0x00,
VIDEO_VS_CTL_PROBE, VIDEO_VS_CTL_PROBE,
VIDEO_VS_CTL_COMMIT, VIDEO_VS_CTL_COMMIT,
@ -170,8 +165,7 @@ typedef enum
} video_interface_streaming_selector_t; } video_interface_streaming_selector_t;
/* B. Terminal Types */ /* B. Terminal Types */
typedef enum typedef enum {
{
VIDEO_TT_VENDOR_SPECIFIC = 0x0100, VIDEO_TT_VENDOR_SPECIFIC = 0x0100,
VIDEO_TT_STREAMING, VIDEO_TT_STREAMING,
VIDEO_ITT_VENDOR_SPECIFIC = 0x0200, VIDEO_ITT_VENDOR_SPECIFIC = 0x0200,
@ -254,20 +248,53 @@ typedef struct TU_ATTR_PACKED {
}; };
} tusb_desc_cs_video_stm_itf_hdr_t; } tusb_desc_cs_video_stm_itf_hdr_t;
typedef struct TU_ATTR_PACKED {
uint8_t bLength;
uint8_t bDescriptorType;
uint8_t bDescriptorSubType;
uint8_t bFormatIndex;
uint8_t bNumFrameDescriptors;
uint8_t guidFormat[16];
uint8_t bBitsPerPixel;
uint8_t bDefaultFrameIndex;
uint8_t bAspectRatioX;
uint8_t bAspectRatioY;
uint8_t bmInterlaceFlags;
uint8_t bCopyProtect;
} tusb_desc_cs_video_fmt_uncompressed_t;
typedef struct TU_ATTR_PACKED {
uint8_t bLength;
uint8_t bDescriptorType;
uint8_t bDescriptorSubType;
uint8_t bFrameIndex;
uint8_t bNumFrameDescriptors;
uint8_t guidFormat[16];
uint8_t bBitsPerPixel;
uint8_t bDefaultFrameIndex;
uint8_t bAspectRatioX;
uint8_t bAspectRatioY;
uint8_t bmInterlaceFlags;
uint8_t bCopyProtect;
} tusb_desc_cs_video_frm_uncompressed_t;
//--------------------------------------------------------------------+ //--------------------------------------------------------------------+
// Requests // Requests
//--------------------------------------------------------------------+ //--------------------------------------------------------------------+
/* 4.3.1.1 */ /* 4.3.1.1 */
typedef struct TU_ATTR_PACKED { typedef struct TU_ATTR_PACKED {
struct TU_ATTR_PACKEDt { union {
uint16_t dwFrameInterval: 1; uint8_t bmHint;
uint16_t wKeyFrameRatel : 1; struct TU_ATTR_PACKED {
uint16_t wPFrameRate : 1; uint16_t dwFrameInterval: 1;
uint16_t wCompQuality : 1; uint16_t wKeyFrameRatel : 1;
uint16_t wCompWindowSize: 1; uint16_t wPFrameRate : 1;
uint16_t : 0; uint16_t wCompQuality : 1;
} bmHint; uint16_t wCompWindowSize: 1;
uint16_t : 0;
} Hint;
};
uint8_t bFormatIndex; uint8_t bFormatIndex;
uint8_t bFrameIndex; uint8_t bFrameIndex;
uint32_t dwFrameInterval; uint32_t dwFrameInterval;
@ -279,22 +306,27 @@ typedef struct TU_ATTR_PACKED {
uint32_t dwMaxVideoFrameSize; uint32_t dwMaxVideoFrameSize;
uint32_t dwMaxPayloadTransferSize; uint32_t dwMaxPayloadTransferSize;
uint32_t dwClockFrequency; uint32_t dwClockFrequency;
struct TU_ATTR_PACKED { union {
uint8_t FrameID : 1; uint8_t bmFramingInfo;
uint8_t EndOfFrame: 1; struct TU_ATTR_PACKED {
uint8_t EndOfSlice: 1; uint8_t FrameID : 1;
uint8_t : 0; uint8_t EndOfFrame: 1;
} bmFramingInfo; uint8_t EndOfSlice: 1;
uint8_t : 0;
} FramingInfo;
};
uint8_t bPreferedVersion; uint8_t bPreferedVersion;
uint8_t bMinVersion; uint8_t bMinVersion;
uint8_t bMaxVersion; uint8_t bMaxVersion;
uint8_t bUsage; uint8_t bUsage;
uint8_t bBitDepthLum; uint8_t bBitDepthLuma;
uint8_t bmSettings; uint8_t bmSettings;
uint8_t bMaxNumberOfRefFramesPlus1; uint8_t bMaxNumberOfRefFramesPlus1;
uint16_t bmRateControlModes; uint16_t bmRateControlModes;
uint64_t bmLayoutPerStream; uint64_t bmLayoutPerStream;
} video_probe_and_commit_t; } video_probe_and_commit_control_t;
TU_VERIFY_STATIC( sizeof(video_probe_and_commit_control_t) == 48, "size is not correct");
#define TUD_VIDEO_DESC_IAD_LEN 8 #define TUD_VIDEO_DESC_IAD_LEN 8
#define TUD_VIDEO_DESC_STD_VC_LEN 9 #define TUD_VIDEO_DESC_STD_VC_LEN 9

213
src/class/video/video_device.c
View File

@ -65,20 +65,35 @@ typedef struct TU_ATTR_PACKED {
uint8_t bEntityId; uint8_t bEntityId;
} tusb_desc_cs_video_entity_itf_t; } tusb_desc_cs_video_entity_itf_t;
typedef struct
{ typedef struct {
void const *beg; /* The head of the first video control interface descriptor */
uint16_t length; /* Byte length of the video control interface descriptors */
uint16_t offset; /* offset bytes for the current video control interface descripter */
uint8_t error_code; /* error code set by previous transaction */
uint8_t power_mode; /* current power mode */
} videod_control_interface_t;
typedef struct {
tusb_desc_vs_itf_t const *descriptor; /* video streaming interface descriptor */
uint16_t offset; /* video streaming interface descriptor */
video_probe_and_commit_control_t settings; /* last video streaming interface descriptor */
uint8_t error_code;
} videod_streaming_interface_t;
typedef struct {
void const *beg; /* The head of the first video control interface descriptor */ void const *beg; /* The head of the first video control interface descriptor */
uint16_t len; /* Byte length of the descriptors */ uint16_t len; /* Byte length of the descriptors */
uint16_t ofs[3]; /* offsets for video control/streaming interface. 0:control 1:streaming 2:streaming */ uint16_t ofs[3]; /* offsets for video control/streaming interface. 0:control 1:streaming 2:streaming */
uint8_t error_code[3]; /* error code for video control/streaming interface. 0:control 1:streaming 2:streaming */
uint8_t power_mode; uint8_t power_mode;
uint8_t error_code;
/*------------- From this point, data is not cleared by bus reset -------------*/ /*------------- From this point, data is not cleared by bus reset -------------*/
// Endpoint Transfer buffer // Endpoint Transfer buffer
// CFG_TUSB_MEM_ALIGN uint8_t epout_buf[CFG_TUD_CDC_EP_BUFSIZE]; // CFG_TUSB_MEM_ALIGN uint8_t epout_buf[CFG_TUD_CDC_EP_BUFSIZE];
// CFG_TUSB_MEM_ALIGN uint8_t epin_buf[CFG_TUD_CDC_EP_BUFSIZE]; // CFG_TUSB_MEM_ALIGN uint8_t epin_buf[CFG_TUD_CDC_EP_BUFSIZE];
uint8_t ctl_buf; uint8_t ctl_buf[64];
} videod_interface_t; } videod_interface_t;
@ -91,6 +106,30 @@ CFG_TUSB_MEM_SECTION static videod_interface_t _videod_itf[CFG_TUD_VIDEO];
static uint8_t const _cap_get = 0x1u; /* support for GET */ static uint8_t const _cap_get = 0x1u; /* support for GET */
static uint8_t const _cap_get_set = 0x3u; /* support for GET and SET */ static uint8_t const _cap_get_set = 0x3u; /* support for GET and SET */
static video_probe_and_commit_control_t const def_stm_settings = {
.bmHint = 0,
.bFormatIndex = 1,
.bFrameIndex = 1,
.dwFrameInterval = (10000000/15),
.wKeyFrameRate = 1,
.wPFrameRate = 0,
.wCompQuality = 1, /* 1 to 10000 */
.wCompWindowSize = 1, /* Maybe it is match to GOP size */
.wDelay = 240, /* milliseconds */
.dwMaxVideoFrameSize = 128 * 96 * 12 / 8,
.dwMaxPayloadTransferSize = 256, /* Maybe it is the maximum packet size under this settings */
.dwClockFrequency = 27000000, /* same as MPEG-2 system time clock */
.bmFramingInfo = 0,
.bPreferedVersion = 1,
.bMinVersion = 1,
.bMaxVersion = 1,
.bUsage = 0,
.bBitDepthLuma = 8,
.bmSettings = 0,
.bMaxNumberOfRefFramesPlus1 = 0,
.bmRateControlModes = 0,
.bmLayoutPerStream = 0
};
static tusb_desc_vc_itf_t const* _get_desc_vc(videod_interface_t const *self) static tusb_desc_vc_itf_t const* _get_desc_vc(videod_interface_t const *self)
{ {
@ -116,7 +155,6 @@ static tusb_desc_vs_itf_t const *_get_desc_vs(videod_interface_t const *self, un
return (tusb_desc_vs_itf_t const*)(self->beg + *ofs); return (tusb_desc_vs_itf_t const*)(self->beg + *ofs);
} }
/** Find the first descriptor with the specified descriptor type. /** Find the first descriptor with the specified descriptor type.
* *
* @param[in] beg The head of descriptor byte array. * @param[in] beg The head of descriptor byte array.
@ -146,7 +184,7 @@ static void const* _next_desc_itf(void const *beg, void const *end)
void const *cur = beg; void const *cur = beg;
unsigned itfnum = ((tusb_desc_interface_t const*)cur)->bInterfaceNumber; unsigned itfnum = ((tusb_desc_interface_t const*)cur)->bInterfaceNumber;
while ((cur < end) && while ((cur < end) &&
(itfnum == ((tusb_desc_interface_t const*)cur)->bInterfaceNumber)) { (itfnum == ((tusb_desc_interface_t const*)cur)->bInterfaceNumber)) {
cur = _find_desc(tu_desc_next(cur), end, TUSB_DESC_INTERFACE); cur = _find_desc(tu_desc_next(cur), end, TUSB_DESC_INTERFACE);
} }
return cur; return cur;
@ -186,9 +224,9 @@ static void const* _find_desc_entity(tusb_desc_vc_itf_t const *vc, unsigned enti
void const *end = beg + vc->std.bLength + vc->ctl.wTotalLength; void const *end = beg + vc->std.bLength + vc->ctl.wTotalLength;
for (void const *cur = beg; cur < end; cur = _find_desc(cur, end, TUSB_DESC_CS_INTERFACE)) { for (void const *cur = beg; cur < end; cur = _find_desc(cur, end, TUSB_DESC_CS_INTERFACE)) {
tusb_desc_cs_video_entity_itf_t const *itf = (tusb_desc_cs_video_entity_itf_t const *)cur; tusb_desc_cs_video_entity_itf_t const *itf = (tusb_desc_cs_video_entity_itf_t const *)cur;
if ((VIDEO_CS_VC_INTERFACE_INPUT_TERMINAL == itf->bDescriptorSubtype || if ((VIDEO_CS_VC_INTERFACE_INPUT_TERMINAL <= itf->bDescriptorSubtype
VIDEO_CS_VC_INTERFACE_OUTPUT_TERMINAL == itf->bDescriptorSubtype) && && itf->bDescriptorSubtype < VIDEO_CS_VC_INTERFACE_MAX)
itf->bEntityId == entityid) { && itf->bEntityId == entityid) {
return itf; return itf;
} }
cur = tu_desc_next(cur); cur = tu_desc_next(cur);
@ -334,8 +372,8 @@ static int handle_video_ctl_std_req(uint8_t rhport, uint8_t stage, tusb_control_
tusb_desc_vc_itf_t const *vc = _get_desc_vc(&_videod_itf[itf]); tusb_desc_vc_itf_t const *vc = _get_desc_vc(&_videod_itf[itf]);
if (!vc) return VIDEO_UNKNOWN; if (!vc) return VIDEO_UNKNOWN;
if (tud_control_xfer(rhport, request, if (tud_control_xfer(rhport, request,
(void*)&vc->std.bAlternateSetting, (void*)&vc->std.bAlternateSetting,
sizeof(vc->std.bAlternateSetting))) sizeof(vc->std.bAlternateSetting)))
return VIDEO_NO_ERROR; return VIDEO_NO_ERROR;
return VIDEO_UNKNOWN; return VIDEO_UNKNOWN;
case TUSB_REQ_SET_INTERFACE: case TUSB_REQ_SET_INTERFACE:
@ -359,10 +397,11 @@ static int handle_video_ctl_cs_req(uint8_t rhport, uint8_t stage, tusb_control_r
/* 4.2.1 Interface Control Request */ /* 4.2.1 Interface Control Request */
switch (TU_U16_HIGH(request->wValue)) { switch (TU_U16_HIGH(request->wValue)) {
case VIDEO_VC_CTL_VIDEO_POWER_MODE: case VIDEO_VC_CTL_VIDEO_POWER_MODE:
TU_LOG2(" Power Mode ");
switch (request->bRequest) { switch (request->bRequest) {
case VIDEO_REQUEST_SET_CUR: case VIDEO_REQUEST_SET_CUR:
if (stage == CONTROL_STAGE_SETUP) { if (stage == CONTROL_STAGE_SETUP) {
TU_LOG2(" Set Power Mode\r\n"); TU_LOG2("Set\r\n");
TU_VERIFY(1 == request->wLength, VIDEO_UNKNOWN); TU_VERIFY(1 == request->wLength, VIDEO_UNKNOWN);
if (!tud_control_xfer(rhport, request, &self->power_mode, sizeof(self->power_mode))) if (!tud_control_xfer(rhport, request, &self->power_mode, sizeof(self->power_mode)))
return VIDEO_UNKNOWN; return VIDEO_UNKNOWN;
@ -371,39 +410,36 @@ static int handle_video_ctl_cs_req(uint8_t rhport, uint8_t stage, tusb_control_r
} }
return VIDEO_NO_ERROR; return VIDEO_NO_ERROR;
case VIDEO_REQUEST_GET_CUR: case VIDEO_REQUEST_GET_CUR:
if (stage == CONTROL_STAGE_SETUP) { if (stage != CONTROL_STAGE_SETUP) return VIDEO_NO_ERROR;
TU_LOG2(" Get Power Mode\r\n"); TU_LOG2("Get\r\n");
TU_VERIFY(1 == request->wLength, VIDEO_UNKNOWN); TU_VERIFY(1 == request->wLength, VIDEO_UNKNOWN);
if (!tud_control_xfer(rhport, request, &self->power_mode, sizeof(self->power_mode))) if (!tud_control_xfer(rhport, request, &self->power_mode, sizeof(self->power_mode)))
return VIDEO_UNKNOWN; return VIDEO_UNKNOWN;
}
return VIDEO_NO_ERROR; return VIDEO_NO_ERROR;
case VIDEO_REQUEST_GET_INFO: case VIDEO_REQUEST_GET_INFO:
if (stage == CONTROL_STAGE_SETUP) { if (stage != CONTROL_STAGE_SETUP) return VIDEO_NO_ERROR;
TU_LOG2(" Get Info Power Mode\r\n"); TU_LOG2("GetInfo\r\n");
TU_VERIFY(1 == request->wLength, VIDEO_UNKNOWN); TU_VERIFY(1 == request->wLength, VIDEO_UNKNOWN);
if (!tud_control_xfer(rhport, request, (uint8_t*)&_cap_get_set, sizeof(_cap_get_set))) if (!tud_control_xfer(rhport, request, (uint8_t*)&_cap_get_set, sizeof(_cap_get_set)))
return VIDEO_UNKNOWN; return VIDEO_UNKNOWN;
}
return VIDEO_NO_ERROR; return VIDEO_NO_ERROR;
default: break; default: break;
} }
break; break;
case VIDEO_VC_CTL_REQUEST_ERROR_CODE: case VIDEO_VC_CTL_REQUEST_ERROR_CODE:
TU_LOG2(" Error Code");
switch (request->bRequest) { switch (request->bRequest) {
case VIDEO_REQUEST_GET_CUR: case VIDEO_REQUEST_GET_CUR:
if (stage == CONTROL_STAGE_SETUP) { if (stage != CONTROL_STAGE_SETUP) return VIDEO_NO_ERROR;
TU_LOG2(" Get Error Code\r\n"); TU_LOG2(" Get\r\n");
if (!tud_control_xfer(rhport, request, &self->error_code, sizeof(self->error_code))) if (!tud_control_xfer(rhport, request, &self->error_code[0], sizeof(uint8_t)))
return VIDEO_UNKNOWN; return VIDEO_UNKNOWN;
}
return VIDEO_NO_ERROR; return VIDEO_NO_ERROR;
case VIDEO_REQUEST_GET_INFO: case VIDEO_REQUEST_GET_INFO:
if (stage == CONTROL_STAGE_SETUP) { if (stage != CONTROL_STAGE_SETUP) return VIDEO_NO_ERROR;
TU_LOG2(" Get Info Error Code\r\n"); TU_LOG2(" GetInfo\r\n");
if (tud_control_xfer(rhport, request, (uint8_t*)&_cap_get, sizeof(_cap_get))) if (tud_control_xfer(rhport, request, (uint8_t*)&_cap_get, sizeof(_cap_get)))
return VIDEO_UNKNOWN; return VIDEO_UNKNOWN;
}
return VIDEO_NO_ERROR; return VIDEO_NO_ERROR;
default: break; default: break;
} }
@ -427,7 +463,7 @@ static int handle_video_ctl_req(uint8_t rhport, uint8_t stage, tusb_control_requ
return handle_video_ctl_cs_req(rhport, stage, request, itf); return handle_video_ctl_cs_req(rhport, stage, request, itf);
} else { } else {
if (!_find_desc_entity(_get_desc_vc(&_videod_itf[itf]), entity_id)) if (!_find_desc_entity(_get_desc_vc(&_videod_itf[itf]), entity_id))
return VIDEO_INVALID_REQUEST; return VIDEO_INVALID_REQUEST;
return VIDEO_INVALID_REQUEST; return VIDEO_INVALID_REQUEST;
} }
default: default:
@ -446,8 +482,8 @@ static int handle_video_stm_std_req(uint8_t rhport, uint8_t stage, tusb_control_
tusb_desc_vs_itf_t const *vs = _get_desc_vs(&_videod_itf[itf], itfnum); tusb_desc_vs_itf_t const *vs = _get_desc_vs(&_videod_itf[itf], itfnum);
if (!vs) return VIDEO_UNKNOWN; if (!vs) return VIDEO_UNKNOWN;
if (tud_control_xfer(rhport, request, if (tud_control_xfer(rhport, request,
(void*)&vs->std.bAlternateSetting, (void*)&vs->std.bAlternateSetting,
sizeof(vs->std.bAlternateSetting))) sizeof(vs->std.bAlternateSetting)))
return VIDEO_NO_ERROR; return VIDEO_NO_ERROR;
return VIDEO_UNKNOWN; return VIDEO_UNKNOWN;
case TUSB_REQ_SET_INTERFACE: case TUSB_REQ_SET_INTERFACE:
@ -467,55 +503,113 @@ static int handle_video_stm_std_req(uint8_t rhport, uint8_t stage, tusb_control_
static int handle_video_stm_cs_req(uint8_t rhport, uint8_t stage, tusb_control_request_t const *request, unsigned itf) static int handle_video_stm_cs_req(uint8_t rhport, uint8_t stage, tusb_control_request_t const *request, unsigned itf)
{ {
// videod_interface_t *self = &_videod_itf[itf]; (void)rhport;
(void)rhport; (void)stage; (void)itf; videod_interface_t *self = &_videod_itf[itf];
/* 4.2.1 Interface Control Request */ /* 4.2.1 Interface Control Request */
switch (TU_U16_HIGH(request->wValue)) { switch (TU_U16_HIGH(request->wValue)) {
case VIDEO_VS_CTL_STREAM_ERROR_CODE:
TU_LOG2(" Error Code ");
switch (request->bRequest) {
case VIDEO_REQUEST_GET_CUR:
if (stage != CONTROL_STAGE_SETUP) return VIDEO_NO_ERROR;
TU_LOG2("Get\r\n");
/* TODO */
if (!tud_control_xfer(rhport, request, &self->error_code[0], sizeof(uint8_t)))
return VIDEO_UNKNOWN;
return VIDEO_NO_ERROR;
case VIDEO_REQUEST_GET_INFO:
if (stage != CONTROL_STAGE_SETUP) return VIDEO_NO_ERROR;
TU_LOG2("GetInfo\r\n");
if (tud_control_xfer(rhport, request, (uint8_t*)&_cap_get, sizeof(_cap_get)))
return VIDEO_UNKNOWN;
return VIDEO_NO_ERROR;
default: break;
}
break;
case VIDEO_VS_CTL_PROBE: case VIDEO_VS_CTL_PROBE:
TU_LOG2(" Probe ");
switch (request->bRequest) { switch (request->bRequest) {
case VIDEO_REQUEST_SET_CUR: case VIDEO_REQUEST_SET_CUR:
TU_LOG2("Set\r\n"); if (stage == CONTROL_STAGE_SETUP) {
return VIDEO_UNKNOWN; TU_VERIFY(sizeof(video_probe_and_commit_control_t) == request->wLength, VIDEO_UNKNOWN);
if (!tud_control_xfer(rhport, request, self->ctl_buf, sizeof(video_probe_and_commit_control_t)))
return VIDEO_UNKNOWN;
} else if (stage == CONTROL_STAGE_ACK) {
if (tud_video_probe_set_cb)
return tud_video_probe_set_cb(itf, (video_probe_and_commit_control_t const*)self->ctl_buf);
}
return VIDEO_NO_ERROR;
case VIDEO_REQUEST_GET_CUR: case VIDEO_REQUEST_GET_CUR:
TU_LOG2("Get\r\n"); if (stage != CONTROL_STAGE_SETUP) return VIDEO_NO_ERROR;
TU_VERIFY(request->wLength, VIDEO_UNKNOWN);
if (tud_control_xfer(rhport, request, (void*)&def_stm_settings,
sizeof(video_probe_and_commit_control_t)))
return VIDEO_NO_ERROR;
return VIDEO_UNKNOWN; return VIDEO_UNKNOWN;
case VIDEO_REQUEST_GET_MIN: case VIDEO_REQUEST_GET_MIN:
TU_LOG2("Get Min\r\n"); if (stage != CONTROL_STAGE_SETUP) return VIDEO_NO_ERROR;
TU_VERIFY(request->wLength, VIDEO_UNKNOWN);
if (tud_control_xfer(rhport, request, (void*)&def_stm_settings,
sizeof(video_probe_and_commit_control_t)))
return VIDEO_NO_ERROR;
return VIDEO_UNKNOWN; return VIDEO_UNKNOWN;
case VIDEO_REQUEST_GET_MAX: case VIDEO_REQUEST_GET_MAX:
TU_LOG2("Get Man\r\n"); if (stage != CONTROL_STAGE_SETUP) return VIDEO_NO_ERROR;
TU_VERIFY(request->wLength, VIDEO_UNKNOWN);
if (tud_control_xfer(rhport, request, (void*)&def_stm_settings,
sizeof(video_probe_and_commit_control_t)))
return VIDEO_NO_ERROR;
return VIDEO_UNKNOWN; return VIDEO_UNKNOWN;
case VIDEO_REQUEST_GET_RES: case VIDEO_REQUEST_GET_RES:
TU_LOG2("Get Res\r\n");
return VIDEO_UNKNOWN; return VIDEO_UNKNOWN;
case VIDEO_REQUEST_GET_DEF: case VIDEO_REQUEST_GET_DEF:
TU_LOG2("Get Def\r\n");
return VIDEO_UNKNOWN; return VIDEO_UNKNOWN;
case VIDEO_REQUEST_GET_LEN: case VIDEO_REQUEST_GET_LEN:
TU_LOG2("Get Len\r\n");
return VIDEO_UNKNOWN; return VIDEO_UNKNOWN;
case VIDEO_REQUEST_GET_INFO: case VIDEO_REQUEST_GET_INFO:
TU_LOG2("Get Info\r\n"); if (stage != CONTROL_STAGE_SETUP) return VIDEO_NO_ERROR;
TU_VERIFY(1 == request->wLength, VIDEO_UNKNOWN);
if (tud_control_xfer(rhport, request, (uint8_t*)&_cap_get_set, sizeof(_cap_get_set)))
return VIDEO_NO_ERROR;
return VIDEO_UNKNOWN; return VIDEO_UNKNOWN;
default: break; default: break;
} }
break; break;
case VIDEO_VS_CTL_COMMIT: case VIDEO_VS_CTL_COMMIT:
TU_LOG2(" Commit ");
switch (request->bRequest) { switch (request->bRequest) {
case VIDEO_REQUEST_SET_CUR: case VIDEO_REQUEST_SET_CUR:
TU_LOG2("Set\r\n"); if (stage == CONTROL_STAGE_SETUP) {
return VIDEO_UNKNOWN; TU_VERIFY(sizeof(video_probe_and_commit_control_t) == request->wLength, VIDEO_UNKNOWN);
if (!tud_control_xfer(rhport, request, self->ctl_buf, sizeof(video_probe_and_commit_control_t)))
return VIDEO_UNKNOWN;
} else if (stage == CONTROL_STAGE_ACK) {
if (tud_video_commit_set_cb)
return tud_video_commit_set_cb(itf, (video_probe_and_commit_control_t const*)self->ctl_buf);
}
return VIDEO_NO_ERROR;
case VIDEO_REQUEST_GET_CUR: case VIDEO_REQUEST_GET_CUR:
TU_LOG2("Get\r\n"); if (stage != CONTROL_STAGE_SETUP) return VIDEO_NO_ERROR;
TU_VERIFY(request->wLength, VIDEO_UNKNOWN);
if (tud_control_xfer(rhport, request, (void*)&def_stm_settings,
sizeof(video_probe_and_commit_control_t)))
return VIDEO_NO_ERROR;
return VIDEO_UNKNOWN; return VIDEO_UNKNOWN;
case VIDEO_REQUEST_GET_INFO: case VIDEO_REQUEST_GET_INFO:
TU_LOG2("Get Info\r\n"); if (stage != CONTROL_STAGE_SETUP) return VIDEO_NO_ERROR;
TU_VERIFY(1 == request->wLength, VIDEO_UNKNOWN);
if (tud_control_xfer(rhport, request, (uint8_t*)&_cap_get_set, sizeof(_cap_get_set)))
return VIDEO_NO_ERROR;
return VIDEO_UNKNOWN; return VIDEO_UNKNOWN;
default: break; default: break;
} }
break; break;
case VIDEO_VS_CTL_STILL_PROBE:
case VIDEO_VS_CTL_STILL_COMMIT:
case VIDEO_VS_CTL_STILL_IMAGE_TRIGGER:
case VIDEO_VS_CTL_GENERATE_KEY_FRAME:
case VIDEO_VS_CTL_UPDATE_FRAME_SEGMENT:
case VIDEO_VS_CTL_SYNCH_DELAY_CONTROL:
/* TODO */
break;
default: break; default: break;
} }
/* Unknown/Unsupported request */ /* Unknown/Unsupported request */
@ -587,8 +681,8 @@ void videod_reset(uint8_t rhport)
uint16_t videod_open(uint8_t rhport, tusb_desc_interface_t const * itf_desc, uint16_t max_len) uint16_t videod_open(uint8_t rhport, tusb_desc_interface_t const * itf_desc, uint16_t max_len)
{ {
TU_VERIFY((TUSB_CLASS_VIDEO == itf_desc->bInterfaceClass) && TU_VERIFY((TUSB_CLASS_VIDEO == itf_desc->bInterfaceClass) &&
(VIDEO_SUBCLASS_CONTROL == itf_desc->bInterfaceSubClass) && (VIDEO_SUBCLASS_CONTROL == itf_desc->bInterfaceSubClass) &&
(VIDEO_INT_PROTOCOL_CODE_15 == itf_desc->bInterfaceProtocol), 0); (VIDEO_INT_PROTOCOL_CODE_15 == itf_desc->bInterfaceProtocol), 0);
/* Find available interface */ /* Find available interface */
videod_interface_t *self = NULL; videod_interface_t *self = NULL;
@ -607,7 +701,7 @@ uint16_t videod_open(uint8_t rhport, tusb_desc_interface_t const * itf_desc, uin
if (!_open_vc_itf(rhport, self, 0)) return 0; if (!_open_vc_itf(rhport, self, 0)) return 0;
tusb_desc_vc_itf_t const *vc = _get_desc_vc(self); tusb_desc_vc_itf_t const *vc = _get_desc_vc(self);
unsigned bInCollection = vc->ctl.bInCollection; unsigned bInCollection = vc->ctl.bInCollection;
/* Update end */ /* Find the end of the video interface descriptor */
void const *cur = _next_desc_itf(itf_desc, end); void const *cur = _next_desc_itf(itf_desc, end);
for (unsigned i = 0; i < bInCollection; ++i) { for (unsigned i = 0; i < bInCollection; ++i) {
cur = _next_desc_itf(cur, end); cur = _next_desc_itf(cur, end);
@ -623,6 +717,7 @@ bool videod_control_xfer_cb(uint8_t rhport, uint8_t stage, tusb_control_request_
{ {
int err; int err;
int (*handle_video_req)(uint8_t rhport, uint8_t stage, tusb_control_request_t const *request, unsigned itf) = NULL; int (*handle_video_req)(uint8_t rhport, uint8_t stage, tusb_control_request_t const *request, unsigned itf) = NULL;
uint8_t *error_code;
if (request->bmRequestType_bit.recipient != TUSB_REQ_RCPT_INTERFACE) { if (request->bmRequestType_bit.recipient != TUSB_REQ_RCPT_INTERFACE) {
return false; return false;
} }
@ -634,6 +729,7 @@ bool videod_control_xfer_cb(uint8_t rhport, uint8_t stage, tusb_control_request_
vc = _get_desc_vc(&_videod_itf[itf]); vc = _get_desc_vc(&_videod_itf[itf]);
if (itfnum == vc->std.bInterfaceNumber) { if (itfnum == vc->std.bInterfaceNumber) {
handle_video_req = handle_video_ctl_req; handle_video_req = handle_video_ctl_req;
error_code = &_videod_itf[itf].error_code[0];
break; break;
} }
int i; int i;
@ -641,13 +737,14 @@ bool videod_control_xfer_cb(uint8_t rhport, uint8_t stage, tusb_control_request_
for (i = 0; i < bInCollection && itfnum != vc->ctl.baInterfaceNr[i]; ++i) ; for (i = 0; i < bInCollection && itfnum != vc->ctl.baInterfaceNr[i]; ++i) ;
if (i < bInCollection) { if (i < bInCollection) {
handle_video_req = handle_video_stm_req; handle_video_req = handle_video_stm_req;
error_code = &_videod_itf[itf].error_code[1 + i];
break; break;
} }
} }
if (itf == CFG_TUD_VIDEO) return false; if (itf == CFG_TUD_VIDEO) return false;
err = handle_video_req(rhport, stage, request, itf); err = handle_video_req(rhport, stage, request, itf);
_videod_itf[itf].error_code = (uint8_t)err; *error_code = (uint8_t)err;
if (err) return false; if (err) return false;
return true; return true;
} }

6
src/class/video/video_device.h
View File

@ -48,6 +48,12 @@ TU_ATTR_WEAK bool tud_video_get_cur_cb(uint8_t rhport, tusb_control_request_t co
/* @return video_error_code_t */ /* @return video_error_code_t */
TU_ATTR_WEAK int tud_video_power_mode_cb(unsigned itf, uint8_t power_mod); TU_ATTR_WEAK int tud_video_power_mode_cb(unsigned itf, uint8_t power_mod);
/* @return video_error_code_t */
TU_ATTR_WEAK int tud_video_probe_set_cb(unsigned itf, video_probe_and_commit_control_t const *settings);
/* @return video_error_code_t */
TU_ATTR_WEAK int tud_video_commit_set_cb(unsigned itf, video_probe_and_commit_control_t const *settings);
//--------------------------------------------------------------------+ //--------------------------------------------------------------------+
// INTERNAL USBD-CLASS DRIVER API // INTERNAL USBD-CLASS DRIVER API
//--------------------------------------------------------------------+ //--------------------------------------------------------------------+