mirror of
https://github.com/hathach/tinyusb.git
synced 2025-02-21 03:40:52 +00:00
Merge pull request #1985 from kkitayam/uvc_bulk
Add the capability for video class to handle a bulk endpoint in the streaming interface.
This commit is contained in:
commit
433ffe2152
@ -100,6 +100,9 @@
|
|||||||
// video streaming endpoint size
|
// video streaming endpoint size
|
||||||
#define CFG_TUD_VIDEO_STREAMING_EP_BUFSIZE 256
|
#define CFG_TUD_VIDEO_STREAMING_EP_BUFSIZE 256
|
||||||
|
|
||||||
|
// use bulk endpoint for streaming interface
|
||||||
|
#define CFG_TUD_VIDEO_STREAMING_BULK 0
|
||||||
|
|
||||||
#ifdef __cplusplus
|
#ifdef __cplusplus
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
@ -76,15 +76,27 @@ uint8_t const * tud_descriptor_device_cb(void)
|
|||||||
//--------------------------------------------------------------------+
|
//--------------------------------------------------------------------+
|
||||||
|
|
||||||
#if defined(CFG_EXAMPLE_VIDEO_READONLY) && !defined(CFG_EXAMPLE_VIDEO_DISABLE_MJPEG)
|
#if defined(CFG_EXAMPLE_VIDEO_READONLY) && !defined(CFG_EXAMPLE_VIDEO_DISABLE_MJPEG)
|
||||||
#define CONFIG_TOTAL_LEN (TUD_CONFIG_DESC_LEN + TUD_VIDEO_CAPTURE_DESC_MJPEG_LEN)
|
# if 1 == CFG_TUD_VIDEO_STREAMING_BULK
|
||||||
|
# define CONFIG_TOTAL_LEN (TUD_CONFIG_DESC_LEN + TUD_VIDEO_CAPTURE_DESC_MJPEG_BULK_LEN)
|
||||||
|
# else
|
||||||
|
# define CONFIG_TOTAL_LEN (TUD_CONFIG_DESC_LEN + TUD_VIDEO_CAPTURE_DESC_MJPEG_LEN)
|
||||||
|
# endif
|
||||||
#else
|
#else
|
||||||
#define CONFIG_TOTAL_LEN (TUD_CONFIG_DESC_LEN + TUD_VIDEO_CAPTURE_DESC_UNCOMPR_LEN)
|
# if 1 == CFG_TUD_VIDEO_STREAMING_BULK
|
||||||
|
# define CONFIG_TOTAL_LEN (TUD_CONFIG_DESC_LEN + TUD_VIDEO_CAPTURE_DESC_UNCOMPR_BULK_LEN)
|
||||||
|
# else
|
||||||
|
# define CONFIG_TOTAL_LEN (TUD_CONFIG_DESC_LEN + TUD_VIDEO_CAPTURE_DESC_UNCOMPR_LEN)
|
||||||
|
# endif
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if TU_CHECK_MCU(OPT_MCU_LPC175X_6X, OPT_MCU_LPC177X_8X, OPT_MCU_LPC40XX)
|
#if TU_CHECK_MCU(OPT_MCU_LPC175X_6X, OPT_MCU_LPC177X_8X, OPT_MCU_LPC40XX)
|
||||||
// LPC 17xx and 40xx endpoint type (bulk/interrupt/iso) are fixed by its number
|
// LPC 17xx and 40xx endpoint type (bulk/interrupt/iso) are fixed by its number
|
||||||
// 0 control, 1 In, 2 Bulk, 3 Iso, 4 In, 5 Bulk etc ...
|
// 0 control, 1 In, 2 Bulk, 3 Iso, 4 In, 5 Bulk etc ...
|
||||||
|
#if 1 == CFG_TUD_VIDEO_STREAMING_BULK
|
||||||
|
#define EPNUM_VIDEO_IN 0x82
|
||||||
|
#else
|
||||||
#define EPNUM_VIDEO_IN 0x83
|
#define EPNUM_VIDEO_IN 0x83
|
||||||
|
#endif
|
||||||
|
|
||||||
#elif TU_CHECK_MCU(OPT_MCU_NRF5X)
|
#elif TU_CHECK_MCU(OPT_MCU_NRF5X)
|
||||||
// nRF5x ISO can only be endpoint 8
|
// nRF5x ISO can only be endpoint 8
|
||||||
@ -102,13 +114,25 @@ uint8_t const desc_fs_configuration[] =
|
|||||||
|
|
||||||
// IAD for Video Control
|
// IAD for Video Control
|
||||||
#if defined(CFG_EXAMPLE_VIDEO_READONLY) && !defined(CFG_EXAMPLE_VIDEO_DISABLE_MJPEG)
|
#if defined(CFG_EXAMPLE_VIDEO_READONLY) && !defined(CFG_EXAMPLE_VIDEO_DISABLE_MJPEG)
|
||||||
|
# if 1 == CFG_TUD_VIDEO_STREAMING_BULK
|
||||||
|
TUD_VIDEO_CAPTURE_DESCRIPTOR_MJPEG_BULK(4, EPNUM_VIDEO_IN,
|
||||||
|
FRAME_WIDTH, FRAME_HEIGHT, FRAME_RATE,
|
||||||
|
64)
|
||||||
|
# else
|
||||||
TUD_VIDEO_CAPTURE_DESCRIPTOR_MJPEG(4, EPNUM_VIDEO_IN,
|
TUD_VIDEO_CAPTURE_DESCRIPTOR_MJPEG(4, EPNUM_VIDEO_IN,
|
||||||
FRAME_WIDTH, FRAME_HEIGHT, FRAME_RATE,
|
FRAME_WIDTH, FRAME_HEIGHT, FRAME_RATE,
|
||||||
CFG_TUD_VIDEO_STREAMING_EP_BUFSIZE)
|
CFG_TUD_VIDEO_STREAMING_EP_BUFSIZE)
|
||||||
|
# endif
|
||||||
#else
|
#else
|
||||||
|
# if 1 == CFG_TUD_VIDEO_STREAMING_BULK
|
||||||
|
TUD_VIDEO_CAPTURE_DESCRIPTOR_UNCOMPR_BULK(4, EPNUM_VIDEO_IN,
|
||||||
|
FRAME_WIDTH, FRAME_HEIGHT, FRAME_RATE,
|
||||||
|
64)
|
||||||
|
# else
|
||||||
TUD_VIDEO_CAPTURE_DESCRIPTOR_UNCOMPR(4, EPNUM_VIDEO_IN,
|
TUD_VIDEO_CAPTURE_DESCRIPTOR_UNCOMPR(4, EPNUM_VIDEO_IN,
|
||||||
FRAME_WIDTH, FRAME_HEIGHT, FRAME_RATE,
|
FRAME_WIDTH, FRAME_HEIGHT, FRAME_RATE,
|
||||||
CFG_TUD_VIDEO_STREAMING_EP_BUFSIZE)
|
CFG_TUD_VIDEO_STREAMING_EP_BUFSIZE)
|
||||||
|
# endif
|
||||||
#endif
|
#endif
|
||||||
};
|
};
|
||||||
|
|
||||||
|
@ -79,6 +79,38 @@ enum {
|
|||||||
+ 7/* Endpoint */\
|
+ 7/* Endpoint */\
|
||||||
)
|
)
|
||||||
|
|
||||||
|
#define TUD_VIDEO_CAPTURE_DESC_UNCOMPR_BULK_LEN (\
|
||||||
|
TUD_VIDEO_DESC_IAD_LEN\
|
||||||
|
/* control */\
|
||||||
|
+ TUD_VIDEO_DESC_STD_VC_LEN\
|
||||||
|
+ (TUD_VIDEO_DESC_CS_VC_LEN + 1/*bInCollection*/)\
|
||||||
|
+ TUD_VIDEO_DESC_CAMERA_TERM_LEN\
|
||||||
|
+ TUD_VIDEO_DESC_OUTPUT_TERM_LEN\
|
||||||
|
/* Interface 1, Alternate 0 */\
|
||||||
|
+ TUD_VIDEO_DESC_STD_VS_LEN\
|
||||||
|
+ (TUD_VIDEO_DESC_CS_VS_IN_LEN + 1/*bNumFormats x bControlSize*/)\
|
||||||
|
+ TUD_VIDEO_DESC_CS_VS_FMT_UNCOMPR_LEN\
|
||||||
|
+ TUD_VIDEO_DESC_CS_VS_FRM_UNCOMPR_CONT_LEN\
|
||||||
|
+ TUD_VIDEO_DESC_CS_VS_COLOR_MATCHING_LEN\
|
||||||
|
+ 7/* Endpoint */\
|
||||||
|
)
|
||||||
|
|
||||||
|
#define TUD_VIDEO_CAPTURE_DESC_MJPEG_BULK_LEN (\
|
||||||
|
TUD_VIDEO_DESC_IAD_LEN\
|
||||||
|
/* control */\
|
||||||
|
+ TUD_VIDEO_DESC_STD_VC_LEN\
|
||||||
|
+ (TUD_VIDEO_DESC_CS_VC_LEN + 1/*bInCollection*/)\
|
||||||
|
+ TUD_VIDEO_DESC_CAMERA_TERM_LEN\
|
||||||
|
+ TUD_VIDEO_DESC_OUTPUT_TERM_LEN\
|
||||||
|
/* Interface 1, Alternate 0 */\
|
||||||
|
+ TUD_VIDEO_DESC_STD_VS_LEN\
|
||||||
|
+ (TUD_VIDEO_DESC_CS_VS_IN_LEN + 1/*bNumFormats x bControlSize*/)\
|
||||||
|
+ TUD_VIDEO_DESC_CS_VS_FMT_MJPEG_LEN\
|
||||||
|
+ TUD_VIDEO_DESC_CS_VS_FRM_MJPEG_CONT_LEN\
|
||||||
|
+ TUD_VIDEO_DESC_CS_VS_COLOR_MATCHING_LEN\
|
||||||
|
+ 7/* Endpoint */\
|
||||||
|
)
|
||||||
|
|
||||||
/* Windows support YUY2 and NV12
|
/* Windows support YUY2 and NV12
|
||||||
* https://docs.microsoft.com/en-us/windows-hardware/drivers/stream/usb-video-class-driver-overview */
|
* https://docs.microsoft.com/en-us/windows-hardware/drivers/stream/usb-video-class-driver-overview */
|
||||||
|
|
||||||
@ -165,4 +197,75 @@ enum {
|
|||||||
/* EP */ \
|
/* EP */ \
|
||||||
TUD_VIDEO_DESC_EP_ISO(_epin, _epsize, 1)
|
TUD_VIDEO_DESC_EP_ISO(_epin, _epsize, 1)
|
||||||
|
|
||||||
|
|
||||||
|
#define TUD_VIDEO_CAPTURE_DESCRIPTOR_UNCOMPR_BULK(_stridx, _epin, _width, _height, _fps, _epsize) \
|
||||||
|
TUD_VIDEO_DESC_IAD(ITF_NUM_VIDEO_CONTROL, /* 2 Interfaces */ 0x02, _stridx), \
|
||||||
|
/* Video control 0 */ \
|
||||||
|
TUD_VIDEO_DESC_STD_VC(ITF_NUM_VIDEO_CONTROL, 0, _stridx), \
|
||||||
|
TUD_VIDEO_DESC_CS_VC( /* UVC 1.5*/ 0x0150, \
|
||||||
|
/* wTotalLength - bLength */ \
|
||||||
|
TUD_VIDEO_DESC_CAMERA_TERM_LEN + TUD_VIDEO_DESC_OUTPUT_TERM_LEN, \
|
||||||
|
UVC_CLOCK_FREQUENCY, ITF_NUM_VIDEO_STREAMING), \
|
||||||
|
TUD_VIDEO_DESC_CAMERA_TERM(UVC_ENTITY_CAP_INPUT_TERMINAL, 0, 0,\
|
||||||
|
/*wObjectiveFocalLengthMin*/0, /*wObjectiveFocalLengthMax*/0,\
|
||||||
|
/*wObjectiveFocalLength*/0, /*bmControls*/0), \
|
||||||
|
TUD_VIDEO_DESC_OUTPUT_TERM(UVC_ENTITY_CAP_OUTPUT_TERMINAL, VIDEO_TT_STREAMING, 0, 1, 0), \
|
||||||
|
/* Video stream alt. 0 */ \
|
||||||
|
TUD_VIDEO_DESC_STD_VS(ITF_NUM_VIDEO_STREAMING, 0, 1, _stridx), \
|
||||||
|
/* Video stream header for without still image capture */ \
|
||||||
|
TUD_VIDEO_DESC_CS_VS_INPUT( /*bNumFormats*/1, \
|
||||||
|
/*wTotalLength - bLength */\
|
||||||
|
TUD_VIDEO_DESC_CS_VS_FMT_UNCOMPR_LEN\
|
||||||
|
+ TUD_VIDEO_DESC_CS_VS_FRM_UNCOMPR_CONT_LEN\
|
||||||
|
+ TUD_VIDEO_DESC_CS_VS_COLOR_MATCHING_LEN,\
|
||||||
|
_epin, /*bmInfo*/0, /*bTerminalLink*/UVC_ENTITY_CAP_OUTPUT_TERMINAL, \
|
||||||
|
/*bStillCaptureMethod*/0, /*bTriggerSupport*/0, /*bTriggerUsage*/0, \
|
||||||
|
/*bmaControls(1)*/0), \
|
||||||
|
/* Video stream format */ \
|
||||||
|
TUD_VIDEO_DESC_CS_VS_FMT_YUY2(/*bFormatIndex*/1, /*bNumFrameDescriptors*/1, \
|
||||||
|
/*bDefaultFrameIndex*/1, 0, 0, 0, /*bCopyProtect*/0), \
|
||||||
|
/* Video stream frame format */ \
|
||||||
|
TUD_VIDEO_DESC_CS_VS_FRM_UNCOMPR_CONT(/*bFrameIndex */1, 0, _width, _height, \
|
||||||
|
_width * _height * 16, _width * _height * 16 * _fps, \
|
||||||
|
_width * _height * 16, \
|
||||||
|
(10000000/_fps), (10000000/_fps), (10000000/_fps)*_fps, (10000000/_fps)), \
|
||||||
|
TUD_VIDEO_DESC_CS_VS_COLOR_MATCHING(VIDEO_COLOR_PRIMARIES_BT709, VIDEO_COLOR_XFER_CH_BT709, VIDEO_COLOR_COEF_SMPTE170M), \
|
||||||
|
TUD_VIDEO_DESC_EP_BULK(_epin, _epsize, 1)
|
||||||
|
|
||||||
|
#define TUD_VIDEO_CAPTURE_DESCRIPTOR_MJPEG_BULK(_stridx, _epin, _width, _height, _fps, _epsize) \
|
||||||
|
TUD_VIDEO_DESC_IAD(ITF_NUM_VIDEO_CONTROL, /* 2 Interfaces */ 0x02, _stridx), \
|
||||||
|
/* Video control 0 */ \
|
||||||
|
TUD_VIDEO_DESC_STD_VC(ITF_NUM_VIDEO_CONTROL, 0, _stridx), \
|
||||||
|
TUD_VIDEO_DESC_CS_VC( /* UVC 1.5*/ 0x0150, \
|
||||||
|
/* wTotalLength - bLength */ \
|
||||||
|
TUD_VIDEO_DESC_CAMERA_TERM_LEN + TUD_VIDEO_DESC_OUTPUT_TERM_LEN, \
|
||||||
|
UVC_CLOCK_FREQUENCY, ITF_NUM_VIDEO_STREAMING), \
|
||||||
|
TUD_VIDEO_DESC_CAMERA_TERM(UVC_ENTITY_CAP_INPUT_TERMINAL, 0, 0,\
|
||||||
|
/*wObjectiveFocalLengthMin*/0, /*wObjectiveFocalLengthMax*/0,\
|
||||||
|
/*wObjectiveFocalLength*/0, /*bmControls*/0), \
|
||||||
|
TUD_VIDEO_DESC_OUTPUT_TERM(UVC_ENTITY_CAP_OUTPUT_TERMINAL, VIDEO_TT_STREAMING, 0, 1, 0), \
|
||||||
|
/* Video stream alt. 0 */ \
|
||||||
|
TUD_VIDEO_DESC_STD_VS(ITF_NUM_VIDEO_STREAMING, 0, 1, _stridx), \
|
||||||
|
/* Video stream header for without still image capture */ \
|
||||||
|
TUD_VIDEO_DESC_CS_VS_INPUT( /*bNumFormats*/1, \
|
||||||
|
/*wTotalLength - bLength */\
|
||||||
|
TUD_VIDEO_DESC_CS_VS_FMT_MJPEG_LEN\
|
||||||
|
+ TUD_VIDEO_DESC_CS_VS_FRM_MJPEG_CONT_LEN\
|
||||||
|
+ TUD_VIDEO_DESC_CS_VS_COLOR_MATCHING_LEN,\
|
||||||
|
_epin, /*bmInfo*/0, /*bTerminalLink*/UVC_ENTITY_CAP_OUTPUT_TERMINAL, \
|
||||||
|
/*bStillCaptureMethod*/0, /*bTriggerSupport*/0, /*bTriggerUsage*/0, \
|
||||||
|
/*bmaControls(1)*/0), \
|
||||||
|
/* Video stream format */ \
|
||||||
|
TUD_VIDEO_DESC_CS_VS_FMT_MJPEG(/*bFormatIndex*/1, /*bNumFrameDescriptors*/1, \
|
||||||
|
/*bmFlags*/0, /*bDefaultFrameIndex*/1, 0, 0, 0, /*bCopyProtect*/0), \
|
||||||
|
/* Video stream frame format */ \
|
||||||
|
TUD_VIDEO_DESC_CS_VS_FRM_MJPEG_CONT(/*bFrameIndex */1, 0, _width, _height, \
|
||||||
|
_width * _height * 16, _width * _height * 16 * _fps, \
|
||||||
|
_width * _height * 16 / 8, \
|
||||||
|
(10000000/_fps), (10000000/_fps), (10000000/_fps)*_fps, (10000000/_fps)), \
|
||||||
|
TUD_VIDEO_DESC_CS_VS_COLOR_MATCHING(VIDEO_COLOR_PRIMARIES_BT709, VIDEO_COLOR_XFER_CH_BT709, VIDEO_COLOR_COEF_SMPTE170M), \
|
||||||
|
/* EP */ \
|
||||||
|
TUD_VIDEO_DESC_EP_BULK(_epin, _epsize, 1)
|
||||||
|
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
@ -37,6 +37,10 @@
|
|||||||
//--------------------------------------------------------------------+
|
//--------------------------------------------------------------------+
|
||||||
// MACRO CONSTANT TYPEDEF
|
// MACRO CONSTANT TYPEDEF
|
||||||
//--------------------------------------------------------------------+
|
//--------------------------------------------------------------------+
|
||||||
|
#define VS_STATE_PROBING 0 /* Configuration in progress */
|
||||||
|
#define VS_STATE_COMMITTED 1 /* Ready for streaming or Streaming via bulk endpoint */
|
||||||
|
#define VS_STATE_STREAMING 2 /* Streaming via isochronous endpoint */
|
||||||
|
|
||||||
typedef struct {
|
typedef struct {
|
||||||
tusb_desc_interface_t std;
|
tusb_desc_interface_t std;
|
||||||
tusb_desc_cs_video_ctl_itf_hdr_t ctl;
|
tusb_desc_cs_video_ctl_itf_hdr_t ctl;
|
||||||
@ -102,6 +106,7 @@ typedef struct TU_ATTR_PACKED {
|
|||||||
uint32_t offset; /* offset for the next payload transfer */
|
uint32_t offset; /* offset for the next payload transfer */
|
||||||
uint32_t max_payload_transfer_size;
|
uint32_t max_payload_transfer_size;
|
||||||
uint8_t error_code;/* error code */
|
uint8_t error_code;/* error code */
|
||||||
|
uint8_t state; /* 0:probing 1:committed 2:streaming */
|
||||||
/*------------- From this point, data is not cleared by bus reset -------------*/
|
/*------------- From this point, data is not cleared by bus reset -------------*/
|
||||||
CFG_TUSB_MEM_ALIGN uint8_t ep_buf[CFG_TUD_VIDEO_STREAMING_EP_BUFSIZE]; /* EP transfer buffer for streaming */
|
CFG_TUSB_MEM_ALIGN uint8_t ep_buf[CFG_TUD_VIDEO_STREAMING_EP_BUFSIZE]; /* EP transfer buffer for streaming */
|
||||||
} videod_streaming_interface_t;
|
} videod_streaming_interface_t;
|
||||||
@ -639,6 +644,17 @@ static bool _open_vc_itf(uint8_t rhport, videod_interface_t *self, uint_fast8_t
|
|||||||
return true;
|
return true;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
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;
|
||||||
|
tu_memclr(param, sizeof(*param));
|
||||||
|
return _update_streaming_parameters(stm, param);
|
||||||
|
}
|
||||||
|
|
||||||
/** Set the alternate setting to own video streaming interface.
|
/** Set the alternate setting to own video streaming interface.
|
||||||
*
|
*
|
||||||
* @param[in,out] stm Streaming interface context.
|
* @param[in,out] stm Streaming interface context.
|
||||||
@ -672,42 +688,32 @@ static bool _open_vs_itf(uint8_t rhport, videod_streaming_interface_t *stm, uint
|
|||||||
|
|
||||||
uint_fast8_t numeps = ((tusb_desc_interface_t const *)cur)->bNumEndpoints;
|
uint_fast8_t numeps = ((tusb_desc_interface_t const *)cur)->bNumEndpoints;
|
||||||
TU_ASSERT(numeps <= TU_ARRAY_SIZE(stm->desc.ep));
|
TU_ASSERT(numeps <= TU_ARRAY_SIZE(stm->desc.ep));
|
||||||
stm->desc.cur = (uint16_t) (cur - desc); /* Save the offset of the new settings */
|
stm->desc.cur = (uint16_t)(cur - desc); /* Save the offset of the new settings */
|
||||||
if (!altnum) {
|
if (!altnum && (VS_STATE_COMMITTED != stm->state)) {
|
||||||
/* initialize streaming settings */
|
TU_VERIFY(_init_vs_configuration(stm));
|
||||||
stm->max_payload_transfer_size = 0;
|
|
||||||
video_probe_and_commit_control_t *param =
|
|
||||||
(video_probe_and_commit_control_t *)&stm->ep_buf;
|
|
||||||
tu_memclr(param, sizeof(*param));
|
|
||||||
TU_LOG2(" done 0\n");
|
|
||||||
return _update_streaming_parameters(stm, param);
|
|
||||||
}
|
}
|
||||||
/* Open endpoints of the new settings. */
|
/* Open bulk or isochronous endpoints of the new settings. */
|
||||||
for (i = 0, cur = tu_desc_next(cur); i < numeps; ++i, cur = tu_desc_next(cur)) {
|
for (i = 0, cur = tu_desc_next(cur); i < numeps; ++i, cur = tu_desc_next(cur)) {
|
||||||
cur = _find_desc_ep(cur, end);
|
cur = _find_desc_ep(cur, end);
|
||||||
TU_ASSERT(cur < end);
|
TU_ASSERT(cur < end);
|
||||||
tusb_desc_endpoint_t const *ep = (tusb_desc_endpoint_t const*)cur;
|
tusb_desc_endpoint_t const *ep = (tusb_desc_endpoint_t const*)cur;
|
||||||
if (!stm->max_payload_transfer_size) {
|
uint_fast32_t max_size = stm->max_payload_transfer_size;
|
||||||
video_probe_and_commit_control_t const *param = (video_probe_and_commit_control_t const*)&stm->ep_buf;
|
if (altnum) {
|
||||||
uint_fast32_t max_size = param->dwMaxPayloadTransferSize;
|
|
||||||
if ((TUSB_XFER_ISOCHRONOUS == ep->bmAttributes.xfer) &&
|
if ((TUSB_XFER_ISOCHRONOUS == ep->bmAttributes.xfer) &&
|
||||||
(tu_edpt_packet_size(ep) < max_size))
|
(tu_edpt_packet_size(ep) < max_size)) {
|
||||||
{
|
|
||||||
/* FS must be less than or equal to max packet size */
|
/* FS must be less than or equal to max packet size */
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
/* Set the negotiated value */
|
} else {
|
||||||
stm->max_payload_transfer_size = max_size;
|
TU_VERIFY(TUSB_XFER_BULK == ep->bmAttributes.xfer);
|
||||||
}
|
}
|
||||||
TU_ASSERT(usbd_edpt_open(rhport, ep));
|
TU_ASSERT(usbd_edpt_open(rhport, ep));
|
||||||
stm->desc.ep[i] = (uint16_t) (cur - desc);
|
stm->desc.ep[i] = (uint16_t) (cur - desc);
|
||||||
TU_LOG2(" open EP%02x\n", _desc_ep_addr(cur));
|
TU_LOG2(" open EP%02x\n", _desc_ep_addr(cur));
|
||||||
}
|
}
|
||||||
/* initialize payload header */
|
if (altnum) {
|
||||||
tusb_video_payload_header_t *hdr = (tusb_video_payload_header_t*)stm->ep_buf;
|
stm->state = VS_STATE_STREAMING;
|
||||||
hdr->bHeaderLength = sizeof(*hdr);
|
}
|
||||||
hdr->bmHeaderInfo = 0;
|
|
||||||
|
|
||||||
TU_LOG2(" done\n");
|
TU_LOG2(" done\n");
|
||||||
return true;
|
return true;
|
||||||
}
|
}
|
||||||
@ -920,6 +926,10 @@ static int handle_video_stm_cs_req(uint8_t rhport, uint8_t stage,
|
|||||||
break;
|
break;
|
||||||
|
|
||||||
case VIDEO_VS_CTL_PROBE:
|
case VIDEO_VS_CTL_PROBE:
|
||||||
|
if (self->state != VS_STATE_PROBING) {
|
||||||
|
self->state = VS_STATE_PROBING;
|
||||||
|
_init_vs_configuration(self);
|
||||||
|
}
|
||||||
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) {
|
||||||
@ -982,9 +992,23 @@ static int handle_video_stm_cs_req(uint8_t rhport, uint8_t stage,
|
|||||||
TU_VERIFY(sizeof(video_probe_and_commit_control_t) >= request->wLength, VIDEO_ERROR_UNKNOWN);
|
TU_VERIFY(sizeof(video_probe_and_commit_control_t) >= 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);
|
TU_VERIFY(tud_control_xfer(rhport, request, self->ep_buf, sizeof(video_probe_and_commit_control_t)), VIDEO_ERROR_UNKNOWN);
|
||||||
} else if (stage == CONTROL_STAGE_DATA) {
|
} else if (stage == CONTROL_STAGE_DATA) {
|
||||||
TU_VERIFY(_update_streaming_parameters(self, (video_probe_and_commit_control_t*)self->ep_buf), VIDEO_ERROR_INVALID_VALUE_WITHIN_RANGE);
|
video_probe_and_commit_control_t *param = (video_probe_and_commit_control_t*)self->ep_buf;
|
||||||
|
TU_VERIFY(_update_streaming_parameters(self, param), VIDEO_ERROR_INVALID_VALUE_WITHIN_RANGE);
|
||||||
|
/* Set the negotiated value */
|
||||||
|
self->max_payload_transfer_size = param->dwMaxPayloadTransferSize;
|
||||||
|
int ret = VIDEO_ERROR_NONE;
|
||||||
if (tud_video_commit_cb) {
|
if (tud_video_commit_cb) {
|
||||||
return tud_video_commit_cb(self->index_vc, self->index_vs, (video_probe_and_commit_control_t*)self->ep_buf);
|
ret = tud_video_commit_cb(self->index_vc, self->index_vs, param);
|
||||||
|
}
|
||||||
|
if (VIDEO_ERROR_NONE == ret) {
|
||||||
|
self->state = VS_STATE_COMMITTED;
|
||||||
|
self->buffer = NULL;
|
||||||
|
self->bufsize = 0;
|
||||||
|
self->offset = 0;
|
||||||
|
/* initialize payload header */
|
||||||
|
tusb_video_payload_header_t *hdr = (tusb_video_payload_header_t*)self->ep_buf;
|
||||||
|
hdr->bHeaderLength = sizeof(*hdr);
|
||||||
|
hdr->bmHeaderInfo = 0;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
return VIDEO_ERROR_NONE;
|
return VIDEO_ERROR_NONE;
|
||||||
@ -1069,6 +1093,7 @@ bool tud_video_n_streaming(uint_fast8_t ctl_idx, uint_fast8_t stm_idx)
|
|||||||
TU_ASSERT(stm_idx < CFG_TUD_VIDEO_STREAMING);
|
TU_ASSERT(stm_idx < CFG_TUD_VIDEO_STREAMING);
|
||||||
videod_streaming_interface_t *stm = _get_instance_streaming(ctl_idx, stm_idx);
|
videod_streaming_interface_t *stm = _get_instance_streaming(ctl_idx, stm_idx);
|
||||||
if (!stm || !stm->desc.ep[0]) return false;
|
if (!stm || !stm->desc.ep[0]) return false;
|
||||||
|
if (stm->state == VS_STATE_PROBING) return false;
|
||||||
return true;
|
return true;
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -1079,6 +1104,7 @@ bool tud_video_n_frame_xfer(uint_fast8_t ctl_idx, uint_fast8_t stm_idx, void *bu
|
|||||||
if (!buffer || !bufsize) return false;
|
if (!buffer || !bufsize) return false;
|
||||||
videod_streaming_interface_t *stm = _get_instance_streaming(ctl_idx, stm_idx);
|
videod_streaming_interface_t *stm = _get_instance_streaming(ctl_idx, stm_idx);
|
||||||
if (!stm || !stm->desc.ep[0] || stm->buffer) return false;
|
if (!stm || !stm->desc.ep[0] || stm->buffer) return false;
|
||||||
|
if (stm->state == VS_STATE_PROBING) return false;
|
||||||
|
|
||||||
/* Find EP address */
|
/* Find EP address */
|
||||||
uint8_t const *desc = _videod_itf[stm->index_vc].beg;
|
uint8_t const *desc = _videod_itf[stm->index_vc].beg;
|
||||||
@ -1174,6 +1200,16 @@ uint16_t videod_open(uint8_t rhport, tusb_desc_interface_t const * itf_desc, uin
|
|||||||
stm->desc.beg = (uint16_t) ((uintptr_t)cur - (uintptr_t)itf_desc);
|
stm->desc.beg = (uint16_t) ((uintptr_t)cur - (uintptr_t)itf_desc);
|
||||||
cur = _next_desc_itf(cur, end);
|
cur = _next_desc_itf(cur, end);
|
||||||
stm->desc.end = (uint16_t) ((uintptr_t)cur - (uintptr_t)itf_desc);
|
stm->desc.end = (uint16_t) ((uintptr_t)cur - (uintptr_t)itf_desc);
|
||||||
|
stm->state = VS_STATE_PROBING;
|
||||||
|
if (0 == stm_idx && 1 == bInCollection) {
|
||||||
|
/* If there is only one streaming interface and no alternate settings,
|
||||||
|
* host may not issue set_interface so open the streaming interface here. */
|
||||||
|
uint8_t const *sbeg = (uint8_t const*)itf_desc + stm->desc.beg;
|
||||||
|
uint8_t const *send = (uint8_t const*)itf_desc + stm->desc.end;
|
||||||
|
if (end == _find_desc_itf(sbeg, send, _desc_itfnum(sbeg), 1)) {
|
||||||
|
TU_VERIFY(_open_vs_itf(rhport, stm, 0), 0);
|
||||||
|
}
|
||||||
|
}
|
||||||
}
|
}
|
||||||
self->len = (uint16_t) ((uintptr_t)cur - (uintptr_t)itf_desc);
|
self->len = (uint16_t) ((uintptr_t)cur - (uintptr_t)itf_desc);
|
||||||
return (uint16_t) ((uintptr_t)cur - (uintptr_t)itf_desc);
|
return (uint16_t) ((uintptr_t)cur - (uintptr_t)itf_desc);
|
||||||
@ -1187,7 +1223,6 @@ bool videod_control_xfer_cb(uint8_t rhport, uint8_t stage, tusb_control_request_
|
|||||||
int err;
|
int err;
|
||||||
TU_VERIFY(request->bmRequestType_bit.recipient == TUSB_REQ_RCPT_INTERFACE);
|
TU_VERIFY(request->bmRequestType_bit.recipient == TUSB_REQ_RCPT_INTERFACE);
|
||||||
uint_fast8_t itfnum = tu_u16_low(request->wIndex);
|
uint_fast8_t itfnum = tu_u16_low(request->wIndex);
|
||||||
|
|
||||||
/* Identify which control interface to use */
|
/* Identify which control interface to use */
|
||||||
uint_fast8_t itf;
|
uint_fast8_t itf;
|
||||||
for (itf = 0; itf < CFG_TUD_VIDEO; ++itf) {
|
for (itf = 0; itf < CFG_TUD_VIDEO; ++itf) {
|
||||||
|
Loading…
x
Reference in New Issue
Block a user