752 lines
37 KiB
C
752 lines
37 KiB
C
/**
|
|
* @file usbd_video.c
|
|
*
|
|
* Copyright (c) 2022 sakumisu
|
|
*
|
|
* Licensed to the Apache Software Foundation (ASF) under one or more
|
|
* contributor license agreements. See the NOTICE file distributed with
|
|
* this work for additional information regarding copyright ownership. The
|
|
* ASF licenses this file to you under the Apache License, Version 2.0 (the
|
|
* "License"); you may not use this file except in compliance with the
|
|
* License. You may obtain a copy of the License at
|
|
*
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
|
|
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
|
|
* License for the specific language governing permissions and limitations
|
|
* under the License.
|
|
*
|
|
*/
|
|
#include "usbd_core.h"
|
|
#include "usbd_video.h"
|
|
|
|
struct usbd_video_cfg_priv {
|
|
struct video_probe_and_commit_controls *probe;
|
|
struct video_probe_and_commit_controls *commit;
|
|
uint8_t power_mode;
|
|
uint8_t error_code;
|
|
uint8_t vcintf;
|
|
uint8_t vsintf;
|
|
usb_slist_t entity_info_list;
|
|
} usbd_video_cfg = { .vcintf = 0xff, .vsintf = 0xff };
|
|
|
|
static int usbd_video_control_request_handler(struct usb_setup_packet *setup, uint8_t **data, uint32_t *len)
|
|
{
|
|
uint8_t control_selector = (uint8_t)(setup->wValue >> 8);
|
|
|
|
switch (control_selector) {
|
|
case VIDEO_VC_VIDEO_POWER_MODE_CONTROL:
|
|
switch (setup->bRequest) {
|
|
case VIDEO_REQUEST_SET_CUR:
|
|
break;
|
|
case VIDEO_REQUEST_GET_CUR:
|
|
break;
|
|
case VIDEO_REQUEST_GET_INFO:
|
|
break;
|
|
default:
|
|
USB_LOG_WRN("Unhandled Video Class bRequest 0x%02x\r\n", setup->bRequest);
|
|
return -1;
|
|
}
|
|
|
|
break;
|
|
case VIDEO_VC_REQUEST_ERROR_CODE_CONTROL:
|
|
switch (setup->bRequest) {
|
|
case VIDEO_REQUEST_GET_CUR:
|
|
(*data)[0] = 0x06;
|
|
*len = 1;
|
|
break;
|
|
case VIDEO_REQUEST_GET_INFO:
|
|
break;
|
|
default:
|
|
USB_LOG_WRN("Unhandled Video Class bRequest 0x%02x\r\n", setup->bRequest);
|
|
return -1;
|
|
}
|
|
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int usbd_video_control_unit_terminal_request_handler(struct usb_setup_packet *setup, uint8_t **data, uint32_t *len)
|
|
{
|
|
uint8_t entity_id = (uint8_t)(setup->wIndex >> 8);
|
|
uint8_t control_selector = (uint8_t)(setup->wValue >> 8);
|
|
|
|
usb_slist_t *i;
|
|
usb_slist_for_each(i, &usbd_video_cfg.entity_info_list)
|
|
{
|
|
struct video_entity_info *entity_info = usb_slist_entry(i, struct video_entity_info, list);
|
|
if (entity_info->bEntityId == entity_id) {
|
|
switch (entity_info->bDescriptorSubtype) {
|
|
case VIDEO_VC_HEADER_DESCRIPTOR_SUBTYPE:
|
|
break;
|
|
case VIDEO_VC_INPUT_TERMINAL_DESCRIPTOR_SUBTYPE:
|
|
if (entity_info->wTerminalType == VIDEO_ITT_CAMERA) {
|
|
switch (control_selector) {
|
|
case VIDEO_CT_AE_MODE_CONTROL:
|
|
switch (setup->bRequest) {
|
|
case VIDEO_REQUEST_GET_CUR:
|
|
(*data)[0] = 0x08;
|
|
*len = 1;
|
|
break;
|
|
default:
|
|
USB_LOG_WRN("Unhandled Video Class bRequest 0x%02x\r\n", setup->bRequest);
|
|
return -1;
|
|
}
|
|
break;
|
|
case VIDEO_CT_EXPOSURE_TIME_ABSOLUTE_CONTROL:
|
|
switch (setup->bRequest) {
|
|
case VIDEO_REQUEST_GET_CUR: {
|
|
uint32_t dwExposureTimeAbsolute = 2500;
|
|
memcpy(*data, (uint8_t *)&dwExposureTimeAbsolute, 4);
|
|
*len = 4;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_MIN: {
|
|
uint32_t dwExposureTimeAbsolute = 5; //0.0005sec
|
|
memcpy(*data, (uint8_t *)&dwExposureTimeAbsolute, 4);
|
|
*len = 4;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_MAX: {
|
|
uint32_t dwExposureTimeAbsolute = 2500; //0.2500sec
|
|
memcpy(*data, (uint8_t *)&dwExposureTimeAbsolute, 4);
|
|
*len = 4;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_RES: {
|
|
uint32_t dwExposureTimeAbsolute = 5; //0.0005sec
|
|
memcpy(*data, (uint8_t *)&dwExposureTimeAbsolute, 4);
|
|
*len = 4;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_INFO:
|
|
(*data)[0] = 0x03; //struct video_camera_capabilities
|
|
*len = 1;
|
|
break;
|
|
case VIDEO_REQUEST_GET_DEF: {
|
|
uint32_t dwExposureTimeAbsolute = 2500; //0.2500sec
|
|
memcpy(*data, (uint8_t *)&dwExposureTimeAbsolute, 4);
|
|
*len = 4;
|
|
} break;
|
|
default:
|
|
USB_LOG_WRN("Unhandled Video Class bRequest 0x%02x\r\n", setup->bRequest);
|
|
return -1;
|
|
}
|
|
break;
|
|
case VIDEO_CT_FOCUS_ABSOLUTE_CONTROL:
|
|
switch (setup->bRequest) {
|
|
case VIDEO_REQUEST_GET_CUR: {
|
|
uint16_t wFocusAbsolute = 0x0080;
|
|
memcpy(*data, (uint8_t *)&wFocusAbsolute, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_MIN: {
|
|
uint16_t wFocusAbsolute = 0;
|
|
memcpy(*data, (uint8_t *)&wFocusAbsolute, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_MAX: {
|
|
uint16_t wFocusAbsolute = 0x00ff;
|
|
memcpy(*data, (uint8_t *)&wFocusAbsolute, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_RES: {
|
|
uint16_t wFocusAbsolute = 0x0001;
|
|
memcpy(*data, (uint8_t *)&wFocusAbsolute, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_INFO:
|
|
(*data)[0] = 0x03; //struct video_camera_capabilities
|
|
*len = 1;
|
|
break;
|
|
case VIDEO_REQUEST_GET_DEF: {
|
|
uint16_t wFocusAbsolute = 0x0080;
|
|
memcpy(*data, (uint8_t *)&wFocusAbsolute, 2);
|
|
*len = 2;
|
|
} break;
|
|
default:
|
|
USB_LOG_WRN("Unhandled Video Class bRequest 0x%02x\r\n", setup->bRequest);
|
|
return -1;
|
|
}
|
|
break;
|
|
case VIDEO_CT_ZOOM_ABSOLUTE_CONTROL:
|
|
switch (setup->bRequest) {
|
|
case VIDEO_REQUEST_GET_CUR: {
|
|
uint16_t wObjectiveFocalLength = 0x0064;
|
|
memcpy(*data, (uint8_t *)&wObjectiveFocalLength, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_MIN: {
|
|
uint16_t wObjectiveFocalLength = 0x0064;
|
|
memcpy(*data, (uint8_t *)&wObjectiveFocalLength, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_MAX: {
|
|
uint16_t wObjectiveFocalLength = 0x00c8;
|
|
memcpy(*data, (uint8_t *)&wObjectiveFocalLength, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_RES: {
|
|
uint16_t wObjectiveFocalLength = 0x0001;
|
|
memcpy(*data, (uint8_t *)&wObjectiveFocalLength, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_INFO:
|
|
(*data)[0] = 0x03; //struct video_camera_capabilities
|
|
*len = 1;
|
|
break;
|
|
case VIDEO_REQUEST_GET_DEF: {
|
|
uint16_t wObjectiveFocalLength = 0x0064;
|
|
memcpy(*data, (uint8_t *)&wObjectiveFocalLength, 2);
|
|
*len = 2;
|
|
} break;
|
|
default:
|
|
USB_LOG_WRN("Unhandled Video Class bRequest 0x%02x\r\n", setup->bRequest);
|
|
return -1;
|
|
}
|
|
break;
|
|
case VIDEO_CT_ROLL_ABSOLUTE_CONTROL:
|
|
switch (setup->bRequest) {
|
|
case VIDEO_REQUEST_GET_CUR: {
|
|
uint16_t wRollAbsolute = 0x0000;
|
|
memcpy(*data, (uint8_t *)&wRollAbsolute, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_MIN: {
|
|
uint16_t wRollAbsolute = 0x0000;
|
|
memcpy(*data, (uint8_t *)&wRollAbsolute, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_MAX: {
|
|
uint16_t wRollAbsolute = 0x00ff;
|
|
memcpy(*data, (uint8_t *)&wRollAbsolute, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_RES: {
|
|
uint16_t wRollAbsolute = 0x0001;
|
|
memcpy(*data, (uint8_t *)&wRollAbsolute, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_INFO:
|
|
(*data)[0] = 0x03; //struct video_camera_capabilities
|
|
*len = 1;
|
|
break;
|
|
case VIDEO_REQUEST_GET_DEF: {
|
|
uint16_t wRollAbsolute = 0x0000;
|
|
memcpy(*data, (uint8_t *)&wRollAbsolute, 2);
|
|
*len = 2;
|
|
} break;
|
|
default:
|
|
USB_LOG_WRN("Unhandled Video Class bRequest 0x%02x\r\n", setup->bRequest);
|
|
return -1;
|
|
}
|
|
break;
|
|
case VIDEO_CT_FOCUS_AUTO_CONTROL:
|
|
switch (setup->bRequest) {
|
|
case VIDEO_REQUEST_GET_CUR: {
|
|
uint16_t wFocusAuto = 0x0000;
|
|
memcpy(*data, (uint8_t *)&wFocusAuto, 2);
|
|
*len = 2;
|
|
} break;
|
|
default:
|
|
USB_LOG_WRN("Unhandled Video Class bRequest 0x%02x\r\n", setup->bRequest);
|
|
return -1;
|
|
}
|
|
break;
|
|
default:
|
|
USB_LOG_WRN("Unhandled Video Class control selector 0x%02x\r\n", control_selector);
|
|
return -1;
|
|
}
|
|
} else {
|
|
USB_LOG_WRN("Unhandled Video Class wTerminalType 0x%02x\r\n", entity_info->wTerminalType);
|
|
return -2;
|
|
}
|
|
break;
|
|
case VIDEO_VC_OUTPUT_TERMINAL_DESCRIPTOR_SUBTYPE:
|
|
break;
|
|
case VIDEO_VC_SELECTOR_UNIT_DESCRIPTOR_SUBTYPE:
|
|
break;
|
|
case VIDEO_VC_PROCESSING_UNIT_DESCRIPTOR_SUBTYPE:
|
|
switch (control_selector) {
|
|
case VIDEO_PU_BACKLIGHT_COMPENSATION_CONTROL:
|
|
switch (setup->bRequest) {
|
|
case VIDEO_REQUEST_GET_CUR: {
|
|
uint16_t wBacklightCompensation = 0x0004;
|
|
memcpy(*data, (uint8_t *)&wBacklightCompensation, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_MIN: {
|
|
uint16_t wBacklightCompensation = 0;
|
|
memcpy(*data, (uint8_t *)&wBacklightCompensation, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_MAX: {
|
|
uint16_t wBacklightCompensation = 8;
|
|
memcpy(*data, (uint8_t *)&wBacklightCompensation, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_RES: {
|
|
uint16_t wBacklightCompensation = 1;
|
|
memcpy(*data, (uint8_t *)&wBacklightCompensation, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_INFO:
|
|
(*data)[0] = 0x03; //struct video_camera_capabilities
|
|
*len = 1;
|
|
break;
|
|
case VIDEO_REQUEST_GET_DEF: {
|
|
uint16_t wBacklightCompensation = 4;
|
|
memcpy(*data, (uint8_t *)&wBacklightCompensation, 2);
|
|
*len = 2;
|
|
} break;
|
|
default:
|
|
USB_LOG_WRN("Unhandled Video Class bRequest 0x%02x\r\n", setup->bRequest);
|
|
return -1;
|
|
}
|
|
break;
|
|
case VIDEO_PU_BRIGHTNESS_CONTROL:
|
|
switch (setup->bRequest) {
|
|
case VIDEO_REQUEST_SET_CUR: {
|
|
uint16_t wBrightness = (uint16_t)(*data)[1] << 8 | (uint16_t)(*data)[0];
|
|
USB_LOG_INFO("Video set brightness:%d\r\n", wBrightness);
|
|
} break;
|
|
case VIDEO_REQUEST_GET_CUR: {
|
|
uint16_t wBrightness = 0x0080;
|
|
memcpy(*data, (uint8_t *)&wBrightness, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_MIN: {
|
|
uint16_t wBrightness = 0x0001;
|
|
memcpy(*data, (uint8_t *)&wBrightness, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_MAX: {
|
|
uint16_t wBrightness = 0x00ff;
|
|
memcpy(*data, (uint8_t *)&wBrightness, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_RES: {
|
|
uint16_t wBrightness = 0x0001;
|
|
memcpy(*data, (uint8_t *)&wBrightness, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_INFO:
|
|
(*data)[0] = 0x03; //struct video_camera_capabilities
|
|
*len = 1;
|
|
break;
|
|
case VIDEO_REQUEST_GET_DEF: {
|
|
uint16_t wBrightness = 0x0080;
|
|
memcpy(*data, (uint8_t *)&wBrightness, 2);
|
|
*len = 2;
|
|
} break;
|
|
default:
|
|
USB_LOG_WRN("Unhandled Video Class bRequest 0x%02x\r\n", setup->bRequest);
|
|
return -1;
|
|
}
|
|
break;
|
|
case VIDEO_PU_CONTRAST_CONTROL:
|
|
switch (setup->bRequest) {
|
|
case VIDEO_REQUEST_GET_CUR: {
|
|
uint16_t wContrast = 0x0080;
|
|
memcpy(*data, (uint8_t *)&wContrast, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_MIN: {
|
|
uint16_t wContrast = 0x0001;
|
|
memcpy(*data, (uint8_t *)&wContrast, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_MAX: {
|
|
uint16_t wContrast = 0x00ff;
|
|
memcpy(*data, (uint8_t *)&wContrast, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_RES: {
|
|
uint16_t wContrast = 0x0001;
|
|
memcpy(*data, (uint8_t *)&wContrast, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_INFO:
|
|
(*data)[0] = 0x03; //struct video_camera_capabilities
|
|
*len = 1;
|
|
break;
|
|
case VIDEO_REQUEST_GET_DEF: {
|
|
uint16_t wContrast = 0x0080;
|
|
memcpy(*data, (uint8_t *)&wContrast, 2);
|
|
*len = 2;
|
|
} break;
|
|
default:
|
|
USB_LOG_WRN("Unhandled Video Class bRequest 0x%02x\r\n", setup->bRequest);
|
|
return -1;
|
|
}
|
|
break;
|
|
case VIDEO_PU_HUE_CONTROL:
|
|
switch (setup->bRequest) {
|
|
case VIDEO_REQUEST_GET_CUR: {
|
|
uint16_t wHue = 0x0080;
|
|
memcpy(*data, (uint8_t *)&wHue, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_MIN: {
|
|
uint16_t wHue = 0x0001;
|
|
memcpy(*data, (uint8_t *)&wHue, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_MAX: {
|
|
uint16_t wHue = 0x00ff;
|
|
memcpy(*data, (uint8_t *)&wHue, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_RES: {
|
|
uint16_t wHue = 0x0001;
|
|
memcpy(*data, (uint8_t *)&wHue, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_INFO:
|
|
(*data)[0] = 0x03; //struct video_camera_capabilities
|
|
*len = 1;
|
|
break;
|
|
case VIDEO_REQUEST_GET_DEF: {
|
|
uint16_t wHue = 0x0080;
|
|
memcpy(*data, (uint8_t *)&wHue, 2);
|
|
*len = 2;
|
|
} break;
|
|
default:
|
|
USB_LOG_WRN("Unhandled Video Class bRequest 0x%02x\r\n", setup->bRequest);
|
|
return -1;
|
|
}
|
|
break;
|
|
case VIDEO_PU_SATURATION_CONTROL:
|
|
switch (setup->bRequest) {
|
|
case VIDEO_REQUEST_GET_MIN: {
|
|
uint16_t wSaturation = 0x0001;
|
|
memcpy(*data, (uint8_t *)&wSaturation, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_MAX: {
|
|
uint16_t wSaturation = 0x00ff;
|
|
memcpy(*data, (uint8_t *)&wSaturation, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_RES: {
|
|
uint16_t wSaturation = 0x0001;
|
|
memcpy(*data, (uint8_t *)&wSaturation, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_INFO:
|
|
(*data)[0] = 0x03; //struct video_camera_capabilities
|
|
*len = 1;
|
|
break;
|
|
case VIDEO_REQUEST_GET_DEF: {
|
|
uint16_t wSaturation = 0x0080;
|
|
memcpy(*data, (uint8_t *)&wSaturation, 2);
|
|
*len = 2;
|
|
} break;
|
|
default:
|
|
USB_LOG_WRN("Unhandled Video Class bRequest 0x%02x\r\n", setup->bRequest);
|
|
return -1;
|
|
}
|
|
break;
|
|
case VIDEO_PU_SHARPNESS_CONTROL:
|
|
switch (setup->bRequest) {
|
|
case VIDEO_REQUEST_GET_MIN: {
|
|
uint16_t wSharpness = 0x0001;
|
|
memcpy(*data, (uint8_t *)&wSharpness, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_MAX: {
|
|
uint16_t wSharpness = 0x00ff;
|
|
memcpy(*data, (uint8_t *)&wSharpness, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_RES: {
|
|
uint16_t wSharpness = 0x0001;
|
|
memcpy(*data, (uint8_t *)&wSharpness, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_INFO:
|
|
(*data)[0] = 0x03; //struct video_camera_capabilities
|
|
*len = 1;
|
|
break;
|
|
case VIDEO_REQUEST_GET_DEF: {
|
|
uint16_t wSharpness = 0x0080;
|
|
memcpy(*data, (uint8_t *)&wSharpness, 2);
|
|
*len = 2;
|
|
} break;
|
|
default:
|
|
USB_LOG_WRN("Unhandled Video Class bRequest 0x%02x\r\n", setup->bRequest);
|
|
return -1;
|
|
}
|
|
break;
|
|
case VIDEO_PU_GAIN_CONTROL:
|
|
switch (setup->bRequest) {
|
|
case VIDEO_REQUEST_GET_MIN: {
|
|
uint16_t wGain = 0;
|
|
memcpy(*data, (uint8_t *)&wGain, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_MAX: {
|
|
uint16_t wGain = 255;
|
|
memcpy(*data, (uint8_t *)&wGain, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_RES: {
|
|
uint16_t wGain = 1;
|
|
memcpy(*data, (uint8_t *)&wGain, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_INFO:
|
|
(*data)[0] = 0x03; //struct video_camera_capabilities
|
|
*len = 1;
|
|
break;
|
|
case VIDEO_REQUEST_GET_DEF: {
|
|
uint16_t wGain = 255;
|
|
memcpy(*data, (uint8_t *)&wGain, 2);
|
|
*len = 2;
|
|
} break;
|
|
default:
|
|
USB_LOG_WRN("Unhandled Video Class bRequest 0x%02x\r\n", setup->bRequest);
|
|
return -1;
|
|
}
|
|
break;
|
|
case VIDEO_PU_WHITE_BALANCE_TEMPERATURE_CONTROL:
|
|
switch (setup->bRequest) {
|
|
case VIDEO_REQUEST_GET_CUR: {
|
|
uint16_t wWhiteBalance_Temprature = 417;
|
|
memcpy(*data, (uint8_t *)&wWhiteBalance_Temprature, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_MIN: {
|
|
uint16_t wWhiteBalance_Temprature = 300;
|
|
memcpy(*data, (uint8_t *)&wWhiteBalance_Temprature, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_MAX: {
|
|
uint16_t wWhiteBalance_Temprature = 600;
|
|
memcpy(*data, (uint8_t *)&wWhiteBalance_Temprature, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_RES: {
|
|
uint16_t wWhiteBalance_Temprature = 1;
|
|
memcpy(*data, (uint8_t *)&wWhiteBalance_Temprature, 2);
|
|
*len = 2;
|
|
} break;
|
|
case VIDEO_REQUEST_GET_INFO:
|
|
(*data)[0] = 0x03; //struct video_camera_capabilities
|
|
*len = 1;
|
|
break;
|
|
case VIDEO_REQUEST_GET_DEF: {
|
|
uint16_t wWhiteBalance_Temprature = 417;
|
|
memcpy(*data, (uint8_t *)&wWhiteBalance_Temprature, 2);
|
|
*len = 2;
|
|
} break;
|
|
default:
|
|
USB_LOG_WRN("Unhandled Video Class bRequest 0x%02x\r\n", setup->bRequest);
|
|
return -1;
|
|
}
|
|
break;
|
|
case VIDEO_PU_WHITE_BALANCE_TEMPERATURE_AUTO_CONTROL:
|
|
switch (setup->bRequest) {
|
|
case VIDEO_REQUEST_GET_CUR: {
|
|
uint16_t wWhiteBalance_Temprature_Auto = 1;
|
|
memcpy(*data, (uint8_t *)&wWhiteBalance_Temprature_Auto, 1);
|
|
*len = 1;
|
|
} break;
|
|
default:
|
|
USB_LOG_WRN("Unhandled Video Class bRequest 0x%02x\r\n", setup->bRequest);
|
|
return -1;
|
|
}
|
|
break;
|
|
default:
|
|
usbd_video_cfg.error_code = 0x06;
|
|
USB_LOG_WRN("Unhandled Video Class control selector 0x%02x\r\n", control_selector);
|
|
return -1;
|
|
}
|
|
break;
|
|
case VIDEO_VC_EXTENSION_UNIT_DESCRIPTOR_SUBTYPE:
|
|
break;
|
|
case VIDEO_VC_ENCODING_UNIT_DESCRIPTOR_SUBTYPE:
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int usbd_video_stream_request_handler(struct usb_setup_packet *setup, uint8_t **data, uint32_t *len)
|
|
{
|
|
uint8_t control_selector = (uint8_t)(setup->wValue >> 8);
|
|
|
|
switch (control_selector) {
|
|
case VIDEO_VS_PROBE_CONTROL:
|
|
switch (setup->bRequest) {
|
|
case VIDEO_REQUEST_SET_CUR:
|
|
//memcpy((uint8_t *)usbd_video_cfg.probe, *data, setup->wLength);
|
|
break;
|
|
case VIDEO_REQUEST_GET_CUR:
|
|
*data = (uint8_t *)usbd_video_cfg.probe;
|
|
*len = sizeof(struct video_probe_and_commit_controls);
|
|
break;
|
|
|
|
case VIDEO_REQUEST_GET_MIN:
|
|
case VIDEO_REQUEST_GET_MAX:
|
|
case VIDEO_REQUEST_GET_RES:
|
|
case VIDEO_REQUEST_GET_DEF:
|
|
*data = (uint8_t *)usbd_video_cfg.probe;
|
|
*len = sizeof(struct video_probe_and_commit_controls);
|
|
break;
|
|
case VIDEO_REQUEST_GET_LEN:
|
|
(*data)[0] = sizeof(struct video_probe_and_commit_controls);
|
|
*len = 1;
|
|
break;
|
|
|
|
case VIDEO_REQUEST_GET_INFO:
|
|
(*data)[0] = 0x03;
|
|
*len = 1;
|
|
break;
|
|
|
|
default:
|
|
USB_LOG_WRN("Unhandled Video Class bRequest 0x%02x\r\n", setup->bRequest);
|
|
return -1;
|
|
}
|
|
break;
|
|
case VIDEO_VS_COMMIT_CONTROL:
|
|
switch (setup->bRequest) {
|
|
case VIDEO_REQUEST_SET_CUR:
|
|
//memcpy((uint8_t *)usbd_video_cfg.commit, *data, setup->wLength);
|
|
break;
|
|
case VIDEO_REQUEST_GET_CUR:
|
|
*data = (uint8_t *)usbd_video_cfg.commit;
|
|
*len = sizeof(struct video_probe_and_commit_controls);
|
|
break;
|
|
case VIDEO_REQUEST_GET_MIN:
|
|
case VIDEO_REQUEST_GET_MAX:
|
|
case VIDEO_REQUEST_GET_RES:
|
|
case VIDEO_REQUEST_GET_DEF:
|
|
*data = (uint8_t *)usbd_video_cfg.commit;
|
|
*len = sizeof(struct video_probe_and_commit_controls);
|
|
break;
|
|
|
|
case VIDEO_REQUEST_GET_LEN:
|
|
(*data)[0] = sizeof(struct video_probe_and_commit_controls);
|
|
*len = 1;
|
|
break;
|
|
|
|
case VIDEO_REQUEST_GET_INFO:
|
|
(*data)[0] = 0x03;
|
|
*len = 1;
|
|
break;
|
|
|
|
default:
|
|
USB_LOG_WRN("Unhandled Video Class bRequest 0x%02x\r\n", setup->bRequest);
|
|
return -1;
|
|
}
|
|
break;
|
|
case VIDEO_VS_STREAM_ERROR_CODE_CONTROL:
|
|
switch (setup->bRequest) {
|
|
case VIDEO_REQUEST_GET_CUR:
|
|
*data = &usbd_video_cfg.error_code;
|
|
*len = 1;
|
|
break;
|
|
case VIDEO_REQUEST_GET_INFO:
|
|
(*data)[0] = 0x01;
|
|
*len = 1;
|
|
break;
|
|
default:
|
|
USB_LOG_WRN("Unhandled Video Class bRequest 0x%02x\r\n", setup->bRequest);
|
|
return -1;
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int video_class_request_handler(struct usb_setup_packet *setup, uint8_t **data, uint32_t *len)
|
|
{
|
|
USB_LOG_DBG("Video Class request: "
|
|
"bRequest 0x%02x\r\n",
|
|
setup->bRequest);
|
|
|
|
uint8_t intf_num = (uint8_t)setup->wIndex;
|
|
uint8_t entity_id = (uint8_t)(setup->wIndex >> 8);
|
|
|
|
if (usbd_video_cfg.vcintf == intf_num) { /* Video Control Interface */
|
|
if (entity_id == 0) {
|
|
return usbd_video_control_request_handler(setup, data, len); /* Interface Control Requests */
|
|
} else {
|
|
return usbd_video_control_unit_terminal_request_handler(setup, data, len); /* Unit and Terminal Requests */
|
|
}
|
|
} else if (usbd_video_cfg.vsintf == intf_num) { /* Video Stream Inteface */
|
|
return usbd_video_stream_request_handler(setup, data, len); /* Interface Stream Requests */
|
|
}
|
|
return -1;
|
|
}
|
|
|
|
static void video_notify_handler(uint8_t event, void *arg)
|
|
{
|
|
switch (event) {
|
|
case USBD_EVENT_RESET:
|
|
usbd_video_cfg.error_code = 0;
|
|
usbd_video_cfg.power_mode = 0;
|
|
break;
|
|
|
|
case USBD_EVENT_SOF:
|
|
usbd_video_sof_callback();
|
|
break;
|
|
|
|
case USBD_EVENT_SET_INTERFACE: {
|
|
struct usb_interface_descriptor *intf = (struct usb_interface_descriptor *)arg;
|
|
usbd_video_set_interface_callback(intf->bAlternateSetting);
|
|
}
|
|
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
void usbd_video_add_interface(usbd_class_t *class, usbd_interface_t *intf)
|
|
{
|
|
static usbd_class_t *last_class = NULL;
|
|
|
|
if (last_class != class) {
|
|
last_class = class;
|
|
usbd_class_register(class);
|
|
}
|
|
|
|
intf->class_handler = video_class_request_handler;
|
|
intf->custom_handler = NULL;
|
|
intf->vendor_handler = NULL;
|
|
intf->notify_handler = video_notify_handler;
|
|
usbd_class_add_interface(class, intf);
|
|
|
|
if (usbd_video_cfg.vcintf == 0xff) {
|
|
usbd_video_cfg.vcintf = intf->intf_num;
|
|
} else if (usbd_video_cfg.vsintf == 0xff) {
|
|
usbd_video_cfg.vsintf = intf->intf_num;
|
|
}
|
|
}
|
|
|
|
void usbd_video_set_probe_and_commit_controls(struct video_probe_and_commit_controls *probe,
|
|
struct video_probe_and_commit_controls *commit)
|
|
{
|
|
usbd_video_cfg.probe = probe;
|
|
usbd_video_cfg.commit = commit;
|
|
}
|
|
|
|
void usbd_video_add_entity_info(struct video_entity_info *info)
|
|
{
|
|
usb_slist_add_tail(&usbd_video_cfg.entity_info_list, &info->list);
|
|
}
|
|
|
|
__WEAK void usbd_video_sof_callback(void)
|
|
{
|
|
} |