Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 1 | /* usb-urb.c is part of the DVB USB library. |
| 2 | * |
| 3 | * Copyright (C) 2004-6 Patrick Boettcher (patrick.boettcher@desy.de) |
| 4 | * see dvb-usb-init.c for copyright information. |
| 5 | * |
| 6 | * This file keeps functions for initializing and handling the |
| 7 | * BULK and ISOC USB data transfers in a generic way. |
| 8 | * Can be used for DVB-only and also, that's the plan, for |
| 9 | * Hybrid USB devices (analog and DVB). |
| 10 | */ |
| 11 | #include "dvb_usb_common.h" |
| 12 | |
| 13 | /* URB stuff for streaming */ |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 14 | |
| 15 | int usb_urb_reconfig(struct usb_data_stream *stream, |
| 16 | struct usb_data_stream_properties *props); |
| 17 | |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 18 | static void usb_urb_complete(struct urb *urb) |
| 19 | { |
| 20 | struct usb_data_stream *stream = urb->context; |
| 21 | int ptype = usb_pipetype(urb->pipe); |
| 22 | int i; |
| 23 | u8 *b; |
| 24 | |
Antti Palosaari | 6d7cfec | 2013-03-09 11:36:35 -0300 | [diff] [blame] | 25 | dev_dbg_ratelimited(&stream->udev->dev, |
| 26 | "%s: %s urb completed status=%d length=%d/%d pack_num=%d errors=%d\n", |
Antti Palosaari | 7fa8694 | 2012-08-16 22:07:08 -0300 | [diff] [blame] | 27 | __func__, ptype == PIPE_ISOCHRONOUS ? "isoc" : "bulk", |
Antti Palosaari | 23d8e63 | 2012-06-06 22:46:38 -0300 | [diff] [blame] | 28 | urb->status, urb->actual_length, |
| 29 | urb->transfer_buffer_length, |
| 30 | urb->number_of_packets, urb->error_count); |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 31 | |
| 32 | switch (urb->status) { |
Antti Palosaari | 4e60d95 | 2012-05-24 14:44:21 -0300 | [diff] [blame] | 33 | case 0: /* success */ |
| 34 | case -ETIMEDOUT: /* NAK */ |
| 35 | break; |
| 36 | case -ECONNRESET: /* kill */ |
| 37 | case -ENOENT: |
| 38 | case -ESHUTDOWN: |
| 39 | return; |
| 40 | default: /* error */ |
Antti Palosaari | 7fa8694 | 2012-08-16 22:07:08 -0300 | [diff] [blame] | 41 | dev_dbg_ratelimited(&stream->udev->dev, |
| 42 | "%s: urb completition failed=%d\n", |
Antti Palosaari | d10d1b9 | 2012-06-26 22:44:00 -0300 | [diff] [blame] | 43 | __func__, urb->status); |
Antti Palosaari | 4e60d95 | 2012-05-24 14:44:21 -0300 | [diff] [blame] | 44 | break; |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 45 | } |
| 46 | |
| 47 | b = (u8 *) urb->transfer_buffer; |
| 48 | switch (ptype) { |
Antti Palosaari | 4e60d95 | 2012-05-24 14:44:21 -0300 | [diff] [blame] | 49 | case PIPE_ISOCHRONOUS: |
| 50 | for (i = 0; i < urb->number_of_packets; i++) { |
| 51 | if (urb->iso_frame_desc[i].status != 0) |
Antti Palosaari | 6d7cfec | 2013-03-09 11:36:35 -0300 | [diff] [blame] | 52 | dev_dbg(&stream->udev->dev, |
| 53 | "%s: iso frame descriptor has an error=%d\n", |
Antti Palosaari | d10d1b9 | 2012-06-26 22:44:00 -0300 | [diff] [blame] | 54 | __func__, |
Antti Palosaari | 15072bb | 2012-05-28 18:23:17 -0300 | [diff] [blame] | 55 | urb->iso_frame_desc[i].status); |
Antti Palosaari | 4e60d95 | 2012-05-24 14:44:21 -0300 | [diff] [blame] | 56 | else if (urb->iso_frame_desc[i].actual_length > 0) |
| 57 | stream->complete(stream, |
| 58 | b + urb->iso_frame_desc[i].offset, |
| 59 | urb->iso_frame_desc[i].actual_length); |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 60 | |
Antti Palosaari | 4e60d95 | 2012-05-24 14:44:21 -0300 | [diff] [blame] | 61 | urb->iso_frame_desc[i].status = 0; |
| 62 | urb->iso_frame_desc[i].actual_length = 0; |
| 63 | } |
Antti Palosaari | 4e60d95 | 2012-05-24 14:44:21 -0300 | [diff] [blame] | 64 | break; |
| 65 | case PIPE_BULK: |
| 66 | if (urb->actual_length > 0) |
| 67 | stream->complete(stream, b, urb->actual_length); |
| 68 | break; |
| 69 | default: |
Antti Palosaari | 6d7cfec | 2013-03-09 11:36:35 -0300 | [diff] [blame] | 70 | dev_err(&stream->udev->dev, |
| 71 | "%s: unknown endpoint type in completition handler\n", |
| 72 | KBUILD_MODNAME); |
Antti Palosaari | 4e60d95 | 2012-05-24 14:44:21 -0300 | [diff] [blame] | 73 | return; |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 74 | } |
Antti Palosaari | 4e60d95 | 2012-05-24 14:44:21 -0300 | [diff] [blame] | 75 | usb_submit_urb(urb, GFP_ATOMIC); |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 76 | } |
| 77 | |
Antti Palosaari | 5978434 | 2012-08-01 14:44:06 -0300 | [diff] [blame] | 78 | int usb_urb_killv2(struct usb_data_stream *stream) |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 79 | { |
| 80 | int i; |
| 81 | for (i = 0; i < stream->urbs_submitted; i++) { |
Antti Palosaari | d10d1b9 | 2012-06-26 22:44:00 -0300 | [diff] [blame] | 82 | dev_dbg(&stream->udev->dev, "%s: kill urb=%d\n", __func__, i); |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 83 | /* stop the URB */ |
| 84 | usb_kill_urb(stream->urb_list[i]); |
| 85 | } |
| 86 | stream->urbs_submitted = 0; |
| 87 | return 0; |
| 88 | } |
| 89 | |
Antti Palosaari | 5978434 | 2012-08-01 14:44:06 -0300 | [diff] [blame] | 90 | int usb_urb_submitv2(struct usb_data_stream *stream, |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 91 | struct usb_data_stream_properties *props) |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 92 | { |
Antti Palosaari | 4e60d95 | 2012-05-24 14:44:21 -0300 | [diff] [blame] | 93 | int i, ret; |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 94 | |
| 95 | if (props) { |
| 96 | ret = usb_urb_reconfig(stream, props); |
| 97 | if (ret < 0) |
| 98 | return ret; |
| 99 | } |
| 100 | |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 101 | for (i = 0; i < stream->urbs_initialized; i++) { |
Antti Palosaari | d10d1b9 | 2012-06-26 22:44:00 -0300 | [diff] [blame] | 102 | dev_dbg(&stream->udev->dev, "%s: submit urb=%d\n", __func__, i); |
Antti Palosaari | 4e60d95 | 2012-05-24 14:44:21 -0300 | [diff] [blame] | 103 | ret = usb_submit_urb(stream->urb_list[i], GFP_ATOMIC); |
| 104 | if (ret) { |
Antti Palosaari | 6d7cfec | 2013-03-09 11:36:35 -0300 | [diff] [blame] | 105 | dev_err(&stream->udev->dev, |
| 106 | "%s: could not submit urb no. %d - get them all back\n", |
Antti Palosaari | d10d1b9 | 2012-06-26 22:44:00 -0300 | [diff] [blame] | 107 | KBUILD_MODNAME, i); |
Antti Palosaari | 5978434 | 2012-08-01 14:44:06 -0300 | [diff] [blame] | 108 | usb_urb_killv2(stream); |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 109 | return ret; |
| 110 | } |
| 111 | stream->urbs_submitted++; |
| 112 | } |
| 113 | return 0; |
| 114 | } |
| 115 | |
Mauro Carvalho Chehab | 691a550 | 2012-10-27 14:08:45 -0300 | [diff] [blame] | 116 | static int usb_urb_free_urbs(struct usb_data_stream *stream) |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 117 | { |
| 118 | int i; |
| 119 | |
Antti Palosaari | 5978434 | 2012-08-01 14:44:06 -0300 | [diff] [blame] | 120 | usb_urb_killv2(stream); |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 121 | |
Antti Palosaari | 831511b | 2012-06-20 00:32:53 -0300 | [diff] [blame] | 122 | for (i = stream->urbs_initialized - 1; i >= 0; i--) { |
| 123 | if (stream->urb_list[i]) { |
Antti Palosaari | d10d1b9 | 2012-06-26 22:44:00 -0300 | [diff] [blame] | 124 | dev_dbg(&stream->udev->dev, "%s: free urb=%d\n", |
| 125 | __func__, i); |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 126 | /* free the URBs */ |
| 127 | usb_free_urb(stream->urb_list[i]); |
| 128 | } |
| 129 | } |
| 130 | stream->urbs_initialized = 0; |
| 131 | |
| 132 | return 0; |
| 133 | } |
| 134 | |
| 135 | static int usb_urb_alloc_bulk_urbs(struct usb_data_stream *stream) |
| 136 | { |
| 137 | int i, j; |
| 138 | |
| 139 | /* allocate the URBs */ |
| 140 | for (i = 0; i < stream->props.count; i++) { |
Antti Palosaari | d10d1b9 | 2012-06-26 22:44:00 -0300 | [diff] [blame] | 141 | dev_dbg(&stream->udev->dev, "%s: alloc urb=%d\n", __func__, i); |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 142 | stream->urb_list[i] = usb_alloc_urb(0, GFP_ATOMIC); |
| 143 | if (!stream->urb_list[i]) { |
Antti Palosaari | d10d1b9 | 2012-06-26 22:44:00 -0300 | [diff] [blame] | 144 | dev_dbg(&stream->udev->dev, "%s: failed\n", __func__); |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 145 | for (j = 0; j < i; j++) |
| 146 | usb_free_urb(stream->urb_list[j]); |
| 147 | return -ENOMEM; |
| 148 | } |
| 149 | usb_fill_bulk_urb(stream->urb_list[i], |
| 150 | stream->udev, |
| 151 | usb_rcvbulkpipe(stream->udev, |
| 152 | stream->props.endpoint), |
| 153 | stream->buf_list[i], |
| 154 | stream->props.u.bulk.buffersize, |
| 155 | usb_urb_complete, stream); |
| 156 | |
| 157 | stream->urb_list[i]->transfer_flags = URB_NO_TRANSFER_DMA_MAP; |
| 158 | stream->urb_list[i]->transfer_dma = stream->dma_addr[i]; |
| 159 | stream->urbs_initialized++; |
| 160 | } |
| 161 | return 0; |
| 162 | } |
| 163 | |
| 164 | static int usb_urb_alloc_isoc_urbs(struct usb_data_stream *stream) |
| 165 | { |
| 166 | int i, j; |
| 167 | |
| 168 | /* allocate the URBs */ |
| 169 | for (i = 0; i < stream->props.count; i++) { |
| 170 | struct urb *urb; |
| 171 | int frame_offset = 0; |
Antti Palosaari | d10d1b9 | 2012-06-26 22:44:00 -0300 | [diff] [blame] | 172 | dev_dbg(&stream->udev->dev, "%s: alloc urb=%d\n", __func__, i); |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 173 | stream->urb_list[i] = usb_alloc_urb( |
| 174 | stream->props.u.isoc.framesperurb, GFP_ATOMIC); |
| 175 | if (!stream->urb_list[i]) { |
Antti Palosaari | d10d1b9 | 2012-06-26 22:44:00 -0300 | [diff] [blame] | 176 | dev_dbg(&stream->udev->dev, "%s: failed\n", __func__); |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 177 | for (j = 0; j < i; j++) |
| 178 | usb_free_urb(stream->urb_list[j]); |
| 179 | return -ENOMEM; |
| 180 | } |
| 181 | |
| 182 | urb = stream->urb_list[i]; |
| 183 | |
| 184 | urb->dev = stream->udev; |
| 185 | urb->context = stream; |
| 186 | urb->complete = usb_urb_complete; |
| 187 | urb->pipe = usb_rcvisocpipe(stream->udev, |
| 188 | stream->props.endpoint); |
| 189 | urb->transfer_flags = URB_ISO_ASAP | URB_NO_TRANSFER_DMA_MAP; |
| 190 | urb->interval = stream->props.u.isoc.interval; |
| 191 | urb->number_of_packets = stream->props.u.isoc.framesperurb; |
| 192 | urb->transfer_buffer_length = stream->props.u.isoc.framesize * |
| 193 | stream->props.u.isoc.framesperurb; |
| 194 | urb->transfer_buffer = stream->buf_list[i]; |
| 195 | urb->transfer_dma = stream->dma_addr[i]; |
| 196 | |
| 197 | for (j = 0; j < stream->props.u.isoc.framesperurb; j++) { |
| 198 | urb->iso_frame_desc[j].offset = frame_offset; |
| 199 | urb->iso_frame_desc[j].length = |
| 200 | stream->props.u.isoc.framesize; |
| 201 | frame_offset += stream->props.u.isoc.framesize; |
| 202 | } |
| 203 | |
| 204 | stream->urbs_initialized++; |
| 205 | } |
| 206 | return 0; |
| 207 | } |
| 208 | |
Mauro Carvalho Chehab | 691a550 | 2012-10-27 14:08:45 -0300 | [diff] [blame] | 209 | static int usb_free_stream_buffers(struct usb_data_stream *stream) |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 210 | { |
| 211 | if (stream->state & USB_STATE_URB_BUF) { |
| 212 | while (stream->buf_num) { |
| 213 | stream->buf_num--; |
Antti Palosaari | d10d1b9 | 2012-06-26 22:44:00 -0300 | [diff] [blame] | 214 | dev_dbg(&stream->udev->dev, "%s: free buf=%d\n", |
| 215 | __func__, stream->buf_num); |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 216 | usb_free_coherent(stream->udev, stream->buf_size, |
| 217 | stream->buf_list[stream->buf_num], |
| 218 | stream->dma_addr[stream->buf_num]); |
| 219 | } |
| 220 | } |
| 221 | |
| 222 | stream->state &= ~USB_STATE_URB_BUF; |
| 223 | |
| 224 | return 0; |
| 225 | } |
| 226 | |
Mauro Carvalho Chehab | 691a550 | 2012-10-27 14:08:45 -0300 | [diff] [blame] | 227 | static int usb_alloc_stream_buffers(struct usb_data_stream *stream, int num, |
| 228 | unsigned long size) |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 229 | { |
| 230 | stream->buf_num = 0; |
| 231 | stream->buf_size = size; |
| 232 | |
Antti Palosaari | 6d7cfec | 2013-03-09 11:36:35 -0300 | [diff] [blame] | 233 | dev_dbg(&stream->udev->dev, |
| 234 | "%s: all in all I will use %lu bytes for streaming\n", |
| 235 | __func__, num * size); |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 236 | |
| 237 | for (stream->buf_num = 0; stream->buf_num < num; stream->buf_num++) { |
Antti Palosaari | 4e60d95 | 2012-05-24 14:44:21 -0300 | [diff] [blame] | 238 | stream->buf_list[stream->buf_num] = usb_alloc_coherent( |
| 239 | stream->udev, size, GFP_ATOMIC, |
| 240 | &stream->dma_addr[stream->buf_num]); |
Antti Palosaari | 831511b | 2012-06-20 00:32:53 -0300 | [diff] [blame] | 241 | if (!stream->buf_list[stream->buf_num]) { |
Antti Palosaari | d10d1b9 | 2012-06-26 22:44:00 -0300 | [diff] [blame] | 242 | dev_dbg(&stream->udev->dev, "%s: alloc buf=%d failed\n", |
| 243 | __func__, stream->buf_num); |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 244 | usb_free_stream_buffers(stream); |
| 245 | return -ENOMEM; |
| 246 | } |
Antti Palosaari | 15072bb | 2012-05-28 18:23:17 -0300 | [diff] [blame] | 247 | |
Antti Palosaari | d10d1b9 | 2012-06-26 22:44:00 -0300 | [diff] [blame] | 248 | dev_dbg(&stream->udev->dev, "%s: alloc buf=%d %p (dma %llu)\n", |
| 249 | __func__, stream->buf_num, |
Antti Palosaari | 4e60d95 | 2012-05-24 14:44:21 -0300 | [diff] [blame] | 250 | stream->buf_list[stream->buf_num], |
| 251 | (long long)stream->dma_addr[stream->buf_num]); |
| 252 | memset(stream->buf_list[stream->buf_num], 0, size); |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 253 | stream->state |= USB_STATE_URB_BUF; |
| 254 | } |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 255 | |
| 256 | return 0; |
| 257 | } |
| 258 | |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 259 | int usb_urb_reconfig(struct usb_data_stream *stream, |
| 260 | struct usb_data_stream_properties *props) |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 261 | { |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 262 | int buf_size; |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 263 | |
Antti Palosaari | 831511b | 2012-06-20 00:32:53 -0300 | [diff] [blame] | 264 | if (!props) |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 265 | return 0; |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 266 | |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 267 | /* check allocated buffers are large enough for the request */ |
Antti Palosaari | 15072bb | 2012-05-28 18:23:17 -0300 | [diff] [blame] | 268 | if (props->type == USB_BULK) { |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 269 | buf_size = stream->props.u.bulk.buffersize; |
Antti Palosaari | 15072bb | 2012-05-28 18:23:17 -0300 | [diff] [blame] | 270 | } else if (props->type == USB_ISOC) { |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 271 | buf_size = props->u.isoc.framesize * props->u.isoc.framesperurb; |
Antti Palosaari | 15072bb | 2012-05-28 18:23:17 -0300 | [diff] [blame] | 272 | } else { |
Antti Palosaari | d10d1b9 | 2012-06-26 22:44:00 -0300 | [diff] [blame] | 273 | dev_err(&stream->udev->dev, "%s: invalid endpoint type=%d\n", |
| 274 | KBUILD_MODNAME, props->type); |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 275 | return -EINVAL; |
Antti Palosaari | 15072bb | 2012-05-28 18:23:17 -0300 | [diff] [blame] | 276 | } |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 277 | |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 278 | if (stream->buf_num < props->count || stream->buf_size < buf_size) { |
Antti Palosaari | 6d7cfec | 2013-03-09 11:36:35 -0300 | [diff] [blame] | 279 | dev_err(&stream->udev->dev, |
| 280 | "%s: cannot reconfigure as allocated buffers are too small\n", |
Antti Palosaari | d10d1b9 | 2012-06-26 22:44:00 -0300 | [diff] [blame] | 281 | KBUILD_MODNAME); |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 282 | return -EINVAL; |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 283 | } |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 284 | |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 285 | /* check if all fields are same */ |
| 286 | if (stream->props.type == props->type && |
| 287 | stream->props.count == props->count && |
| 288 | stream->props.endpoint == props->endpoint) { |
| 289 | if (props->type == USB_BULK && |
| 290 | props->u.bulk.buffersize == |
| 291 | stream->props.u.bulk.buffersize) |
| 292 | return 0; |
| 293 | else if (props->type == USB_ISOC && |
| 294 | props->u.isoc.framesperurb == |
| 295 | stream->props.u.isoc.framesperurb && |
| 296 | props->u.isoc.framesize == |
| 297 | stream->props.u.isoc.framesize && |
| 298 | props->u.isoc.interval == |
| 299 | stream->props.u.isoc.interval) |
| 300 | return 0; |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 301 | } |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 302 | |
Antti Palosaari | d10d1b9 | 2012-06-26 22:44:00 -0300 | [diff] [blame] | 303 | dev_dbg(&stream->udev->dev, "%s: re-alloc urbs\n", __func__); |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 304 | |
| 305 | usb_urb_free_urbs(stream); |
| 306 | memcpy(&stream->props, props, sizeof(*props)); |
| 307 | if (props->type == USB_BULK) |
| 308 | return usb_urb_alloc_bulk_urbs(stream); |
| 309 | else if (props->type == USB_ISOC) |
| 310 | return usb_urb_alloc_isoc_urbs(stream); |
| 311 | |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 312 | return 0; |
| 313 | } |
| 314 | |
Antti Palosaari | 5978434 | 2012-08-01 14:44:06 -0300 | [diff] [blame] | 315 | int usb_urb_initv2(struct usb_data_stream *stream, |
Antti Palosaari | 6400a8c | 2012-06-16 16:02:57 -0300 | [diff] [blame] | 316 | const struct usb_data_stream_properties *props) |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 317 | { |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 318 | int ret; |
| 319 | |
Antti Palosaari | 831511b | 2012-06-20 00:32:53 -0300 | [diff] [blame] | 320 | if (!stream || !props) |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 321 | return -EINVAL; |
| 322 | |
| 323 | memcpy(&stream->props, props, sizeof(*props)); |
| 324 | |
Antti Palosaari | 831511b | 2012-06-20 00:32:53 -0300 | [diff] [blame] | 325 | if (!stream->complete) { |
Antti Palosaari | 6d7cfec | 2013-03-09 11:36:35 -0300 | [diff] [blame] | 326 | dev_err(&stream->udev->dev, |
| 327 | "%s: there is no data callback - this doesn't make sense\n", |
| 328 | KBUILD_MODNAME); |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 329 | return -EINVAL; |
| 330 | } |
| 331 | |
| 332 | switch (stream->props.type) { |
Antti Palosaari | 4e60d95 | 2012-05-24 14:44:21 -0300 | [diff] [blame] | 333 | case USB_BULK: |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 334 | ret = usb_alloc_stream_buffers(stream, stream->props.count, |
| 335 | stream->props.u.bulk.buffersize); |
| 336 | if (ret < 0) |
| 337 | return ret; |
| 338 | |
| 339 | return usb_urb_alloc_bulk_urbs(stream); |
Antti Palosaari | 4e60d95 | 2012-05-24 14:44:21 -0300 | [diff] [blame] | 340 | case USB_ISOC: |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 341 | ret = usb_alloc_stream_buffers(stream, stream->props.count, |
| 342 | stream->props.u.isoc.framesize * |
| 343 | stream->props.u.isoc.framesperurb); |
| 344 | if (ret < 0) |
| 345 | return ret; |
| 346 | |
| 347 | return usb_urb_alloc_isoc_urbs(stream); |
Antti Palosaari | 4e60d95 | 2012-05-24 14:44:21 -0300 | [diff] [blame] | 348 | default: |
Antti Palosaari | 6d7cfec | 2013-03-09 11:36:35 -0300 | [diff] [blame] | 349 | dev_err(&stream->udev->dev, |
| 350 | "%s: unknown urb-type for data transfer\n", |
| 351 | KBUILD_MODNAME); |
Antti Palosaari | 4e60d95 | 2012-05-24 14:44:21 -0300 | [diff] [blame] | 352 | return -EINVAL; |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 353 | } |
| 354 | } |
| 355 | |
Antti Palosaari | 5978434 | 2012-08-01 14:44:06 -0300 | [diff] [blame] | 356 | int usb_urb_exitv2(struct usb_data_stream *stream) |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 357 | { |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 358 | usb_urb_free_urbs(stream); |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 359 | usb_free_stream_buffers(stream); |
Antti Palosaari | bce1c02 | 2012-05-28 17:25:40 -0300 | [diff] [blame] | 360 | |
Antti Palosaari | c79b339 | 2012-05-23 10:06:09 -0300 | [diff] [blame] | 361 | return 0; |
| 362 | } |