|
|
|
@@ -143,13 +143,65 @@ CFG_TUD_MEM_SECTION tu_static videod_streaming_interface_t _videod_streaming_itf
|
|
|
|
|
tu_static uint8_t const _cap_get = 0x1u; /* support for GET */
|
|
|
|
|
tu_static uint8_t const _cap_get_set = 0x3u; /* support for GET and SET */
|
|
|
|
|
|
|
|
|
|
//--------------------------------------------------------------------+
|
|
|
|
|
// Debug
|
|
|
|
|
//--------------------------------------------------------------------+
|
|
|
|
|
#if CFG_TUSB_DEBUG >= CFG_TUD_VIDEO_LOG_LEVEL
|
|
|
|
|
|
|
|
|
|
static tu_lookup_entry_t const tu_lookup_video_request[] = {
|
|
|
|
|
{.key = VIDEO_REQUEST_UNDEFINED, .data = "Undefined"},
|
|
|
|
|
{.key = VIDEO_REQUEST_SET_CUR, .data = "SetCur"},
|
|
|
|
|
{.key = VIDEO_REQUEST_SET_CUR_ALL, .data = "SetCurAll"},
|
|
|
|
|
{.key = VIDEO_REQUEST_GET_CUR, .data = "GetCur"},
|
|
|
|
|
{.key = VIDEO_REQUEST_GET_MIN, .data = "GetMin"},
|
|
|
|
|
{.key = VIDEO_REQUEST_GET_MAX, .data = "GetMax"},
|
|
|
|
|
{.key = VIDEO_REQUEST_GET_RES, .data = "GetRes"},
|
|
|
|
|
{.key = VIDEO_REQUEST_GET_LEN, .data = "GetLen"},
|
|
|
|
|
{.key = VIDEO_REQUEST_GET_INFO, .data = "GetInfo"},
|
|
|
|
|
{.key = VIDEO_REQUEST_GET_DEF, .data = "GetDef"},
|
|
|
|
|
{.key = VIDEO_REQUEST_GET_CUR_ALL, .data = "GetCurAll"},
|
|
|
|
|
{.key = VIDEO_REQUEST_GET_MIN_ALL, .data = "GetMinAll"},
|
|
|
|
|
{.key = VIDEO_REQUEST_GET_MAX_ALL, .data = "GetMaxAll"},
|
|
|
|
|
{.key = VIDEO_REQUEST_GET_RES_ALL, .data = "GetResAll"},
|
|
|
|
|
{.key = VIDEO_REQUEST_GET_DEF_ALL, .data = "GetDefAll"},
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
static tu_lookup_table_t const tu_table_video_request = {
|
|
|
|
|
.count = TU_ARRAY_SIZE(tu_lookup_video_request),
|
|
|
|
|
.items = tu_lookup_video_request
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
static char const* const tu_str_video_vc_control_selector[] = {
|
|
|
|
|
"Undefined",
|
|
|
|
|
"Video Power Mode",
|
|
|
|
|
"Request Error Code",
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
static char const* const tu_str_video_vs_control_selector[] = {
|
|
|
|
|
"Undefined",
|
|
|
|
|
"Probe",
|
|
|
|
|
"Commit",
|
|
|
|
|
"Still Probe",
|
|
|
|
|
"Still Commit",
|
|
|
|
|
"Still Image Trigger",
|
|
|
|
|
"Stream Error Code",
|
|
|
|
|
"Generate Key Frame",
|
|
|
|
|
"Update Frame Segment",
|
|
|
|
|
"Sync Delay",
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
//--------------------------------------------------------------------+
|
|
|
|
|
//
|
|
|
|
|
//--------------------------------------------------------------------+
|
|
|
|
|
|
|
|
|
|
/** Get interface number from the interface descriptor
|
|
|
|
|
*
|
|
|
|
|
* @param[in] desc interface descriptor
|
|
|
|
|
*
|
|
|
|
|
* @return bInterfaceNumber */
|
|
|
|
|
static inline uint8_t _desc_itfnum(void const *desc)
|
|
|
|
|
{
|
|
|
|
|
static inline uint8_t _desc_itfnum(void const *desc) {
|
|
|
|
|
return ((uint8_t const*)desc)[2];
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
@@ -158,8 +210,7 @@ static inline uint8_t _desc_itfnum(void const *desc)
|
|
|
|
|
* @param[in] desc endpoint descriptor
|
|
|
|
|
*
|
|
|
|
|
* @return bEndpointAddress */
|
|
|
|
|
static inline uint8_t _desc_ep_addr(void const *desc)
|
|
|
|
|
{
|
|
|
|
|
static inline uint8_t _desc_ep_addr(void const *desc) {
|
|
|
|
|
return ((uint8_t const*)desc)[2];
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
@@ -169,8 +220,7 @@ static inline uint8_t _desc_ep_addr(void const *desc)
|
|
|
|
|
* @param[in] stm_idx index number of streaming interface
|
|
|
|
|
*
|
|
|
|
|
* @return instance */
|
|
|
|
|
static videod_streaming_interface_t* _get_instance_streaming(uint_fast8_t ctl_idx, uint_fast8_t stm_idx)
|
|
|
|
|
{
|
|
|
|
|
static videod_streaming_interface_t* _get_instance_streaming(uint_fast8_t ctl_idx, uint_fast8_t stm_idx) {
|
|
|
|
|
videod_interface_t *ctl = &_videod_itf[ctl_idx];
|
|
|
|
|
if (!ctl->beg) return NULL;
|
|
|
|
|
videod_streaming_interface_t *stm = &_videod_streaming_itf[ctl->stm[stm_idx]];
|
|
|
|
@@ -178,13 +228,11 @@ static videod_streaming_interface_t* _get_instance_streaming(uint_fast8_t ctl_id
|
|
|
|
|
return stm;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
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) {
|
|
|
|
|
return (tusb_desc_vc_itf_t const *)(self->beg + self->cur);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static tusb_desc_vs_itf_t const* _get_desc_vs(videod_streaming_interface_t const *self)
|
|
|
|
|
{
|
|
|
|
|
static tusb_desc_vs_itf_t const* _get_desc_vs(videod_streaming_interface_t const *self) {
|
|
|
|
|
if (!self->desc.cur) return NULL;
|
|
|
|
|
uint8_t const *desc = _videod_itf[self->index_vc].beg;
|
|
|
|
|
return (tusb_desc_vs_itf_t const*)(desc + self->desc.cur);
|
|
|
|
@@ -198,8 +246,7 @@ static tusb_desc_vs_itf_t const* _get_desc_vs(videod_streaming_interface_t const
|
|
|
|
|
*
|
|
|
|
|
* @return The pointer for interface descriptor.
|
|
|
|
|
* @retval end did not found interface descriptor */
|
|
|
|
|
static void const* _find_desc(void const *beg, void const *end, uint_fast8_t desc_type)
|
|
|
|
|
{
|
|
|
|
|
static void const* _find_desc(void const *beg, void const *end, uint_fast8_t desc_type) {
|
|
|
|
|
void const *cur = beg;
|
|
|
|
|
while ((cur < end) && (desc_type != tu_desc_type(cur))) {
|
|
|
|
|
cur = tu_desc_next(cur);
|
|
|
|
@@ -238,8 +285,7 @@ static void const* _find_desc_2_type(void const *beg, void const *end, uint_fast
|
|
|
|
|
static void const* _find_desc_3(void const *beg, void const *end,
|
|
|
|
|
uint_fast8_t desc_type,
|
|
|
|
|
uint_fast8_t element_0,
|
|
|
|
|
uint_fast8_t element_1)
|
|
|
|
|
{
|
|
|
|
|
uint_fast8_t element_1) {
|
|
|
|
|
for (void const *cur = beg; cur < end; cur = _find_desc(cur, end, desc_type)) {
|
|
|
|
|
uint8_t const *p = (uint8_t const *)cur;
|
|
|
|
|
if ((p[2] == element_0) && (p[3] == element_1)) {
|
|
|
|
@@ -261,8 +307,7 @@ static void const* _find_desc_3(void const *beg, void const *end,
|
|
|
|
|
*
|
|
|
|
|
* @return The pointer for interface descriptor.
|
|
|
|
|
* @retval end did not found interface descriptor */
|
|
|
|
|
static void const* _next_desc_itf(void const *beg, void const *end)
|
|
|
|
|
{
|
|
|
|
|
static void const* _next_desc_itf(void const *beg, void const *end) {
|
|
|
|
|
void const *cur = beg;
|
|
|
|
|
uint_fast8_t itfnum = ((tusb_desc_interface_t const*)cur)->bInterfaceNumber;
|
|
|
|
|
while ((cur < end) &&
|
|
|
|
@@ -413,8 +458,10 @@ static bool _update_streaming_parameters(videod_streaming_interface_t const *stm
|
|
|
|
|
case VIDEO_CS_ITF_VS_FORMAT_UNCOMPRESSED:
|
|
|
|
|
param->wCompQuality = 1; /* 1 to 10000 */
|
|
|
|
|
break;
|
|
|
|
|
case VIDEO_CS_ITF_VS_FORMAT_MJPEG:
|
|
|
|
|
|
|
|
|
|
case VIDEO_CS_ITF_VS_FORMAT_MJPEG:
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
default: return false;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
@@ -435,9 +482,11 @@ static bool _update_streaming_parameters(videod_streaming_interface_t const *stm
|
|
|
|
|
case VIDEO_CS_ITF_VS_FORMAT_UNCOMPRESSED:
|
|
|
|
|
frame_size = (uint_fast32_t)frm->wWidth * frm->wHeight * fmt->uncompressed.bBitsPerPixel / 8;
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
case VIDEO_CS_ITF_VS_FORMAT_MJPEG:
|
|
|
|
|
frame_size = (uint_fast32_t)frm->wWidth * frm->wHeight * 16 / 8; /* YUV422 */
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
default: break;
|
|
|
|
|
}
|
|
|
|
|
param->dwMaxVideoFrameSize = frame_size;
|
|
|
|
@@ -478,10 +527,12 @@ static bool _negotiate_streaming_parameters(videod_streaming_interface_t const *
|
|
|
|
|
if (_get_desc_vs(stm))
|
|
|
|
|
param->bFormatIndex = _get_desc_vs(stm)->stm.bNumFormats;
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
case VIDEO_REQUEST_GET_MIN:
|
|
|
|
|
case VIDEO_REQUEST_GET_DEF:
|
|
|
|
|
param->bFormatIndex = 1;
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
default: return false;
|
|
|
|
|
}
|
|
|
|
|
/* Set the parameters determined by the format */
|
|
|
|
@@ -510,18 +561,22 @@ static bool _negotiate_streaming_parameters(videod_streaming_interface_t const *
|
|
|
|
|
case VIDEO_REQUEST_GET_MAX:
|
|
|
|
|
frmnum = fmt->bNumFrameDescriptors;
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
case VIDEO_REQUEST_GET_MIN:
|
|
|
|
|
frmnum = 1;
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
case VIDEO_REQUEST_GET_DEF:
|
|
|
|
|
switch (fmt->bDescriptorSubType) {
|
|
|
|
|
case VIDEO_CS_ITF_VS_FORMAT_UNCOMPRESSED:
|
|
|
|
|
frmnum = fmt->uncompressed.bDefaultFrameIndex;
|
|
|
|
|
break;
|
|
|
|
|
case VIDEO_CS_ITF_VS_FORMAT_MJPEG:
|
|
|
|
|
frmnum = fmt->mjpeg.bDefaultFrameIndex;
|
|
|
|
|
break;
|
|
|
|
|
default: return false;
|
|
|
|
|
case VIDEO_CS_ITF_VS_FORMAT_UNCOMPRESSED:
|
|
|
|
|
frmnum = fmt->uncompressed.bDefaultFrameIndex;
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
case VIDEO_CS_ITF_VS_FORMAT_MJPEG:
|
|
|
|
|
frmnum = fmt->mjpeg.bDefaultFrameIndex;
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
default: return false;
|
|
|
|
|
}
|
|
|
|
|
break;
|
|
|
|
|
default: return false;
|
|
|
|
@@ -534,9 +589,11 @@ static bool _negotiate_streaming_parameters(videod_streaming_interface_t const *
|
|
|
|
|
case VIDEO_CS_ITF_VS_FORMAT_UNCOMPRESSED:
|
|
|
|
|
frame_size = (uint_fast32_t)frm->wWidth * frm->wHeight * fmt->uncompressed.bBitsPerPixel / 8;
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
case VIDEO_CS_ITF_VS_FORMAT_MJPEG:
|
|
|
|
|
frame_size = (uint_fast32_t)frm->wWidth * frm->wHeight * 16 / 8; /* YUV422 */
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
default: return false;
|
|
|
|
|
}
|
|
|
|
|
param->dwMaxVideoFrameSize = frame_size;
|
|
|
|
@@ -552,42 +609,43 @@ static bool _negotiate_streaming_parameters(videod_streaming_interface_t const *
|
|
|
|
|
|
|
|
|
|
uint_fast32_t interval, interval_ms;
|
|
|
|
|
switch (request) {
|
|
|
|
|
case VIDEO_REQUEST_GET_MAX:
|
|
|
|
|
{
|
|
|
|
|
uint_fast32_t min_interval, max_interval;
|
|
|
|
|
uint_fast8_t num_intervals = frm->uncompressed.bFrameIntervalType;
|
|
|
|
|
max_interval = num_intervals ? frm->uncompressed.dwFrameInterval[num_intervals - 1]: frm->uncompressed.dwFrameInterval[1];
|
|
|
|
|
min_interval = frm->uncompressed.dwFrameInterval[0];
|
|
|
|
|
interval = max_interval;
|
|
|
|
|
interval_ms = min_interval / 10000;
|
|
|
|
|
}
|
|
|
|
|
case VIDEO_REQUEST_GET_MAX: {
|
|
|
|
|
uint_fast32_t min_interval, max_interval;
|
|
|
|
|
uint_fast8_t num_intervals = frm->uncompressed.bFrameIntervalType;
|
|
|
|
|
max_interval = num_intervals ? frm->uncompressed.dwFrameInterval[num_intervals - 1]: frm->uncompressed.dwFrameInterval[1];
|
|
|
|
|
min_interval = frm->uncompressed.dwFrameInterval[0];
|
|
|
|
|
interval = max_interval;
|
|
|
|
|
interval_ms = min_interval / 10000;
|
|
|
|
|
break;
|
|
|
|
|
case VIDEO_REQUEST_GET_MIN:
|
|
|
|
|
{
|
|
|
|
|
uint_fast32_t min_interval, max_interval;
|
|
|
|
|
uint_fast8_t num_intervals = frm->uncompressed.bFrameIntervalType;
|
|
|
|
|
max_interval = num_intervals ? frm->uncompressed.dwFrameInterval[num_intervals - 1]: frm->uncompressed.dwFrameInterval[1];
|
|
|
|
|
min_interval = frm->uncompressed.dwFrameInterval[0];
|
|
|
|
|
interval = min_interval;
|
|
|
|
|
interval_ms = max_interval / 10000;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
case VIDEO_REQUEST_GET_MIN: {
|
|
|
|
|
uint_fast32_t min_interval, max_interval;
|
|
|
|
|
uint_fast8_t num_intervals = frm->uncompressed.bFrameIntervalType;
|
|
|
|
|
max_interval = num_intervals ? frm->uncompressed.dwFrameInterval[num_intervals - 1]: frm->uncompressed.dwFrameInterval[1];
|
|
|
|
|
min_interval = frm->uncompressed.dwFrameInterval[0];
|
|
|
|
|
interval = min_interval;
|
|
|
|
|
interval_ms = max_interval / 10000;
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
case VIDEO_REQUEST_GET_DEF:
|
|
|
|
|
interval = frm->uncompressed.dwDefaultFrameInterval;
|
|
|
|
|
interval_ms = interval / 10000;
|
|
|
|
|
break;
|
|
|
|
|
case VIDEO_REQUEST_GET_RES:
|
|
|
|
|
{
|
|
|
|
|
uint_fast8_t num_intervals = frm->uncompressed.bFrameIntervalType;
|
|
|
|
|
if (num_intervals) {
|
|
|
|
|
interval = 0;
|
|
|
|
|
interval_ms = 0;
|
|
|
|
|
} else {
|
|
|
|
|
interval = frm->uncompressed.dwFrameInterval[2];
|
|
|
|
|
interval_ms = interval / 10000;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
case VIDEO_REQUEST_GET_RES: {
|
|
|
|
|
uint_fast8_t num_intervals = frm->uncompressed.bFrameIntervalType;
|
|
|
|
|
if (num_intervals) {
|
|
|
|
|
interval = 0;
|
|
|
|
|
interval_ms = 0;
|
|
|
|
|
} else {
|
|
|
|
|
interval = frm->uncompressed.dwFrameInterval[2];
|
|
|
|
|
interval_ms = interval / 10000;
|
|
|
|
|
}
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
default: return false;
|
|
|
|
|
}
|
|
|
|
|
param->dwFrameInterval = interval;
|
|
|
|
@@ -681,8 +739,7 @@ static bool _init_vs_configuration(videod_streaming_interface_t *stm)
|
|
|
|
|
/* initialize streaming settings */
|
|
|
|
|
stm->state = VS_STATE_PROBING;
|
|
|
|
|
stm->max_payload_transfer_size = 0;
|
|
|
|
|
video_probe_and_commit_control_t *param =
|
|
|
|
|
(video_probe_and_commit_control_t *)&stm->ep_buf;
|
|
|
|
|
video_probe_and_commit_control_t *param = (video_probe_and_commit_control_t *)&stm->ep_buf;
|
|
|
|
|
tu_memclr(param, sizeof(*param));
|
|
|
|
|
return _update_streaming_parameters(stm, param);
|
|
|
|
|
}
|
|
|
|
@@ -760,6 +817,10 @@ static uint_fast16_t _prepare_in_payload(videod_streaming_interface_t *stm)
|
|
|
|
|
pkt_len = hdr_len + remaining;
|
|
|
|
|
}
|
|
|
|
|
uint_fast16_t data_len = pkt_len - hdr_len;
|
|
|
|
|
TU_LOG2(" prepare remain = %u, hdr_len = %u, pkt_len = %u, offset = %lu, data_len = %u\r\n", remaining, hdr_len, pkt_len, stm->offset, data_len);
|
|
|
|
|
if ( data_len > sizeof(stm->ep_buf) ) {
|
|
|
|
|
TU_BREAKPOINT();
|
|
|
|
|
}
|
|
|
|
|
memcpy(&stm->ep_buf[hdr_len], stm->buffer + stm->offset, data_len);
|
|
|
|
|
stm->offset += data_len;
|
|
|
|
|
remaining -= data_len;
|
|
|
|
@@ -775,6 +836,7 @@ static int handle_video_ctl_std_req(uint8_t rhport, uint8_t stage,
|
|
|
|
|
tusb_control_request_t const *request,
|
|
|
|
|
uint_fast8_t ctl_idx)
|
|
|
|
|
{
|
|
|
|
|
TU_LOG_DRV("\r\n");
|
|
|
|
|
switch (request->bRequest) {
|
|
|
|
|
case TUSB_REQ_GET_INTERFACE:
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP)
|
|
|
|
@@ -812,7 +874,10 @@ static int handle_video_ctl_cs_req(uint8_t rhport, uint8_t stage,
|
|
|
|
|
videod_interface_t *self = &_videod_itf[ctl_idx];
|
|
|
|
|
|
|
|
|
|
/* 4.2.1 Interface Control Request */
|
|
|
|
|
switch (TU_U16_HIGH(request->wValue)) {
|
|
|
|
|
uint8_t const ctrl_sel = TU_U16_HIGH(request->wValue);
|
|
|
|
|
TU_LOG_DRV("%s_Control(%s)\r\n", tu_str_video_vc_control_selector[ctrl_sel], tu_lookup_find(&tu_table_video_request, request->bRequest));
|
|
|
|
|
|
|
|
|
|
switch (ctrl_sel) {
|
|
|
|
|
case VIDEO_VC_CTL_VIDEO_POWER_MODE:
|
|
|
|
|
switch (request->bRequest) {
|
|
|
|
|
case VIDEO_REQUEST_SET_CUR:
|
|
|
|
@@ -876,19 +941,19 @@ static int handle_video_ctl_req(uint8_t rhport, uint8_t stage,
|
|
|
|
|
tusb_control_request_t const *request,
|
|
|
|
|
uint_fast8_t ctl_idx)
|
|
|
|
|
{
|
|
|
|
|
uint_fast8_t entity_id;
|
|
|
|
|
switch (request->bmRequestType_bit.type) {
|
|
|
|
|
case TUSB_REQ_TYPE_STANDARD:
|
|
|
|
|
return handle_video_ctl_std_req(rhport, stage, request, ctl_idx);
|
|
|
|
|
|
|
|
|
|
case TUSB_REQ_TYPE_CLASS:
|
|
|
|
|
entity_id = TU_U16_HIGH(request->wIndex);
|
|
|
|
|
case TUSB_REQ_TYPE_CLASS: {
|
|
|
|
|
uint_fast8_t entity_id = TU_U16_HIGH(request->wIndex);
|
|
|
|
|
if (!entity_id) {
|
|
|
|
|
return handle_video_ctl_cs_req(rhport, stage, request, ctl_idx);
|
|
|
|
|
} else {
|
|
|
|
|
TU_VERIFY(_find_desc_entity(_get_desc_vc(&_videod_itf[ctl_idx]), entity_id), VIDEO_ERROR_INVALID_REQUEST);
|
|
|
|
|
return VIDEO_ERROR_NONE;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
default:
|
|
|
|
|
return VIDEO_ERROR_INVALID_REQUEST;
|
|
|
|
@@ -899,6 +964,7 @@ static int handle_video_stm_std_req(uint8_t rhport, uint8_t stage,
|
|
|
|
|
tusb_control_request_t const *request,
|
|
|
|
|
uint_fast8_t stm_idx)
|
|
|
|
|
{
|
|
|
|
|
TU_LOG_DRV("\r\n");
|
|
|
|
|
videod_streaming_interface_t *self = &_videod_streaming_itf[stm_idx];
|
|
|
|
|
switch (request->bRequest) {
|
|
|
|
|
case TUSB_REQ_GET_INTERFACE:
|
|
|
|
@@ -914,8 +980,7 @@ static int handle_video_stm_std_req(uint8_t rhport, uint8_t stage,
|
|
|
|
|
return VIDEO_ERROR_NONE;
|
|
|
|
|
|
|
|
|
|
case TUSB_REQ_SET_INTERFACE:
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP)
|
|
|
|
|
{
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP) {
|
|
|
|
|
TU_VERIFY(_open_vs_itf(rhport, self, request->wValue), VIDEO_ERROR_UNKNOWN);
|
|
|
|
|
tud_control_status(rhport, request);
|
|
|
|
|
}
|
|
|
|
@@ -929,26 +994,26 @@ static int handle_video_stm_std_req(uint8_t rhport, uint8_t stage,
|
|
|
|
|
|
|
|
|
|
static int handle_video_stm_cs_req(uint8_t rhport, uint8_t stage,
|
|
|
|
|
tusb_control_request_t const *request,
|
|
|
|
|
uint_fast8_t stm_idx)
|
|
|
|
|
{
|
|
|
|
|
uint_fast8_t stm_idx) {
|
|
|
|
|
(void)rhport;
|
|
|
|
|
videod_streaming_interface_t *self = &_videod_streaming_itf[stm_idx];
|
|
|
|
|
|
|
|
|
|
uint8_t const ctrl_sel = TU_U16_HIGH(request->wValue);
|
|
|
|
|
TU_LOG_DRV("%s_Control(%s)\r\n", tu_str_video_vs_control_selector[ctrl_sel], tu_lookup_find(&tu_table_video_request, request->bRequest));
|
|
|
|
|
|
|
|
|
|
/* 4.2.1 Interface Control Request */
|
|
|
|
|
switch (TU_U16_HIGH(request->wValue)) {
|
|
|
|
|
switch (ctrl_sel) {
|
|
|
|
|
case VIDEO_VS_CTL_STREAM_ERROR_CODE:
|
|
|
|
|
switch (request->bRequest) {
|
|
|
|
|
case VIDEO_REQUEST_GET_CUR:
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP)
|
|
|
|
|
{
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP) {
|
|
|
|
|
/* TODO */
|
|
|
|
|
TU_VERIFY(tud_control_xfer(rhport, request, &self->error_code, sizeof(uint8_t)), VIDEO_ERROR_UNKNOWN);
|
|
|
|
|
}
|
|
|
|
|
return VIDEO_ERROR_NONE;
|
|
|
|
|
|
|
|
|
|
case VIDEO_REQUEST_GET_INFO:
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP)
|
|
|
|
|
{
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP) {
|
|
|
|
|
TU_VERIFY(tud_control_xfer(rhport, request, (uint8_t*)(uintptr_t) &_cap_get, sizeof(_cap_get)), VIDEO_ERROR_UNKNOWN);
|
|
|
|
|
}
|
|
|
|
|
return VIDEO_ERROR_NONE;
|
|
|
|
@@ -962,6 +1027,7 @@ static int handle_video_stm_cs_req(uint8_t rhport, uint8_t stage,
|
|
|
|
|
self->state = VS_STATE_PROBING;
|
|
|
|
|
_init_vs_configuration(self);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
switch (request->bRequest) {
|
|
|
|
|
case VIDEO_REQUEST_SET_CUR:
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP) {
|
|
|
|
@@ -975,8 +1041,7 @@ static int handle_video_stm_cs_req(uint8_t rhport, uint8_t stage,
|
|
|
|
|
return VIDEO_ERROR_NONE;
|
|
|
|
|
|
|
|
|
|
case VIDEO_REQUEST_GET_CUR:
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP)
|
|
|
|
|
{
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP) {
|
|
|
|
|
TU_VERIFY(request->wLength, VIDEO_ERROR_UNKNOWN);
|
|
|
|
|
TU_VERIFY(tud_control_xfer(rhport, request, self->ep_buf, sizeof(video_probe_and_commit_control_t)), VIDEO_ERROR_UNKNOWN);
|
|
|
|
|
}
|
|
|
|
@@ -986,8 +1051,7 @@ static int handle_video_stm_cs_req(uint8_t rhport, uint8_t stage,
|
|
|
|
|
case VIDEO_REQUEST_GET_MAX:
|
|
|
|
|
case VIDEO_REQUEST_GET_RES:
|
|
|
|
|
case VIDEO_REQUEST_GET_DEF:
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP)
|
|
|
|
|
{
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP) {
|
|
|
|
|
TU_VERIFY(request->wLength, VIDEO_ERROR_UNKNOWN);
|
|
|
|
|
video_probe_and_commit_control_t tmp;
|
|
|
|
|
tmp = *(video_probe_and_commit_control_t*)&self->ep_buf;
|
|
|
|
@@ -997,8 +1061,7 @@ static int handle_video_stm_cs_req(uint8_t rhport, uint8_t stage,
|
|
|
|
|
return VIDEO_ERROR_NONE;
|
|
|
|
|
|
|
|
|
|
case VIDEO_REQUEST_GET_LEN:
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP)
|
|
|
|
|
{
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP) {
|
|
|
|
|
TU_VERIFY(2 == request->wLength, VIDEO_ERROR_UNKNOWN);
|
|
|
|
|
uint16_t len = sizeof(video_probe_and_commit_control_t);
|
|
|
|
|
TU_VERIFY(tud_control_xfer(rhport, request, (uint8_t*)&len, sizeof(len)), VIDEO_ERROR_UNKNOWN);
|
|
|
|
@@ -1006,8 +1069,7 @@ static int handle_video_stm_cs_req(uint8_t rhport, uint8_t stage,
|
|
|
|
|
return VIDEO_ERROR_NONE;
|
|
|
|
|
|
|
|
|
|
case VIDEO_REQUEST_GET_INFO:
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP)
|
|
|
|
|
{
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP) {
|
|
|
|
|
TU_VERIFY(1 == request->wLength, VIDEO_ERROR_UNKNOWN);
|
|
|
|
|
TU_VERIFY(tud_control_xfer(rhport, request, (uint8_t*)(uintptr_t)&_cap_get_set, sizeof(_cap_get_set)), VIDEO_ERROR_UNKNOWN);
|
|
|
|
|
}
|
|
|
|
@@ -1046,16 +1108,14 @@ static int handle_video_stm_cs_req(uint8_t rhport, uint8_t stage,
|
|
|
|
|
return VIDEO_ERROR_NONE;
|
|
|
|
|
|
|
|
|
|
case VIDEO_REQUEST_GET_CUR:
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP)
|
|
|
|
|
{
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP) {
|
|
|
|
|
TU_VERIFY(request->wLength, VIDEO_ERROR_UNKNOWN);
|
|
|
|
|
TU_VERIFY(tud_control_xfer(rhport, request, self->ep_buf, sizeof(video_probe_and_commit_control_t)), VIDEO_ERROR_UNKNOWN);
|
|
|
|
|
}
|
|
|
|
|
return VIDEO_ERROR_NONE;
|
|
|
|
|
|
|
|
|
|
case VIDEO_REQUEST_GET_LEN:
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP)
|
|
|
|
|
{
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP) {
|
|
|
|
|
TU_VERIFY(2 == request->wLength, VIDEO_ERROR_UNKNOWN);
|
|
|
|
|
uint16_t len = sizeof(video_probe_and_commit_control_t);
|
|
|
|
|
TU_VERIFY(tud_control_xfer(rhport, request, (uint8_t*)&len, sizeof(len)), VIDEO_ERROR_UNKNOWN);
|
|
|
|
@@ -1063,8 +1123,7 @@ static int handle_video_stm_cs_req(uint8_t rhport, uint8_t stage,
|
|
|
|
|
return VIDEO_ERROR_NONE;
|
|
|
|
|
|
|
|
|
|
case VIDEO_REQUEST_GET_INFO:
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP)
|
|
|
|
|
{
|
|
|
|
|
if (stage == CONTROL_STAGE_SETUP) {
|
|
|
|
|
TU_VERIFY(1 == request->wLength, VIDEO_ERROR_UNKNOWN);
|
|
|
|
|
TU_VERIFY(tud_control_xfer(rhport, request, (uint8_t*)(uintptr_t) &_cap_get_set, sizeof(_cap_get_set)), VIDEO_ERROR_UNKNOWN);
|
|
|
|
|
}
|
|
|
|
@@ -1264,6 +1323,7 @@ bool videod_control_xfer_cb(uint8_t rhport, uint8_t stage, tusb_control_request_
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (itf < CFG_TUD_VIDEO) {
|
|
|
|
|
TU_LOG_DRV(" VC[%d]: ", itf);
|
|
|
|
|
err = handle_video_ctl_req(rhport, stage, request, itf);
|
|
|
|
|
_videod_itf[itf].error_code = (uint8_t)err;
|
|
|
|
|
if (err) return false;
|
|
|
|
@@ -1279,6 +1339,7 @@ bool videod_control_xfer_cb(uint8_t rhport, uint8_t stage, tusb_control_request_
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (itf < CFG_TUD_VIDEO_STREAMING) {
|
|
|
|
|
TU_LOG_DRV(" VS[%d]: ", itf);
|
|
|
|
|
err = handle_video_stm_req(rhport, stage, request, itf);
|
|
|
|
|
_videod_streaming_itf[itf].error_code = (uint8_t)err;
|
|
|
|
|
if (err) return false;
|
|
|
|
|