Lines Matching +full:super +full:- +full:frames
1 // SPDX-License-Identifier: GPL-2.0-or-later
3 * uvc_video.c -- USB Video Class driver - Video handling
5 * Copyright (C) 2005-2010
9 #include <linux/dma-mapping.h>
24 #include <media/v4l2-common.h>
28 /* ------------------------------------------------------------------------
39 pipe = (query & 0x80) ? usb_rcvctrlpipe(dev->udev, 0) in __uvc_query_ctrl()
40 : usb_sndctrlpipe(dev->udev, 0); in __uvc_query_ctrl()
43 return usb_control_msg(dev->udev, pipe, query, type, cs << 8, in __uvc_query_ctrl()
89 * Most controls are little-endian integers, in which case the missing in uvc_query_ctrl()
97 memset(data + ret, 0, size - ret); in uvc_query_ctrl()
98 dev_warn_once(&dev->udev->dev, in uvc_query_ctrl()
104 if (ret != -EPIPE) { in uvc_query_ctrl()
105 dev_err(&dev->udev->dev, in uvc_query_ctrl()
108 return ret < 0 ? ret : -EPIPE; in uvc_query_ctrl()
122 dev_err_ratelimited(&dev->udev->dev, in uvc_query_ctrl()
125 return ret < 0 ? ret : -EPIPE; in uvc_query_ctrl()
132 /* Cannot happen - we received a STALL */ in uvc_query_ctrl()
133 return -EPIPE; in uvc_query_ctrl()
135 return -EBUSY; in uvc_query_ctrl()
137 return -EACCES; in uvc_query_ctrl()
139 return -EREMOTE; in uvc_query_ctrl()
141 return -ERANGE; in uvc_query_ctrl()
149 return -EIO; in uvc_query_ctrl()
151 return -EINVAL; in uvc_query_ctrl()
156 return -EPIPE; in uvc_query_ctrl()
179 * Latest Elgato Cam Link 4K firmware as of 2021-03-23 needs this fix. in uvc_fixup_video_ctrl()
182 if (usb_match_one_id(stream->dev->intf, &elgato_cam_link_4k) && in uvc_fixup_video_ctrl()
183 ctrl->bmHint > 255) { in uvc_fixup_video_ctrl()
184 u8 corrected_format_index = ctrl->bmHint >> 8; in uvc_fixup_video_ctrl()
186 uvc_dbg(stream->dev, VIDEO, in uvc_fixup_video_ctrl()
188 ctrl->bmHint, ctrl->bFormatIndex, in uvc_fixup_video_ctrl()
190 ctrl->bmHint = 1; in uvc_fixup_video_ctrl()
191 ctrl->bFormatIndex = corrected_format_index; in uvc_fixup_video_ctrl()
194 for (i = 0; i < stream->nformats; ++i) { in uvc_fixup_video_ctrl()
195 if (stream->formats[i].index == ctrl->bFormatIndex) { in uvc_fixup_video_ctrl()
196 format = &stream->formats[i]; in uvc_fixup_video_ctrl()
204 for (i = 0; i < format->nframes; ++i) { in uvc_fixup_video_ctrl()
205 if (format->frames[i].bFrameIndex == ctrl->bFrameIndex) { in uvc_fixup_video_ctrl()
206 frame = &format->frames[i]; in uvc_fixup_video_ctrl()
214 if (!(format->flags & UVC_FMT_FLAG_COMPRESSED) || in uvc_fixup_video_ctrl()
215 (ctrl->dwMaxVideoFrameSize == 0 && in uvc_fixup_video_ctrl()
216 stream->dev->uvc_version < 0x0110)) in uvc_fixup_video_ctrl()
217 ctrl->dwMaxVideoFrameSize = in uvc_fixup_video_ctrl()
218 frame->dwMaxVideoFrameBufferSize; in uvc_fixup_video_ctrl()
221 * The "TOSHIBA Web Camera - 5M" Chicony device (04f2:b50b) seems to in uvc_fixup_video_ctrl()
222 * compute the bandwidth on 16 bits and erroneously sign-extend it to in uvc_fixup_video_ctrl()
226 if ((ctrl->dwMaxPayloadTransferSize & 0xffff0000) == 0xffff0000) in uvc_fixup_video_ctrl()
227 ctrl->dwMaxPayloadTransferSize &= ~0xffff0000; in uvc_fixup_video_ctrl()
229 if (!(format->flags & UVC_FMT_FLAG_COMPRESSED) && in uvc_fixup_video_ctrl()
230 stream->dev->quirks & UVC_QUIRK_FIX_BANDWIDTH && in uvc_fixup_video_ctrl()
231 stream->intf->num_altsetting > 1) { in uvc_fixup_video_ctrl()
235 interval = (ctrl->dwFrameInterval > 100000) in uvc_fixup_video_ctrl()
236 ? ctrl->dwFrameInterval in uvc_fixup_video_ctrl()
237 : frame->dwFrameInterval[0]; in uvc_fixup_video_ctrl()
241 * size by the number of video frames per second, divide the in uvc_fixup_video_ctrl()
242 * result by the number of USB frames (or micro-frames for in uvc_fixup_video_ctrl()
243 * high- and super-speed devices) per second and add the UVC in uvc_fixup_video_ctrl()
246 bandwidth = frame->wWidth * frame->wHeight / 8 * format->bpp; in uvc_fixup_video_ctrl()
249 if (stream->dev->udev->speed >= USB_SPEED_HIGH) in uvc_fixup_video_ctrl()
263 ctrl->dwMaxPayloadTransferSize = bandwidth; in uvc_fixup_video_ctrl()
273 if (stream->dev->uvc_version < 0x0110) in uvc_video_ctrl_size()
275 else if (stream->dev->uvc_version < 0x0150) in uvc_video_ctrl_size()
288 if ((stream->dev->quirks & UVC_QUIRK_PROBE_DEF) && in uvc_get_video_ctrl()
290 return -EIO; in uvc_get_video_ctrl()
294 return -ENOMEM; in uvc_get_video_ctrl()
296 ret = __uvc_query_ctrl(stream->dev, query, 0, stream->intfnum, in uvc_get_video_ctrl()
306 uvc_warn_once(stream->dev, UVC_WARN_MINMAX, "UVC non " in uvc_get_video_ctrl()
307 "compliance - GET_MIN/MAX(PROBE) incorrectly " in uvc_get_video_ctrl()
310 ctrl->wCompQuality = le16_to_cpup((__le16 *)data); in uvc_get_video_ctrl()
319 uvc_warn_once(stream->dev, UVC_WARN_PROBE_DEF, "UVC non " in uvc_get_video_ctrl()
320 "compliance - GET_DEF(PROBE) not supported. " in uvc_get_video_ctrl()
322 ret = -EIO; in uvc_get_video_ctrl()
325 dev_err(&stream->intf->dev, in uvc_get_video_ctrl()
329 ret = (ret == -EPROTO) ? -EPROTO : -EIO; in uvc_get_video_ctrl()
333 ctrl->bmHint = le16_to_cpup((__le16 *)&data[0]); in uvc_get_video_ctrl()
334 ctrl->bFormatIndex = data[2]; in uvc_get_video_ctrl()
335 ctrl->bFrameIndex = data[3]; in uvc_get_video_ctrl()
336 ctrl->dwFrameInterval = le32_to_cpup((__le32 *)&data[4]); in uvc_get_video_ctrl()
337 ctrl->wKeyFrameRate = le16_to_cpup((__le16 *)&data[8]); in uvc_get_video_ctrl()
338 ctrl->wPFrameRate = le16_to_cpup((__le16 *)&data[10]); in uvc_get_video_ctrl()
339 ctrl->wCompQuality = le16_to_cpup((__le16 *)&data[12]); in uvc_get_video_ctrl()
340 ctrl->wCompWindowSize = le16_to_cpup((__le16 *)&data[14]); in uvc_get_video_ctrl()
341 ctrl->wDelay = le16_to_cpup((__le16 *)&data[16]); in uvc_get_video_ctrl()
342 ctrl->dwMaxVideoFrameSize = get_unaligned_le32(&data[18]); in uvc_get_video_ctrl()
343 ctrl->dwMaxPayloadTransferSize = get_unaligned_le32(&data[22]); in uvc_get_video_ctrl()
346 ctrl->dwClockFrequency = get_unaligned_le32(&data[26]); in uvc_get_video_ctrl()
347 ctrl->bmFramingInfo = data[30]; in uvc_get_video_ctrl()
348 ctrl->bPreferedVersion = data[31]; in uvc_get_video_ctrl()
349 ctrl->bMinVersion = data[32]; in uvc_get_video_ctrl()
350 ctrl->bMaxVersion = data[33]; in uvc_get_video_ctrl()
352 ctrl->dwClockFrequency = stream->dev->clock_frequency; in uvc_get_video_ctrl()
353 ctrl->bmFramingInfo = 0; in uvc_get_video_ctrl()
354 ctrl->bPreferedVersion = 0; in uvc_get_video_ctrl()
355 ctrl->bMinVersion = 0; in uvc_get_video_ctrl()
356 ctrl->bMaxVersion = 0; in uvc_get_video_ctrl()
381 return -ENOMEM; in uvc_set_video_ctrl()
383 *(__le16 *)&data[0] = cpu_to_le16(ctrl->bmHint); in uvc_set_video_ctrl()
384 data[2] = ctrl->bFormatIndex; in uvc_set_video_ctrl()
385 data[3] = ctrl->bFrameIndex; in uvc_set_video_ctrl()
386 *(__le32 *)&data[4] = cpu_to_le32(ctrl->dwFrameInterval); in uvc_set_video_ctrl()
387 *(__le16 *)&data[8] = cpu_to_le16(ctrl->wKeyFrameRate); in uvc_set_video_ctrl()
388 *(__le16 *)&data[10] = cpu_to_le16(ctrl->wPFrameRate); in uvc_set_video_ctrl()
389 *(__le16 *)&data[12] = cpu_to_le16(ctrl->wCompQuality); in uvc_set_video_ctrl()
390 *(__le16 *)&data[14] = cpu_to_le16(ctrl->wCompWindowSize); in uvc_set_video_ctrl()
391 *(__le16 *)&data[16] = cpu_to_le16(ctrl->wDelay); in uvc_set_video_ctrl()
392 put_unaligned_le32(ctrl->dwMaxVideoFrameSize, &data[18]); in uvc_set_video_ctrl()
393 put_unaligned_le32(ctrl->dwMaxPayloadTransferSize, &data[22]); in uvc_set_video_ctrl()
396 put_unaligned_le32(ctrl->dwClockFrequency, &data[26]); in uvc_set_video_ctrl()
397 data[30] = ctrl->bmFramingInfo; in uvc_set_video_ctrl()
398 data[31] = ctrl->bPreferedVersion; in uvc_set_video_ctrl()
399 data[32] = ctrl->bMinVersion; in uvc_set_video_ctrl()
400 data[33] = ctrl->bMaxVersion; in uvc_set_video_ctrl()
403 ret = __uvc_query_ctrl(stream->dev, UVC_SET_CUR, 0, stream->intfnum, in uvc_set_video_ctrl()
407 dev_err(&stream->intf->dev, in uvc_set_video_ctrl()
410 ret = -EIO; in uvc_set_video_ctrl()
437 if (!(stream->dev->quirks & UVC_QUIRK_PROBE_MINMAX)) { in uvc_probe_video()
445 probe->wCompQuality = probe_max.wCompQuality; in uvc_probe_video()
456 if (stream->intf->num_altsetting == 1) in uvc_probe_video()
459 if (probe->dwMaxPayloadTransferSize <= stream->maxpsize) in uvc_probe_video()
462 if (stream->dev->quirks & UVC_QUIRK_PROBE_MINMAX) { in uvc_probe_video()
463 ret = -ENOSPC; in uvc_probe_video()
468 probe->wKeyFrameRate = probe_min.wKeyFrameRate; in uvc_probe_video()
469 probe->wPFrameRate = probe_min.wPFrameRate; in uvc_probe_video()
470 probe->wCompQuality = probe_max.wCompQuality; in uvc_probe_video()
471 probe->wCompWindowSize = probe_min.wCompWindowSize; in uvc_probe_video()
484 /* -----------------------------------------------------------------------------
506 if (clock->head == clock->last_sof_overflow) in uvc_video_clock_add_sample()
507 clock->last_sof_overflow = -1; in uvc_video_clock_add_sample()
509 spin_lock_irqsave(&clock->lock, flags); in uvc_video_clock_add_sample()
511 if (clock->count > 0 && clock->last_sof > sample->dev_sof) { in uvc_video_clock_add_sample()
517 if (clock->last_sof_overflow != -1) in uvc_video_clock_add_sample()
518 clock->count = (clock->head - clock->last_sof_overflow in uvc_video_clock_add_sample()
519 + clock->size) % clock->size; in uvc_video_clock_add_sample()
520 clock->last_sof_overflow = clock->head; in uvc_video_clock_add_sample()
524 clock->samples[clock->head] = *sample; in uvc_video_clock_add_sample()
525 clock->head = (clock->head + 1) % clock->size; in uvc_video_clock_add_sample()
526 clock->count = min(clock->count + 1, clock->size); in uvc_video_clock_add_sample()
528 spin_unlock_irqrestore(&clock->lock, flags); in uvc_video_clock_add_sample()
566 * - store the frame PTS in the buffer structure in uvc_video_clock_decode()
567 * - if the SCR field is present, retrieve the host SOF counter and in uvc_video_clock_decode()
572 buf->pts = get_unaligned_le32(&data[2]); in uvc_video_clock_decode()
583 sample.dev_sof = get_unaligned_le16(&data[header_size - 2]); in uvc_video_clock_decode()
584 if (sample.dev_sof == stream->clock.last_sof) in uvc_video_clock_decode()
587 sample.dev_stc = get_unaligned_le32(&data[header_size - 6]); in uvc_video_clock_decode()
611 if (buf && buf->bytesused == 0 && len == header_size && in uvc_video_clock_decode()
615 sample.host_sof = usb_get_current_frame_number(stream->dev->udev); in uvc_video_clock_decode()
624 if (stream->dev->quirks & UVC_QUIRK_INVALID_DEVICE_SOF) in uvc_video_clock_decode()
649 if (stream->clock.sof_offset == (u16)-1) { in uvc_video_clock_decode()
650 u16 delta_sof = (sample.host_sof - sample.dev_sof) & 255; in uvc_video_clock_decode()
652 stream->clock.sof_offset = delta_sof; in uvc_video_clock_decode()
654 stream->clock.sof_offset = 0; in uvc_video_clock_decode()
657 sample.dev_sof = (sample.dev_sof + stream->clock.sof_offset) & 2047; in uvc_video_clock_decode()
658 uvc_video_clock_add_sample(&stream->clock, &sample); in uvc_video_clock_decode()
659 stream->clock.last_sof = sample.dev_sof; in uvc_video_clock_decode()
664 clock->head = 0; in uvc_video_clock_reset()
665 clock->count = 0; in uvc_video_clock_reset()
666 clock->last_sof = -1; in uvc_video_clock_reset()
667 clock->last_sof_overflow = -1; in uvc_video_clock_reset()
668 clock->sof_offset = -1; in uvc_video_clock_reset()
673 spin_lock_init(&clock->lock); in uvc_video_clock_init()
674 clock->size = 32; in uvc_video_clock_init()
676 clock->samples = kmalloc_array(clock->size, sizeof(*clock->samples), in uvc_video_clock_init()
678 if (clock->samples == NULL) in uvc_video_clock_init()
679 return -ENOMEM; in uvc_video_clock_init()
688 kfree(clock->samples); in uvc_video_clock_cleanup()
689 clock->samples = NULL; in uvc_video_clock_cleanup()
693 * uvc_video_clock_host_sof - Return the host SOF value for a clock sample
696 * cover the whole 11-bits SOF range (0-2047) but are limited to the HCI frame
714 delta_sof = (sample->host_sof - sample->dev_sof) & 255; in uvc_video_clock_host_sof()
716 return (sample->dev_sof + delta_sof) & 2047; in uvc_video_clock_host_sof()
720 * uvc_video_clock_update - Update the buffer timestamp
740 * SOF = (SOF2 - SOF1) / (STC2 - STC1) * PTS
741 * + (SOF1 * STC2 - SOF2 * STC1) / (STC2 - STC1)
745 * SOF = ((SOF2 - SOF1) * PTS + SOF1 * STC2 - SOF2 * STC1) / (STC2 - STC1) (1)
750 * TS = ((TS2 - TS1) * SOF + TS1 * SOF2 - TS2 * SOF1) / (SOF2 - SOF1) (2)
784 struct uvc_clock *clock = &stream->clock; in uvc_video_clock_update()
804 if (!clock->samples) in uvc_video_clock_update()
807 spin_lock_irqsave(&clock->lock, flags); in uvc_video_clock_update()
809 if (clock->count < 2) in uvc_video_clock_update()
812 first = &clock->samples[(clock->head - clock->count + clock->size) % clock->size]; in uvc_video_clock_update()
813 last = &clock->samples[(clock->head - 1 + clock->size) % clock->size]; in uvc_video_clock_update()
816 delta_stc = buf->pts - (1UL << 31); in uvc_video_clock_update()
817 x1 = first->dev_stc - delta_stc; in uvc_video_clock_update()
818 x2 = last->dev_stc - delta_stc; in uvc_video_clock_update()
822 y1 = (first->dev_sof + 2048) << 16; in uvc_video_clock_update()
823 y2 = (last->dev_sof + 2048) << 16; in uvc_video_clock_update()
836 if ((y2 - y1) < ((1000 / 4) << 16)) in uvc_video_clock_update()
839 y = (u64)(y2 - y1) * (1ULL << 31) + (u64)y1 * (u64)x2 in uvc_video_clock_update()
840 - (u64)y2 * (u64)x1; in uvc_video_clock_update()
841 y = div_u64(y, x2 - x1); in uvc_video_clock_update()
845 uvc_dbg(stream->dev, CLOCK, in uvc_video_clock_update()
847 stream->dev->name, buf->pts, in uvc_video_clock_update()
850 x1, x2, y1, y2, clock->sof_offset); in uvc_video_clock_update()
861 y2 = ktime_to_ns(ktime_sub(last->host_time, first->host_time)) + y1; in uvc_video_clock_update()
870 if (mean - (1024 << 16) > sof) in uvc_video_clock_update()
873 sof -= 2048 << 16; in uvc_video_clock_update()
875 y = (u64)(y2 - y1) * (u64)sof + (u64)y1 * (u64)x2 in uvc_video_clock_update()
876 - (u64)y2 * (u64)x1; in uvc_video_clock_update()
877 y = div_u64(y, x2 - x1); in uvc_video_clock_update()
879 timestamp = ktime_to_ns(first->host_time) + y - y1; in uvc_video_clock_update()
881 uvc_dbg(stream->dev, CLOCK, in uvc_video_clock_update()
883 stream->dev->name, in uvc_video_clock_update()
885 y, timestamp, vbuf->vb2_buf.timestamp, in uvc_video_clock_update()
886 x1, first->host_sof, first->dev_sof, in uvc_video_clock_update()
887 x2, last->host_sof, last->dev_sof, y1, y2); in uvc_video_clock_update()
890 vbuf->vb2_buf.timestamp = timestamp; in uvc_video_clock_update()
893 spin_unlock_irqrestore(&clock->lock, flags); in uvc_video_clock_update()
896 /* ------------------------------------------------------------------------
910 if (stream->stats.stream.nb_frames == 0 && in uvc_video_stats_decode()
911 stream->stats.frame.nb_packets == 0) in uvc_video_stats_decode()
912 stream->stats.stream.start_ts = ktime_get(); in uvc_video_stats_decode()
935 stream->stats.frame.nb_invalid++; in uvc_video_stats_decode()
944 scr_stc = get_unaligned_le32(&data[header_size - 6]); in uvc_video_stats_decode()
945 scr_sof = get_unaligned_le16(&data[header_size - 2]); in uvc_video_stats_decode()
949 if (has_pts && stream->stats.frame.nb_pts) { in uvc_video_stats_decode()
950 if (stream->stats.frame.pts != pts) { in uvc_video_stats_decode()
951 stream->stats.frame.nb_pts_diffs++; in uvc_video_stats_decode()
952 stream->stats.frame.last_pts_diff = in uvc_video_stats_decode()
953 stream->stats.frame.nb_packets; in uvc_video_stats_decode()
958 stream->stats.frame.nb_pts++; in uvc_video_stats_decode()
959 stream->stats.frame.pts = pts; in uvc_video_stats_decode()
963 * Do all frames have a PTS in their first non-empty packet, or before in uvc_video_stats_decode()
966 if (stream->stats.frame.size == 0) { in uvc_video_stats_decode()
968 stream->stats.frame.has_initial_pts = has_pts; in uvc_video_stats_decode()
970 stream->stats.frame.has_early_pts = true; in uvc_video_stats_decode()
974 if (has_scr && stream->stats.frame.nb_scr) { in uvc_video_stats_decode()
975 if (stream->stats.frame.scr_stc != scr_stc) in uvc_video_stats_decode()
976 stream->stats.frame.nb_scr_diffs++; in uvc_video_stats_decode()
981 if (stream->stats.stream.nb_frames > 0 || in uvc_video_stats_decode()
982 stream->stats.frame.nb_scr > 0) in uvc_video_stats_decode()
983 stream->stats.stream.scr_sof_count += in uvc_video_stats_decode()
984 (scr_sof - stream->stats.stream.scr_sof) % 2048; in uvc_video_stats_decode()
985 stream->stats.stream.scr_sof = scr_sof; in uvc_video_stats_decode()
987 stream->stats.frame.nb_scr++; in uvc_video_stats_decode()
988 stream->stats.frame.scr_stc = scr_stc; in uvc_video_stats_decode()
989 stream->stats.frame.scr_sof = scr_sof; in uvc_video_stats_decode()
991 if (scr_sof < stream->stats.stream.min_sof) in uvc_video_stats_decode()
992 stream->stats.stream.min_sof = scr_sof; in uvc_video_stats_decode()
993 if (scr_sof > stream->stats.stream.max_sof) in uvc_video_stats_decode()
994 stream->stats.stream.max_sof = scr_sof; in uvc_video_stats_decode()
997 /* Record the first non-empty packet number. */ in uvc_video_stats_decode()
998 if (stream->stats.frame.size == 0 && len > header_size) in uvc_video_stats_decode()
999 stream->stats.frame.first_data = stream->stats.frame.nb_packets; in uvc_video_stats_decode()
1002 stream->stats.frame.size += len - header_size; in uvc_video_stats_decode()
1005 stream->stats.frame.nb_packets++; in uvc_video_stats_decode()
1007 stream->stats.frame.nb_empty++; in uvc_video_stats_decode()
1010 stream->stats.frame.nb_errors++; in uvc_video_stats_decode()
1015 struct uvc_stats_frame *frame = &stream->stats.frame; in uvc_video_stats_update()
1017 uvc_dbg(stream->dev, STATS, in uvc_video_stats_update()
1019 stream->sequence, frame->first_data, in uvc_video_stats_update()
1020 frame->nb_packets - frame->nb_empty, frame->nb_packets, in uvc_video_stats_update()
1021 frame->nb_pts_diffs, frame->last_pts_diff, frame->nb_pts, in uvc_video_stats_update()
1022 frame->has_early_pts ? "" : "!", in uvc_video_stats_update()
1023 frame->has_initial_pts ? "" : "!", in uvc_video_stats_update()
1024 frame->nb_scr_diffs, frame->nb_scr, in uvc_video_stats_update()
1025 frame->pts, frame->scr_stc, frame->scr_sof); in uvc_video_stats_update()
1027 stream->stats.stream.nb_frames++; in uvc_video_stats_update()
1028 stream->stats.stream.nb_packets += stream->stats.frame.nb_packets; in uvc_video_stats_update()
1029 stream->stats.stream.nb_empty += stream->stats.frame.nb_empty; in uvc_video_stats_update()
1030 stream->stats.stream.nb_errors += stream->stats.frame.nb_errors; in uvc_video_stats_update()
1031 stream->stats.stream.nb_invalid += stream->stats.frame.nb_invalid; in uvc_video_stats_update()
1033 if (frame->has_early_pts) in uvc_video_stats_update()
1034 stream->stats.stream.nb_pts_early++; in uvc_video_stats_update()
1035 if (frame->has_initial_pts) in uvc_video_stats_update()
1036 stream->stats.stream.nb_pts_initial++; in uvc_video_stats_update()
1037 if (frame->last_pts_diff <= frame->first_data) in uvc_video_stats_update()
1038 stream->stats.stream.nb_pts_constant++; in uvc_video_stats_update()
1039 if (frame->nb_scr >= frame->nb_packets - frame->nb_empty) in uvc_video_stats_update()
1040 stream->stats.stream.nb_scr_count_ok++; in uvc_video_stats_update()
1041 if (frame->nb_scr_diffs + 1 == frame->nb_scr) in uvc_video_stats_update()
1042 stream->stats.stream.nb_scr_diffs_ok++; in uvc_video_stats_update()
1044 memset(&stream->stats.frame, 0, sizeof(stream->stats.frame)); in uvc_video_stats_update()
1058 duration = ktime_ms_delta(stream->stats.stream.stop_ts, in uvc_video_stats_dump()
1059 stream->stats.stream.start_ts); in uvc_video_stats_dump()
1061 scr_sof_freq = stream->stats.stream.scr_sof_count * 1000 in uvc_video_stats_dump()
1066 count += scnprintf(buf + count, size - count, in uvc_video_stats_dump()
1067 "frames: %u\npackets: %u\nempty: %u\n" in uvc_video_stats_dump()
1069 stream->stats.stream.nb_frames, in uvc_video_stats_dump()
1070 stream->stats.stream.nb_packets, in uvc_video_stats_dump()
1071 stream->stats.stream.nb_empty, in uvc_video_stats_dump()
1072 stream->stats.stream.nb_errors, in uvc_video_stats_dump()
1073 stream->stats.stream.nb_invalid); in uvc_video_stats_dump()
1074 count += scnprintf(buf + count, size - count, in uvc_video_stats_dump()
1076 stream->stats.stream.nb_pts_early, in uvc_video_stats_dump()
1077 stream->stats.stream.nb_pts_initial, in uvc_video_stats_dump()
1078 stream->stats.stream.nb_pts_constant); in uvc_video_stats_dump()
1079 count += scnprintf(buf + count, size - count, in uvc_video_stats_dump()
1081 stream->stats.stream.nb_scr_count_ok, in uvc_video_stats_dump()
1082 stream->stats.stream.nb_scr_diffs_ok); in uvc_video_stats_dump()
1083 count += scnprintf(buf + count, size - count, in uvc_video_stats_dump()
1085 stream->stats.stream.min_sof, in uvc_video_stats_dump()
1086 stream->stats.stream.max_sof, in uvc_video_stats_dump()
1094 memset(&stream->stats, 0, sizeof(stream->stats)); in uvc_video_stats_start()
1095 stream->stats.stream.min_sof = 2048; in uvc_video_stats_start()
1100 stream->stats.stream.stop_ts = ktime_get(); in uvc_video_stats_stop()
1103 /* ------------------------------------------------------------------------
1116 * - EAGAIN informs the caller that the current video buffer should be marked
1121 * If an error other than -EAGAIN is returned, the caller will drop the current
1123 * made until the next payload. -ENODATA can be used to drop the current
1151 * - packet must be at least 2 bytes long in uvc_video_decode_start()
1152 * - bHeaderLength value must be at least 2 bytes (see above) in uvc_video_decode_start()
1153 * - bHeaderLength value can't be larger than the packet size. in uvc_video_decode_start()
1156 stream->stats.frame.nb_invalid++; in uvc_video_decode_start()
1157 return -EINVAL; in uvc_video_decode_start()
1165 * that discontinuous sequence numbers always indicate lost frames. in uvc_video_decode_start()
1167 if (stream->last_fid != fid) { in uvc_video_decode_start()
1168 stream->sequence++; in uvc_video_decode_start()
1169 if (stream->sequence) in uvc_video_decode_start()
1181 stream->last_fid = fid; in uvc_video_decode_start()
1182 return -ENODATA; in uvc_video_decode_start()
1187 uvc_dbg(stream->dev, FRAME, in uvc_video_decode_start()
1189 buf->error = 1; in uvc_video_decode_start()
1195 * stream->last_fid is initialized to -1, so the first isochronous in uvc_video_decode_start()
1198 * If the device doesn't toggle the FID bit, invert stream->last_fid in uvc_video_decode_start()
1201 if (buf->state != UVC_BUF_STATE_ACTIVE) { in uvc_video_decode_start()
1202 if (fid == stream->last_fid) { in uvc_video_decode_start()
1203 uvc_dbg(stream->dev, FRAME, in uvc_video_decode_start()
1205 if ((stream->dev->quirks & UVC_QUIRK_STREAM_NO_FID) && in uvc_video_decode_start()
1207 stream->last_fid ^= UVC_STREAM_FID; in uvc_video_decode_start()
1208 return -ENODATA; in uvc_video_decode_start()
1211 buf->buf.field = V4L2_FIELD_NONE; in uvc_video_decode_start()
1212 buf->buf.sequence = stream->sequence; in uvc_video_decode_start()
1213 buf->buf.vb2_buf.timestamp = ktime_to_ns(uvc_video_get_time()); in uvc_video_decode_start()
1216 buf->state = UVC_BUF_STATE_ACTIVE; in uvc_video_decode_start()
1227 * stream->last_fid is initialized to -1, so the first isochronous in uvc_video_decode_start()
1235 if (fid != stream->last_fid && buf->bytesused != 0) { in uvc_video_decode_start()
1236 uvc_dbg(stream->dev, FRAME, in uvc_video_decode_start()
1238 buf->state = UVC_BUF_STATE_READY; in uvc_video_decode_start()
1239 return -EAGAIN; in uvc_video_decode_start()
1244 * another non-MJPEG stream), are known to lose the EOF packet for a frame. in uvc_video_decode_start()
1246 * the SOI always lies on the packet boundary between two frames for in uvc_video_decode_start()
1249 if (stream->dev->quirks & UVC_QUIRK_MJPEG_NO_EOF && in uvc_video_decode_start()
1250 (stream->cur_format->fcc == V4L2_PIX_FMT_MJPEG || in uvc_video_decode_start()
1251 stream->cur_format->fcc == V4L2_PIX_FMT_JPEG)) { in uvc_video_decode_start()
1256 buf->bytesused != 0) { in uvc_video_decode_start()
1257 buf->state = UVC_BUF_STATE_READY; in uvc_video_decode_start()
1258 buf->error = 1; in uvc_video_decode_start()
1259 stream->last_fid ^= UVC_STREAM_FID; in uvc_video_decode_start()
1260 return -EAGAIN; in uvc_video_decode_start()
1264 stream->last_fid = fid; in uvc_video_decode_start()
1272 if (stream->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) in uvc_stream_dir()
1280 return bus_to_hcd(stream->dev->udev->bus)->self.sysdev; in uvc_stream_to_dmadev()
1286 dma_sync_sgtable_for_device(uvc_stream_to_dmadev(uvc_urb->stream), in uvc_submit_urb()
1287 uvc_urb->sgt, in uvc_submit_urb()
1288 uvc_stream_dir(uvc_urb->stream)); in uvc_submit_urb()
1289 return usb_submit_urb(uvc_urb->urb, mem_flags); in uvc_submit_urb()
1304 for (i = 0; i < uvc_urb->async_operations; i++) { in uvc_video_copy_data_work()
1305 struct uvc_copy_op *op = &uvc_urb->copy_operations[i]; in uvc_video_copy_data_work()
1307 memcpy(op->dst, op->src, op->len); in uvc_video_copy_data_work()
1310 uvc_queue_buffer_release(op->buf); in uvc_video_copy_data_work()
1315 dev_err(&uvc_urb->stream->intf->dev, in uvc_video_copy_data_work()
1322 unsigned int active_op = uvc_urb->async_operations; in uvc_video_decode_data()
1323 struct uvc_copy_op *op = &uvc_urb->copy_operations[active_op]; in uvc_video_decode_data()
1329 maxlen = buf->length - buf->bytesused; in uvc_video_decode_data()
1332 kref_get(&buf->ref); in uvc_video_decode_data()
1334 op->buf = buf; in uvc_video_decode_data()
1335 op->src = data; in uvc_video_decode_data()
1336 op->dst = buf->mem + buf->bytesused; in uvc_video_decode_data()
1337 op->len = min_t(unsigned int, len, maxlen); in uvc_video_decode_data()
1339 buf->bytesused += op->len; in uvc_video_decode_data()
1343 uvc_dbg(uvc_urb->stream->dev, FRAME, in uvc_video_decode_data()
1345 buf->error = 1; in uvc_video_decode_data()
1346 buf->state = UVC_BUF_STATE_READY; in uvc_video_decode_data()
1349 uvc_urb->async_operations++; in uvc_video_decode_data()
1356 if (data[1] & UVC_STREAM_EOF && buf->bytesused != 0) { in uvc_video_decode_end()
1357 uvc_dbg(stream->dev, FRAME, "Frame complete (EOF found)\n"); in uvc_video_decode_end()
1359 uvc_dbg(stream->dev, FRAME, "EOF in empty payload\n"); in uvc_video_decode_end()
1360 buf->state = UVC_BUF_STATE_READY; in uvc_video_decode_end()
1361 if (stream->dev->quirks & UVC_QUIRK_STREAM_NO_FID) in uvc_video_decode_end()
1362 stream->last_fid ^= UVC_STREAM_FID; in uvc_video_decode_end()
1383 | (stream->last_fid & UVC_STREAM_FID); in uvc_video_encode_header()
1390 struct uvc_video_queue *queue = &stream->queue; in uvc_video_encode_data()
1395 mem = buf->mem + queue->buf_used; in uvc_video_encode_data()
1396 nbytes = min((unsigned int)len, buf->bytesused - queue->buf_used); in uvc_video_encode_data()
1397 nbytes = min(stream->bulk.max_payload_size - stream->bulk.payload_size, in uvc_video_encode_data()
1401 queue->buf_used += nbytes; in uvc_video_encode_data()
1406 /* ------------------------------------------------------------------------
1413 * of blocks, containing a 64-bit timestamp in nanoseconds, a 16-bit USB Frame
1436 if (meta_buf->length - meta_buf->bytesused < in uvc_video_decode_meta()
1437 length + sizeof(meta->ns) + sizeof(meta->sof)) { in uvc_video_decode_meta()
1438 meta_buf->error = 1; in uvc_video_decode_meta()
1455 if (stream->meta.format == V4L2_META_FMT_UVC) in uvc_video_decode_meta()
1459 !memcmp(scr, stream->clock.last_scr, 6))) in uvc_video_decode_meta()
1462 meta = (struct uvc_meta_buf *)((u8 *)meta_buf->mem + meta_buf->bytesused); in uvc_video_decode_meta()
1465 sof = usb_get_current_frame_number(stream->dev->udev); in uvc_video_decode_meta()
1467 put_unaligned(ktime_to_ns(time), &meta->ns); in uvc_video_decode_meta()
1468 put_unaligned(sof, &meta->sof); in uvc_video_decode_meta()
1471 memcpy(stream->clock.last_scr, scr, 6); in uvc_video_decode_meta()
1473 meta->length = mem[0]; in uvc_video_decode_meta()
1474 meta->flags = mem[1]; in uvc_video_decode_meta()
1475 memcpy(meta->buf, &mem[2], length - 2); in uvc_video_decode_meta()
1476 meta_buf->bytesused += length + sizeof(meta->ns) + sizeof(meta->sof); in uvc_video_decode_meta()
1478 uvc_dbg(stream->dev, FRAME, in uvc_video_decode_meta()
1479 "%s(): t-sys %lluns, SOF %u, len %u, flags 0x%x, PTS %u, STC %u frame SOF %u\n", in uvc_video_decode_meta()
1480 __func__, ktime_to_ns(time), meta->sof, meta->length, in uvc_video_decode_meta()
1481 meta->flags, in uvc_video_decode_meta()
1482 has_pts ? *(u32 *)meta->buf : 0, in uvc_video_decode_meta()
1487 /* ------------------------------------------------------------------------
1497 if (stream->ctrl.dwMaxVideoFrameSize != buf->bytesused && in uvc_video_validate_buffer()
1498 !(stream->cur_format->flags & UVC_FMT_FLAG_COMPRESSED)) in uvc_video_validate_buffer()
1499 buf->error = 1; in uvc_video_validate_buffer()
1512 struct vb2_v4l2_buffer *vb2_meta = &(*meta_buf)->buf; in uvc_video_next_buffers()
1513 const struct vb2_v4l2_buffer *vb2_video = &(*video_buf)->buf; in uvc_video_next_buffers()
1515 vb2_meta->sequence = vb2_video->sequence; in uvc_video_next_buffers()
1516 vb2_meta->field = vb2_video->field; in uvc_video_next_buffers()
1517 vb2_meta->vb2_buf.timestamp = vb2_video->vb2_buf.timestamp; in uvc_video_next_buffers()
1519 (*meta_buf)->state = UVC_BUF_STATE_READY; in uvc_video_next_buffers()
1520 if (!(*meta_buf)->error) in uvc_video_next_buffers()
1521 (*meta_buf)->error = (*video_buf)->error; in uvc_video_next_buffers()
1522 *meta_buf = uvc_queue_next_buffer(&stream->meta.queue, in uvc_video_next_buffers()
1525 *video_buf = uvc_queue_next_buffer(&stream->queue, *video_buf); in uvc_video_next_buffers()
1531 struct urb *urb = uvc_urb->urb; in uvc_video_decode_isoc()
1532 struct uvc_streaming *stream = uvc_urb->stream; in uvc_video_decode_isoc()
1536 for (i = 0; i < urb->number_of_packets; ++i) { in uvc_video_decode_isoc()
1537 if (urb->iso_frame_desc[i].status < 0) { in uvc_video_decode_isoc()
1538 uvc_dbg(stream->dev, FRAME, in uvc_video_decode_isoc()
1540 urb->iso_frame_desc[i].status); in uvc_video_decode_isoc()
1543 buf->error = 1; in uvc_video_decode_isoc()
1548 mem = urb->transfer_buffer + urb->iso_frame_desc[i].offset; in uvc_video_decode_isoc()
1551 urb->iso_frame_desc[i].actual_length); in uvc_video_decode_isoc()
1552 if (ret == -EAGAIN) in uvc_video_decode_isoc()
1554 } while (ret == -EAGAIN); in uvc_video_decode_isoc()
1563 urb->iso_frame_desc[i].actual_length - ret); in uvc_video_decode_isoc()
1567 urb->iso_frame_desc[i].actual_length); in uvc_video_decode_isoc()
1569 if (buf->state == UVC_BUF_STATE_READY) in uvc_video_decode_isoc()
1577 struct urb *urb = uvc_urb->urb; in uvc_video_decode_bulk()
1578 struct uvc_streaming *stream = uvc_urb->stream; in uvc_video_decode_bulk()
1586 if (urb->actual_length == 0 && stream->bulk.header_size == 0) in uvc_video_decode_bulk()
1589 mem = urb->transfer_buffer; in uvc_video_decode_bulk()
1590 len = urb->actual_length; in uvc_video_decode_bulk()
1591 stream->bulk.payload_size += len; in uvc_video_decode_bulk()
1597 if (stream->bulk.header_size == 0 && !stream->bulk.skip_payload) { in uvc_video_decode_bulk()
1600 if (ret == -EAGAIN) in uvc_video_decode_bulk()
1602 } while (ret == -EAGAIN); in uvc_video_decode_bulk()
1606 stream->bulk.skip_payload = 1; in uvc_video_decode_bulk()
1608 memcpy(stream->bulk.header, mem, ret); in uvc_video_decode_bulk()
1609 stream->bulk.header_size = ret; in uvc_video_decode_bulk()
1614 len -= ret; in uvc_video_decode_bulk()
1625 if (!stream->bulk.skip_payload && buf != NULL) in uvc_video_decode_bulk()
1632 if (urb->actual_length < urb->transfer_buffer_length || in uvc_video_decode_bulk()
1633 stream->bulk.payload_size >= stream->bulk.max_payload_size) { in uvc_video_decode_bulk()
1634 if (!stream->bulk.skip_payload && buf != NULL) { in uvc_video_decode_bulk()
1635 uvc_video_decode_end(stream, buf, stream->bulk.header, in uvc_video_decode_bulk()
1636 stream->bulk.payload_size); in uvc_video_decode_bulk()
1637 if (buf->state == UVC_BUF_STATE_READY) in uvc_video_decode_bulk()
1641 stream->bulk.header_size = 0; in uvc_video_decode_bulk()
1642 stream->bulk.skip_payload = 0; in uvc_video_decode_bulk()
1643 stream->bulk.payload_size = 0; in uvc_video_decode_bulk()
1650 struct urb *urb = uvc_urb->urb; in uvc_video_encode_bulk()
1651 struct uvc_streaming *stream = uvc_urb->stream; in uvc_video_encode_bulk()
1653 u8 *mem = urb->transfer_buffer; in uvc_video_encode_bulk()
1654 int len = stream->urb_size, ret; in uvc_video_encode_bulk()
1657 urb->transfer_buffer_length = 0; in uvc_video_encode_bulk()
1662 if (stream->bulk.header_size == 0) { in uvc_video_encode_bulk()
1664 stream->bulk.header_size = ret; in uvc_video_encode_bulk()
1665 stream->bulk.payload_size += ret; in uvc_video_encode_bulk()
1667 len -= ret; in uvc_video_encode_bulk()
1673 stream->bulk.payload_size += ret; in uvc_video_encode_bulk()
1674 len -= ret; in uvc_video_encode_bulk()
1676 if (buf->bytesused == stream->queue.buf_used || in uvc_video_encode_bulk()
1677 stream->bulk.payload_size == stream->bulk.max_payload_size) { in uvc_video_encode_bulk()
1678 if (buf->bytesused == stream->queue.buf_used) { in uvc_video_encode_bulk()
1679 stream->queue.buf_used = 0; in uvc_video_encode_bulk()
1680 buf->state = UVC_BUF_STATE_READY; in uvc_video_encode_bulk()
1681 buf->buf.sequence = ++stream->sequence; in uvc_video_encode_bulk()
1682 uvc_queue_next_buffer(&stream->queue, buf); in uvc_video_encode_bulk()
1683 stream->last_fid ^= UVC_STREAM_FID; in uvc_video_encode_bulk()
1686 stream->bulk.header_size = 0; in uvc_video_encode_bulk()
1687 stream->bulk.payload_size = 0; in uvc_video_encode_bulk()
1690 urb->transfer_buffer_length = stream->urb_size - len; in uvc_video_encode_bulk()
1695 struct uvc_urb *uvc_urb = urb->context; in uvc_video_complete()
1696 struct uvc_streaming *stream = uvc_urb->stream; in uvc_video_complete()
1697 struct uvc_video_queue *queue = &stream->queue; in uvc_video_complete()
1698 struct uvc_video_queue *qmeta = &stream->meta.queue; in uvc_video_complete()
1699 struct vb2_queue *vb2_qmeta = stream->meta.vdev.queue; in uvc_video_complete()
1705 switch (urb->status) { in uvc_video_complete()
1710 dev_warn(&stream->intf->dev, in uvc_video_complete()
1711 "Non-zero status (%d) in video completion handler.\n", in uvc_video_complete()
1712 urb->status); in uvc_video_complete()
1714 case -ENOENT: /* usb_poison_urb() called. */ in uvc_video_complete()
1715 if (stream->frozen) in uvc_video_complete()
1718 case -ECONNRESET: /* usb_unlink_urb() called. */ in uvc_video_complete()
1719 case -ESHUTDOWN: /* The endpoint is being disabled. */ in uvc_video_complete()
1720 uvc_queue_cancel(queue, urb->status == -ESHUTDOWN); in uvc_video_complete()
1722 uvc_queue_cancel(qmeta, urb->status == -ESHUTDOWN); in uvc_video_complete()
1729 spin_lock_irqsave(&qmeta->irqlock, flags); in uvc_video_complete()
1730 if (!list_empty(&qmeta->irqqueue)) in uvc_video_complete()
1731 buf_meta = list_first_entry(&qmeta->irqqueue, in uvc_video_complete()
1733 spin_unlock_irqrestore(&qmeta->irqlock, flags); in uvc_video_complete()
1736 /* Re-initialise the URB async work. */ in uvc_video_complete()
1737 uvc_urb->async_operations = 0; in uvc_video_complete()
1740 dma_sync_sgtable_for_cpu(uvc_stream_to_dmadev(uvc_urb->stream), in uvc_video_complete()
1741 uvc_urb->sgt, uvc_stream_dir(stream)); in uvc_video_complete()
1742 invalidate_kernel_vmap_range(uvc_urb->buffer, in uvc_video_complete()
1743 uvc_urb->stream->urb_size); in uvc_video_complete()
1749 stream->decode(uvc_urb, buf, buf_meta); in uvc_video_complete()
1752 if (!uvc_urb->async_operations) { in uvc_video_complete()
1755 dev_err(&stream->intf->dev, in uvc_video_complete()
1760 queue_work(stream->async_wq, &uvc_urb->work); in uvc_video_complete()
1772 if (!uvc_urb->buffer) in uvc_free_urb_buffers()
1775 dma_vunmap_noncontiguous(dma_dev, uvc_urb->buffer); in uvc_free_urb_buffers()
1776 dma_free_noncontiguous(dma_dev, stream->urb_size, uvc_urb->sgt, in uvc_free_urb_buffers()
1779 uvc_urb->buffer = NULL; in uvc_free_urb_buffers()
1780 uvc_urb->sgt = NULL; in uvc_free_urb_buffers()
1783 stream->urb_size = 0; in uvc_free_urb_buffers()
1791 uvc_urb->sgt = dma_alloc_noncontiguous(dma_dev, stream->urb_size, in uvc_alloc_urb_buffer()
1794 if (!uvc_urb->sgt) in uvc_alloc_urb_buffer()
1796 uvc_urb->dma = uvc_urb->sgt->sgl->dma_address; in uvc_alloc_urb_buffer()
1798 uvc_urb->buffer = dma_vmap_noncontiguous(dma_dev, stream->urb_size, in uvc_alloc_urb_buffer()
1799 uvc_urb->sgt); in uvc_alloc_urb_buffer()
1800 if (!uvc_urb->buffer) { in uvc_alloc_urb_buffer()
1801 dma_free_noncontiguous(dma_dev, stream->urb_size, in uvc_alloc_urb_buffer()
1802 uvc_urb->sgt, in uvc_alloc_urb_buffer()
1804 uvc_urb->sgt = NULL; in uvc_alloc_urb_buffer()
1829 if (stream->urb_size) in uvc_alloc_urb_buffers()
1830 return stream->urb_size / psize; in uvc_alloc_urb_buffers()
1842 stream->urb_size = psize * npackets; in uvc_alloc_urb_buffers()
1845 struct uvc_urb *uvc_urb = &stream->uvc_urb[i]; in uvc_alloc_urb_buffers()
1852 uvc_urb->stream = stream; in uvc_alloc_urb_buffers()
1856 uvc_dbg(stream->dev, VIDEO, in uvc_alloc_urb_buffers()
1863 uvc_dbg(stream->dev, VIDEO, in uvc_alloc_urb_buffers()
1885 usb_poison_urb(uvc_urb->urb); in uvc_video_stop_transfer()
1887 flush_workqueue(stream->async_wq); in uvc_video_stop_transfer()
1890 usb_free_urb(uvc_urb->urb); in uvc_video_stop_transfer()
1891 uvc_urb->urb = NULL; in uvc_video_stop_transfer()
1905 switch (dev->speed) { in uvc_endpoint_max_bpi()
1908 return le16_to_cpu(ep->ss_ep_comp.wBytesPerInterval); in uvc_endpoint_max_bpi()
1910 psize = usb_endpoint_maxp(&ep->desc); in uvc_endpoint_max_bpi()
1911 psize *= usb_endpoint_maxp_mult(&ep->desc); in uvc_endpoint_max_bpi()
1929 psize = uvc_endpoint_max_bpi(stream->dev->udev, ep); in uvc_init_video_isoc()
1930 size = stream->ctrl.dwMaxVideoFrameSize; in uvc_init_video_isoc()
1934 return -ENOMEM; in uvc_init_video_isoc()
1942 return -ENOMEM; in uvc_init_video_isoc()
1945 urb->dev = stream->dev->udev; in uvc_init_video_isoc()
1946 urb->context = uvc_urb; in uvc_init_video_isoc()
1947 urb->pipe = usb_rcvisocpipe(stream->dev->udev, in uvc_init_video_isoc()
1948 ep->desc.bEndpointAddress); in uvc_init_video_isoc()
1949 urb->transfer_flags = URB_ISO_ASAP | URB_NO_TRANSFER_DMA_MAP; in uvc_init_video_isoc()
1950 urb->transfer_dma = uvc_urb->dma; in uvc_init_video_isoc()
1951 urb->interval = ep->desc.bInterval; in uvc_init_video_isoc()
1952 urb->transfer_buffer = uvc_urb->buffer; in uvc_init_video_isoc()
1953 urb->complete = uvc_video_complete; in uvc_init_video_isoc()
1954 urb->number_of_packets = npackets; in uvc_init_video_isoc()
1955 urb->transfer_buffer_length = size; in uvc_init_video_isoc()
1958 urb->iso_frame_desc[i].offset = i * psize; in uvc_init_video_isoc()
1959 urb->iso_frame_desc[i].length = psize; in uvc_init_video_isoc()
1962 uvc_urb->urb = urb; in uvc_init_video_isoc()
1981 psize = usb_endpoint_maxp(&ep->desc); in uvc_init_video_bulk()
1982 size = stream->ctrl.dwMaxPayloadTransferSize; in uvc_init_video_bulk()
1983 stream->bulk.max_payload_size = size; in uvc_init_video_bulk()
1987 return -ENOMEM; in uvc_init_video_bulk()
1991 if (usb_endpoint_dir_in(&ep->desc)) in uvc_init_video_bulk()
1992 pipe = usb_rcvbulkpipe(stream->dev->udev, in uvc_init_video_bulk()
1993 ep->desc.bEndpointAddress); in uvc_init_video_bulk()
1995 pipe = usb_sndbulkpipe(stream->dev->udev, in uvc_init_video_bulk()
1996 ep->desc.bEndpointAddress); in uvc_init_video_bulk()
1998 if (stream->type == V4L2_BUF_TYPE_VIDEO_OUTPUT) in uvc_init_video_bulk()
2005 return -ENOMEM; in uvc_init_video_bulk()
2008 usb_fill_bulk_urb(urb, stream->dev->udev, pipe, uvc_urb->buffer, in uvc_init_video_bulk()
2010 urb->transfer_flags = URB_NO_TRANSFER_DMA_MAP; in uvc_init_video_bulk()
2011 urb->transfer_dma = uvc_urb->dma; in uvc_init_video_bulk()
2013 uvc_urb->urb = urb; in uvc_init_video_bulk()
2025 struct usb_interface *intf = stream->intf; in uvc_video_start_transfer()
2031 stream->sequence = -1; in uvc_video_start_transfer()
2032 stream->last_fid = -1; in uvc_video_start_transfer()
2033 stream->bulk.header_size = 0; in uvc_video_start_transfer()
2034 stream->bulk.skip_payload = 0; in uvc_video_start_transfer()
2035 stream->bulk.payload_size = 0; in uvc_video_start_transfer()
2039 if (intf->num_altsetting > 1) { in uvc_video_start_transfer()
2044 int intfnum = stream->intfnum; in uvc_video_start_transfer()
2047 bandwidth = stream->ctrl.dwMaxPayloadTransferSize; in uvc_video_start_transfer()
2050 uvc_dbg(stream->dev, VIDEO, in uvc_video_start_transfer()
2054 uvc_dbg(stream->dev, VIDEO, in uvc_video_start_transfer()
2059 for (i = 0; i < intf->num_altsetting; ++i) { in uvc_video_start_transfer()
2063 alts = &intf->altsetting[i]; in uvc_video_start_transfer()
2065 stream->header.bEndpointAddress); in uvc_video_start_transfer()
2070 psize = uvc_endpoint_max_bpi(stream->dev->udev, ep); in uvc_video_start_transfer()
2072 altsetting = alts->desc.bAlternateSetting; in uvc_video_start_transfer()
2079 uvc_dbg(stream->dev, VIDEO, in uvc_video_start_transfer()
2081 return -EIO; in uvc_video_start_transfer()
2084 uvc_dbg(stream->dev, VIDEO, in uvc_video_start_transfer()
2093 if (stream->dev->quirks & UVC_QUIRK_WAKE_AUTOSUSPEND) { in uvc_video_start_transfer()
2094 usb_set_interface(stream->dev->udev, intfnum, in uvc_video_start_transfer()
2096 usb_set_interface(stream->dev->udev, intfnum, 0); in uvc_video_start_transfer()
2099 ret = usb_set_interface(stream->dev->udev, intfnum, altsetting); in uvc_video_start_transfer()
2106 ep = uvc_find_endpoint(&intf->altsetting[0], in uvc_video_start_transfer()
2107 stream->header.bEndpointAddress); in uvc_video_start_transfer()
2109 return -EIO; in uvc_video_start_transfer()
2112 if (usb_endpoint_maxp(&ep->desc) == 0) in uvc_video_start_transfer()
2113 return -EIO; in uvc_video_start_transfer()
2125 dev_err(&stream->intf->dev, in uvc_video_start_transfer()
2137 if (stream->dev->quirks & UVC_QUIRK_RESTORE_CTRLS_ON_INIT) in uvc_video_start_transfer()
2138 uvc_ctrl_restore_values(stream->dev); in uvc_video_start_transfer()
2143 /* --------------------------------------------------------------------------
2156 if (!uvc_queue_streaming(&stream->queue)) in uvc_video_suspend()
2159 stream->frozen = 1; in uvc_video_suspend()
2161 usb_set_interface(stream->dev->udev, stream->intfnum, 0); in uvc_video_suspend()
2184 usb_set_interface(stream->dev->udev, stream->intfnum, 0); in uvc_video_resume()
2186 stream->frozen = 0; in uvc_video_resume()
2188 uvc_video_clock_reset(&stream->clock); in uvc_video_resume()
2190 if (!uvc_queue_streaming(&stream->queue)) in uvc_video_resume()
2193 ret = uvc_commit_video(stream, &stream->ctrl); in uvc_video_resume()
2200 /* ------------------------------------------------------------------------
2216 struct uvc_streaming_control *probe = &stream->ctrl; in uvc_video_init()
2223 if (stream->nformats == 0) { in uvc_video_init()
2224 dev_info(&stream->intf->dev, in uvc_video_init()
2226 return -EINVAL; in uvc_video_init()
2229 atomic_set(&stream->active, 0); in uvc_video_init()
2237 usb_set_interface(stream->dev->udev, stream->intfnum, 0); in uvc_video_init()
2263 if (ret == -EPROTO && in uvc_video_init()
2264 usb_match_one_id(stream->dev->intf, &elgato_cam_link_4k)) { in uvc_video_init()
2265 dev_err(&stream->intf->dev, "Elgato Cam Link 4K firmware crash detected\n"); in uvc_video_init()
2266 dev_err(&stream->intf->dev, "Resetting the device, unplug and replug to recover\n"); in uvc_video_init()
2267 usb_reset_device(stream->dev->udev); in uvc_video_init()
2277 for (i = stream->nformats; i > 0; --i) { in uvc_video_init()
2278 format = &stream->formats[i-1]; in uvc_video_init()
2279 if (format->index == probe->bFormatIndex) in uvc_video_init()
2283 if (format->nframes == 0) { in uvc_video_init()
2284 dev_info(&stream->intf->dev, in uvc_video_init()
2286 return -EINVAL; in uvc_video_init()
2290 * Zero bFrameIndex might be correct. Stream-based formats (including in uvc_video_init()
2291 * MPEG-2 TS and DV) do not support frames but have a dummy frame in uvc_video_init()
2295 for (i = format->nframes; i > 0; --i) { in uvc_video_init()
2296 frame = &format->frames[i-1]; in uvc_video_init()
2297 if (frame->bFrameIndex == probe->bFrameIndex) in uvc_video_init()
2301 probe->bFormatIndex = format->index; in uvc_video_init()
2302 probe->bFrameIndex = frame->bFrameIndex; in uvc_video_init()
2304 stream->def_format = format; in uvc_video_init()
2305 stream->cur_format = format; in uvc_video_init()
2306 stream->cur_frame = frame; in uvc_video_init()
2309 if (stream->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) { in uvc_video_init()
2310 if (stream->dev->quirks & UVC_QUIRK_BUILTIN_ISIGHT) in uvc_video_init()
2311 stream->decode = uvc_video_decode_isight; in uvc_video_init()
2312 else if (stream->intf->num_altsetting > 1) in uvc_video_init()
2313 stream->decode = uvc_video_decode_isoc; in uvc_video_init()
2315 stream->decode = uvc_video_decode_bulk; in uvc_video_init()
2317 if (stream->intf->num_altsetting == 1) in uvc_video_init()
2318 stream->decode = uvc_video_encode_bulk; in uvc_video_init()
2320 dev_info(&stream->intf->dev, in uvc_video_init()
2322 return -EINVAL; in uvc_video_init()
2328 INIT_WORK(&uvc_urb->work, uvc_video_copy_data_work); in uvc_video_init()
2337 ret = uvc_video_clock_init(&stream->clock); in uvc_video_start_streaming()
2342 ret = uvc_commit_video(stream, &stream->ctrl); in uvc_video_start_streaming()
2353 usb_set_interface(stream->dev->udev, stream->intfnum, 0); in uvc_video_start_streaming()
2355 uvc_video_clock_cleanup(&stream->clock); in uvc_video_start_streaming()
2364 if (stream->intf->num_altsetting > 1) { in uvc_video_stop_streaming()
2365 usb_set_interface(stream->dev->udev, stream->intfnum, 0); in uvc_video_stop_streaming()
2368 * UVC doesn't specify how to inform a bulk-based device in uvc_video_stop_streaming()
2373 unsigned int epnum = stream->header.bEndpointAddress in uvc_video_stop_streaming()
2375 unsigned int dir = stream->header.bEndpointAddress in uvc_video_stop_streaming()
2379 pipe = usb_sndbulkpipe(stream->dev->udev, epnum) | dir; in uvc_video_stop_streaming()
2380 usb_clear_halt(stream->dev->udev, pipe); in uvc_video_stop_streaming()
2383 uvc_video_clock_cleanup(&stream->clock); in uvc_video_stop_streaming()