FILE
msi2500.c
File preview with syntax highlighting.
linux-6.19.14/drivers/media/usb/msi2500/msi2500.c
1// SPDX-License-Identifier: GPL-2.0-or-later 2/* 3 * Mirics MSi2500 driver 4 * Mirics MSi3101 SDR Dongle driver 5 * 6 * Copyright (C) 2013 Antti Palosaari <crope@iki.fi> 7 * 8 * That driver is somehow based of pwc driver: 9 * (C) 1999-2004 Nemosoft Unv. 10 * (C) 2004-2006 Luc Saillard (luc@saillard.org) 11 * (C) 2011 Hans de Goede <hdegoede@redhat.com> 12 */ 13 14#include <linux/module.h> 15#include <linux/slab.h> 16#include <asm/div64.h> 17#include <media/v4l2-device.h> 18#include <media/v4l2-ioctl.h> 19#include <media/v4l2-ctrls.h> 20#include <media/v4l2-event.h> 21#include <linux/usb.h> 22#include <media/videobuf2-v4l2.h> 23#include <media/videobuf2-vmalloc.h> 24#include <linux/spi/spi.h> 25 26static bool msi2500_emulated_fmt; 27module_param_named(emulated_formats, msi2500_emulated_fmt, bool, 0644); 28MODULE_PARM_DESC(emulated_formats, "enable emulated formats (disappears in future)"); 29 30/* 31 * iConfiguration 0 32 * bInterfaceNumber 0 33 * bAlternateSetting 1 34 * bNumEndpoints 1 35 * bEndpointAddress 0x81 EP 1 IN 36 * bmAttributes 1 37 * Transfer Type Isochronous 38 * wMaxPacketSize 0x1400 3x 1024 bytes 39 * bInterval 1 40 */ 41#define MAX_ISO_BUFS (8) 42#define ISO_FRAMES_PER_DESC (8) 43#define ISO_MAX_FRAME_SIZE (3 * 1024) 44#define ISO_BUFFER_SIZE (ISO_FRAMES_PER_DESC * ISO_MAX_FRAME_SIZE) 45#define MAX_ISOC_ERRORS 20 46 47/* 48 * TODO: These formats should be moved to V4L2 API. Formats are currently 49 * disabled from formats[] table, not visible to userspace. 50 */ 51 /* signed 12-bit */ 52#define MSI2500_PIX_FMT_SDR_S12 v4l2_fourcc('D', 'S', '1', '2') 53/* Mirics MSi2500 format 384 */ 54#define MSI2500_PIX_FMT_SDR_MSI2500_384 v4l2_fourcc('M', '3', '8', '4') 55 56static const struct v4l2_frequency_band bands[] = { 57 { 58 .tuner = 0, 59 .type = V4L2_TUNER_ADC, 60 .index = 0, 61 .capability = V4L2_TUNER_CAP_1HZ | V4L2_TUNER_CAP_FREQ_BANDS, 62 .rangelow = 1200000, 63 .rangehigh = 15000000, 64 }, 65}; 66 67/* stream formats */ 68struct msi2500_format { 69 u32 pixelformat; 70 u32 buffersize; 71}; 72 73/* format descriptions for capture and preview */ 74static struct msi2500_format formats[] = { 75 { 76 .pixelformat = V4L2_SDR_FMT_CS8, 77 .buffersize = 3 * 1008, 78#if 0 79 }, { 80 .pixelformat = MSI2500_PIX_FMT_SDR_MSI2500_384, 81 }, { 82 .pixelformat = MSI2500_PIX_FMT_SDR_S12, 83#endif 84 }, { 85 .pixelformat = V4L2_SDR_FMT_CS14LE, 86 .buffersize = 3 * 1008, 87 }, { 88 .pixelformat = V4L2_SDR_FMT_CU8, 89 .buffersize = 3 * 1008, 90 }, { 91 .pixelformat = V4L2_SDR_FMT_CU16LE, 92 .buffersize = 3 * 1008, 93 }, 94}; 95 96static const unsigned int NUM_FORMATS = ARRAY_SIZE(formats); 97 98/* intermediate buffers with raw data from the USB device */ 99struct msi2500_frame_buf { 100 /* common v4l buffer stuff -- must be first */ 101 struct vb2_v4l2_buffer vb; 102 struct list_head list; 103}; 104 105struct msi2500_dev { 106 struct device *dev; 107 struct video_device vdev; 108 struct v4l2_device v4l2_dev; 109 struct v4l2_subdev *v4l2_subdev; 110 struct spi_controller *ctlr; 111 112 /* videobuf2 queue and queued buffers list */ 113 struct vb2_queue vb_queue; 114 struct list_head queued_bufs; 115 spinlock_t queued_bufs_lock; /* Protects queued_bufs */ 116 117 /* Note if taking both locks v4l2_lock must always be locked first! */ 118 struct mutex v4l2_lock; /* Protects everything else */ 119 struct mutex vb_queue_lock; /* Protects vb_queue and capt_file */ 120 121 /* Pointer to our usb_device, will be NULL after unplug */ 122 struct usb_device *udev; /* Both mutexes most be hold when setting! */ 123 124 unsigned int f_adc; 125 u32 pixelformat; 126 u32 buffersize; 127 unsigned int num_formats; 128 129 unsigned int isoc_errors; /* number of contiguous ISOC errors */ 130 unsigned int vb_full; /* vb is full and packets dropped */ 131 132 struct urb *urbs[MAX_ISO_BUFS]; 133 134 /* Controls */ 135 struct v4l2_ctrl_handler hdl; 136 137 u32 next_sample; /* for track lost packets */ 138 u32 sample; /* for sample rate calc */ 139 unsigned long jiffies_next; 140}; 141 142/* Private functions */ 143static struct msi2500_frame_buf *msi2500_get_next_fill_buf( 144 struct msi2500_dev *dev) 145{ 146 unsigned long flags; 147 struct msi2500_frame_buf *buf = NULL; 148 149 spin_lock_irqsave(&dev->queued_bufs_lock, flags); 150 if (list_empty(&dev->queued_bufs)) 151 goto leave; 152 153 buf = list_entry(dev->queued_bufs.next, struct msi2500_frame_buf, list); 154 list_del(&buf->list); 155leave: 156 spin_unlock_irqrestore(&dev->queued_bufs_lock, flags); 157 return buf; 158} 159 160/* 161 * +=========================================================================== 162 * | 00-1023 | USB packet type '504' 163 * +=========================================================================== 164 * | 00- 03 | sequence number of first sample in that USB packet 165 * +--------------------------------------------------------------------------- 166 * | 04- 15 | garbage 167 * +--------------------------------------------------------------------------- 168 * | 16-1023 | samples 169 * +--------------------------------------------------------------------------- 170 * signed 8-bit sample 171 * 504 * 2 = 1008 samples 172 * 173 * 174 * +=========================================================================== 175 * | 00-1023 | USB packet type '384' 176 * +=========================================================================== 177 * | 00- 03 | sequence number of first sample in that USB packet 178 * +--------------------------------------------------------------------------- 179 * | 04- 15 | garbage 180 * +--------------------------------------------------------------------------- 181 * | 16- 175 | samples 182 * +--------------------------------------------------------------------------- 183 * | 176- 179 | control bits for previous samples 184 * +--------------------------------------------------------------------------- 185 * | 180- 339 | samples 186 * +--------------------------------------------------------------------------- 187 * | 340- 343 | control bits for previous samples 188 * +--------------------------------------------------------------------------- 189 * | 344- 503 | samples 190 * +--------------------------------------------------------------------------- 191 * | 504- 507 | control bits for previous samples 192 * +--------------------------------------------------------------------------- 193 * | 508- 667 | samples 194 * +--------------------------------------------------------------------------- 195 * | 668- 671 | control bits for previous samples 196 * +--------------------------------------------------------------------------- 197 * | 672- 831 | samples 198 * +--------------------------------------------------------------------------- 199 * | 832- 835 | control bits for previous samples 200 * +--------------------------------------------------------------------------- 201 * | 836- 995 | samples 202 * +--------------------------------------------------------------------------- 203 * | 996- 999 | control bits for previous samples 204 * +--------------------------------------------------------------------------- 205 * | 1000-1023 | garbage 206 * +--------------------------------------------------------------------------- 207 * 208 * Bytes 4 - 7 could have some meaning? 209 * 210 * Control bits for previous samples is 32-bit field, containing 16 x 2-bit 211 * numbers. This results one 2-bit number for 8 samples. It is likely used for 212 * bit shifting sample by given bits, increasing actual sampling resolution. 213 * Number 2 (0b10) was never seen. 214 * 215 * 6 * 16 * 2 * 4 = 768 samples. 768 * 4 = 3072 bytes 216 * 217 * 218 * +=========================================================================== 219 * | 00-1023 | USB packet type '336' 220 * +=========================================================================== 221 * | 00- 03 | sequence number of first sample in that USB packet 222 * +--------------------------------------------------------------------------- 223 * | 04- 15 | garbage 224 * +--------------------------------------------------------------------------- 225 * | 16-1023 | samples 226 * +--------------------------------------------------------------------------- 227 * signed 12-bit sample 228 * 229 * 230 * +=========================================================================== 231 * | 00-1023 | USB packet type '252' 232 * +=========================================================================== 233 * | 00- 03 | sequence number of first sample in that USB packet 234 * +--------------------------------------------------------------------------- 235 * | 04- 15 | garbage 236 * +--------------------------------------------------------------------------- 237 * | 16-1023 | samples 238 * +--------------------------------------------------------------------------- 239 * signed 14-bit sample 240 */ 241 242static int msi2500_convert_stream(struct msi2500_dev *dev, u8 *dst, u8 *src, 243 unsigned int src_len) 244{ 245 unsigned int i, j, transactions, dst_len = 0; 246 u32 sample[3]; 247 248 /* There could be 1-3 1024 byte transactions per packet */ 249 transactions = src_len / 1024; 250 251 for (i = 0; i < transactions; i++) { 252 sample[i] = src[3] << 24 | src[2] << 16 | src[1] << 8 | 253 src[0] << 0; 254 if (i == 0 && dev->next_sample != sample[0]) { 255 dev_dbg_ratelimited(dev->dev, 256 "%d samples lost, %d %08x:%08x\n", 257 sample[0] - dev->next_sample, 258 src_len, dev->next_sample, 259 sample[0]); 260 } 261 262 /* 263 * Dump all unknown 'garbage' data - maybe we will discover 264 * someday if there is something rational... 265 */ 266 dev_dbg_ratelimited(dev->dev, "%*ph\n", 12, &src[4]); 267 268 src += 16; /* skip header */ 269 270 switch (dev->pixelformat) { 271 case V4L2_SDR_FMT_CU8: /* 504 x IQ samples */ 272 { 273 s8 *s8src = (s8 *)src; 274 u8 *u8dst = (u8 *)dst; 275 276 for (j = 0; j < 1008; j++) 277 *u8dst++ = *s8src++ + 128; 278 279 src += 1008; 280 dst += 1008; 281 dst_len += 1008; 282 dev->next_sample = sample[i] + 504; 283 break; 284 } 285 case V4L2_SDR_FMT_CU16LE: /* 252 x IQ samples */ 286 { 287 s16 *s16src = (s16 *)src; 288 u16 *u16dst = (u16 *)dst; 289 struct {signed int x:14; } se; /* sign extension */ 290 unsigned int utmp; 291 292 for (j = 0; j < 1008; j += 2) { 293 /* sign extension from 14-bit to signed int */ 294 se.x = *s16src++; 295 /* from signed int to unsigned int */ 296 utmp = se.x + 8192; 297 /* from 14-bit to 16-bit */ 298 *u16dst++ = utmp << 2 | utmp >> 12; 299 } 300 301 src += 1008; 302 dst += 1008; 303 dst_len += 1008; 304 dev->next_sample = sample[i] + 252; 305 break; 306 } 307 case MSI2500_PIX_FMT_SDR_MSI2500_384: /* 384 x IQ samples */ 308 /* Dump unknown 'garbage' data */ 309 dev_dbg_ratelimited(dev->dev, "%*ph\n", 24, &src[1000]); 310 memcpy(dst, src, 984); 311 src += 984 + 24; 312 dst += 984; 313 dst_len += 984; 314 dev->next_sample = sample[i] + 384; 315 break; 316 case V4L2_SDR_FMT_CS8: /* 504 x IQ samples */ 317 memcpy(dst, src, 1008); 318 src += 1008; 319 dst += 1008; 320 dst_len += 1008; 321 dev->next_sample = sample[i] + 504; 322 break; 323 case MSI2500_PIX_FMT_SDR_S12: /* 336 x IQ samples */ 324 memcpy(dst, src, 1008); 325 src += 1008; 326 dst += 1008; 327 dst_len += 1008; 328 dev->next_sample = sample[i] + 336; 329 break; 330 case V4L2_SDR_FMT_CS14LE: /* 252 x IQ samples */ 331 memcpy(dst, src, 1008); 332 src += 1008; 333 dst += 1008; 334 dst_len += 1008; 335 dev->next_sample = sample[i] + 252; 336 break; 337 default: 338 break; 339 } 340 } 341 342 /* calculate sample rate and output it in 10 seconds intervals */ 343 if (unlikely(time_is_before_jiffies(dev->jiffies_next))) { 344 #define MSECS 10000UL 345 unsigned int msecs = jiffies_to_msecs(jiffies - 346 dev->jiffies_next + msecs_to_jiffies(MSECS)); 347 unsigned int samples = dev->next_sample - dev->sample; 348 349 dev->jiffies_next = jiffies + msecs_to_jiffies(MSECS); 350 dev->sample = dev->next_sample; 351 dev_dbg(dev->dev, "size=%u samples=%u msecs=%u sample rate=%lu\n", 352 src_len, samples, msecs, 353 samples * 1000UL / msecs); 354 } 355 356 return dst_len; 357} 358 359/* 360 * This gets called for the Isochronous pipe (stream). This is done in interrupt 361 * time, so it has to be fast, not crash, and not stall. Neat. 362 */ 363static void msi2500_isoc_handler(struct urb *urb) 364{ 365 struct msi2500_dev *dev = (struct msi2500_dev *)urb->context; 366 int i, flen, fstatus; 367 unsigned char *iso_buf = NULL; 368 struct msi2500_frame_buf *fbuf; 369 370 if (unlikely(urb->status == -ENOENT || 371 urb->status == -ECONNRESET || 372 urb->status == -ESHUTDOWN)) { 373 dev_dbg(dev->dev, "URB (%p) unlinked %ssynchronously\n", 374 urb, urb->status == -ENOENT ? "" : "a"); 375 return; 376 } 377 378 if (unlikely(urb->status != 0)) { 379 dev_dbg(dev->dev, "called with status %d\n", urb->status); 380 /* Give up after a number of contiguous errors */ 381 if (++dev->isoc_errors > MAX_ISOC_ERRORS) 382 dev_dbg(dev->dev, "Too many ISOC errors, bailing out\n"); 383 goto handler_end; 384 } else { 385 /* Reset ISOC error counter. We did get here, after all. */ 386 dev->isoc_errors = 0; 387 } 388 389 /* Compact data */ 390 for (i = 0; i < urb->number_of_packets; i++) { 391 void *ptr; 392 393 /* Check frame error */ 394 fstatus = urb->iso_frame_desc[i].status; 395 if (unlikely(fstatus)) { 396 dev_dbg_ratelimited(dev->dev, 397 "frame=%d/%d has error %d skipping\n", 398 i, urb->number_of_packets, fstatus); 399 continue; 400 } 401 402 /* Check if that frame contains data */ 403 flen = urb->iso_frame_desc[i].actual_length; 404 if (unlikely(flen == 0)) 405 continue; 406 407 iso_buf = urb->transfer_buffer + urb->iso_frame_desc[i].offset; 408 409 /* Get free framebuffer */ 410 fbuf = msi2500_get_next_fill_buf(dev); 411 if (unlikely(fbuf == NULL)) { 412 dev->vb_full++; 413 dev_dbg_ratelimited(dev->dev, 414 "video buffer is full, %d packets dropped\n", 415 dev->vb_full); 416 continue; 417 } 418 419 /* fill framebuffer */ 420 ptr = vb2_plane_vaddr(&fbuf->vb.vb2_buf, 0); 421 flen = msi2500_convert_stream(dev, ptr, iso_buf, flen); 422 vb2_set_plane_payload(&fbuf->vb.vb2_buf, 0, flen); 423 vb2_buffer_done(&fbuf->vb.vb2_buf, VB2_BUF_STATE_DONE); 424 } 425 426handler_end: 427 i = usb_submit_urb(urb, GFP_ATOMIC); 428 if (unlikely(i != 0)) 429 dev_dbg(dev->dev, "Error (%d) re-submitting urb\n", i); 430} 431 432static void msi2500_iso_stop(struct msi2500_dev *dev) 433{ 434 int i; 435 436 dev_dbg(dev->dev, "\n"); 437 438 /* Unlinking ISOC buffers one by one */ 439 for (i = 0; i < MAX_ISO_BUFS; i++) { 440 if (dev->urbs[i]) { 441 dev_dbg(dev->dev, "Unlinking URB %p\n", dev->urbs[i]); 442 usb_kill_urb(dev->urbs[i]); 443 } 444 } 445} 446 447static void msi2500_iso_free(struct msi2500_dev *dev) 448{ 449 int i; 450 451 dev_dbg(dev->dev, "\n"); 452 453 /* Freeing ISOC buffers one by one */ 454 for (i = 0; i < MAX_ISO_BUFS; i++) { 455 if (dev->urbs[i]) { 456 dev_dbg(dev->dev, "Freeing URB\n"); 457 if (dev->urbs[i]->transfer_buffer) { 458 usb_free_coherent(dev->udev, 459 dev->urbs[i]->transfer_buffer_length, 460 dev->urbs[i]->transfer_buffer, 461 dev->urbs[i]->transfer_dma); 462 } 463 usb_free_urb(dev->urbs[i]); 464 dev->urbs[i] = NULL; 465 } 466 } 467} 468 469/* Both v4l2_lock and vb_queue_lock should be locked when calling this */ 470static void msi2500_isoc_cleanup(struct msi2500_dev *dev) 471{ 472 dev_dbg(dev->dev, "\n"); 473 474 msi2500_iso_stop(dev); 475 msi2500_iso_free(dev); 476} 477 478/* Both v4l2_lock and vb_queue_lock should be locked when calling this */ 479static int msi2500_isoc_init(struct msi2500_dev *dev) 480{ 481 struct urb *urb; 482 int i, j, ret; 483 484 dev_dbg(dev->dev, "\n"); 485 486 dev->isoc_errors = 0; 487 488 ret = usb_set_interface(dev->udev, 0, 1); 489 if (ret) 490 return ret; 491 492 /* Allocate and init Isochronuous urbs */ 493 for (i = 0; i < MAX_ISO_BUFS; i++) { 494 urb = usb_alloc_urb(ISO_FRAMES_PER_DESC, GFP_KERNEL); 495 if (urb == NULL) { 496 msi2500_isoc_cleanup(dev); 497 return -ENOMEM; 498 } 499 dev->urbs[i] = urb; 500 dev_dbg(dev->dev, "Allocated URB at 0x%p\n", urb); 501 502 urb->interval = 1; 503 urb->dev = dev->udev; 504 urb->pipe = usb_rcvisocpipe(dev->udev, 0x81); 505 urb->transfer_flags = URB_ISO_ASAP | URB_NO_TRANSFER_DMA_MAP; 506 urb->transfer_buffer = usb_alloc_coherent(dev->udev, 507 ISO_BUFFER_SIZE, 508 GFP_KERNEL, &urb->transfer_dma); 509 if (urb->transfer_buffer == NULL) { 510 dev_err(dev->dev, 511 "Failed to allocate urb buffer %d\n", i); 512 msi2500_isoc_cleanup(dev); 513 return -ENOMEM; 514 } 515 urb->transfer_buffer_length = ISO_BUFFER_SIZE; 516 urb->complete = msi2500_isoc_handler; 517 urb->context = dev; 518 urb->start_frame = 0; 519 urb->number_of_packets = ISO_FRAMES_PER_DESC; 520 for (j = 0; j < ISO_FRAMES_PER_DESC; j++) { 521 urb->iso_frame_desc[j].offset = j * ISO_MAX_FRAME_SIZE; 522 urb->iso_frame_desc[j].length = ISO_MAX_FRAME_SIZE; 523 } 524 } 525 526 /* link */ 527 for (i = 0; i < MAX_ISO_BUFS; i++) { 528 ret = usb_submit_urb(dev->urbs[i], GFP_KERNEL); 529 if (ret) { 530 dev_err(dev->dev, 531 "usb_submit_urb %d failed with error %d\n", 532 i, ret); 533 msi2500_isoc_cleanup(dev); 534 return ret; 535 } 536 dev_dbg(dev->dev, "URB 0x%p submitted.\n", dev->urbs[i]); 537 } 538 539 /* All is done... */ 540 return 0; 541} 542 543/* Must be called with vb_queue_lock hold */ 544static void msi2500_cleanup_queued_bufs(struct msi2500_dev *dev) 545{ 546 unsigned long flags; 547 548 dev_dbg(dev->dev, "\n"); 549 550 spin_lock_irqsave(&dev->queued_bufs_lock, flags); 551 while (!list_empty(&dev->queued_bufs)) { 552 struct msi2500_frame_buf *buf; 553 554 buf = list_entry(dev->queued_bufs.next, 555 struct msi2500_frame_buf, list); 556 list_del(&buf->list); 557 vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR); 558 } 559 spin_unlock_irqrestore(&dev->queued_bufs_lock, flags); 560} 561 562/* The user yanked out the cable... */ 563static void msi2500_disconnect(struct usb_interface *intf) 564{ 565 struct v4l2_device *v = usb_get_intfdata(intf); 566 struct msi2500_dev *dev = 567 container_of(v, struct msi2500_dev, v4l2_dev); 568 569 dev_dbg(dev->dev, "\n"); 570 571 mutex_lock(&dev->vb_queue_lock); 572 mutex_lock(&dev->v4l2_lock); 573 /* No need to keep the urbs around after disconnection */ 574 dev->udev = NULL; 575 v4l2_device_disconnect(&dev->v4l2_dev); 576 video_unregister_device(&dev->vdev); 577 spi_unregister_controller(dev->ctlr); 578 mutex_unlock(&dev->v4l2_lock); 579 mutex_unlock(&dev->vb_queue_lock); 580 581 v4l2_device_put(&dev->v4l2_dev); 582} 583 584static int msi2500_querycap(struct file *file, void *fh, 585 struct v4l2_capability *cap) 586{ 587 struct msi2500_dev *dev = video_drvdata(file); 588 589 dev_dbg(dev->dev, "\n"); 590 591 strscpy(cap->driver, KBUILD_MODNAME, sizeof(cap->driver)); 592 strscpy(cap->card, dev->vdev.name, sizeof(cap->card)); 593 usb_make_path(dev->udev, cap->bus_info, sizeof(cap->bus_info)); 594 return 0; 595} 596 597/* Videobuf2 operations */ 598static int msi2500_queue_setup(struct vb2_queue *vq, 599 unsigned int *nbuffers, 600 unsigned int *nplanes, unsigned int sizes[], 601 struct device *alloc_devs[]) 602{ 603 struct msi2500_dev *dev = vb2_get_drv_priv(vq); 604 605 dev_dbg(dev->dev, "nbuffers=%d\n", *nbuffers); 606 607 /* Absolute min and max number of buffers available for mmap() */ 608 *nbuffers = clamp_t(unsigned int, *nbuffers, 8, 32); 609 *nplanes = 1; 610 sizes[0] = PAGE_ALIGN(dev->buffersize); 611 dev_dbg(dev->dev, "nbuffers=%d sizes[0]=%d\n", *nbuffers, sizes[0]); 612 return 0; 613} 614 615static void msi2500_buf_queue(struct vb2_buffer *vb) 616{ 617 struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); 618 struct msi2500_dev *dev = vb2_get_drv_priv(vb->vb2_queue); 619 struct msi2500_frame_buf *buf = container_of(vbuf, 620 struct msi2500_frame_buf, 621 vb); 622 unsigned long flags; 623 624 /* Check the device has not disconnected between prep and queuing */ 625 if (unlikely(!dev->udev)) { 626 vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR); 627 return; 628 } 629 630 spin_lock_irqsave(&dev->queued_bufs_lock, flags); 631 list_add_tail(&buf->list, &dev->queued_bufs); 632 spin_unlock_irqrestore(&dev->queued_bufs_lock, flags); 633} 634 635#define CMD_WREG 0x41 636#define CMD_START_STREAMING 0x43 637#define CMD_STOP_STREAMING 0x45 638#define CMD_READ_UNKNOWN 0x48 639 640#define msi2500_dbg_usb_control_msg(_dev, _r, _t, _v, _i, _b, _l) { \ 641 char *_direction; \ 642 if (_t & USB_DIR_IN) \ 643 _direction = "<<<"; \ 644 else \ 645 _direction = ">>>"; \ 646 dev_dbg(_dev, "%02x %02x %02x %02x %02x %02x %02x %02x %s %*ph\n", \ 647 _t, _r, _v & 0xff, _v >> 8, _i & 0xff, _i >> 8, \ 648 _l & 0xff, _l >> 8, _direction, _l, _b); \ 649} 650 651static int msi2500_ctrl_msg(struct msi2500_dev *dev, u8 cmd, u32 data) 652{ 653 int ret; 654 u8 request = cmd; 655 u8 requesttype = USB_DIR_OUT | USB_TYPE_VENDOR; 656 u16 value = (data >> 0) & 0xffff; 657 u16 index = (data >> 16) & 0xffff; 658 659 msi2500_dbg_usb_control_msg(dev->dev, request, requesttype, 660 value, index, NULL, 0); 661 ret = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, 0), request, 662 requesttype, value, index, NULL, 0, 2000); 663 if (ret) 664 dev_err(dev->dev, "failed %d, cmd %02x, data %04x\n", 665 ret, cmd, data); 666 667 return ret; 668} 669 670static int msi2500_set_usb_adc(struct msi2500_dev *dev) 671{ 672 int ret; 673 unsigned int f_vco, f_sr, div_n, k, k_cw, div_out; 674 u32 reg3, reg4, reg7; 675 struct v4l2_ctrl *bandwidth_auto; 676 struct v4l2_ctrl *bandwidth; 677 678 f_sr = dev->f_adc; 679 680 /* set tuner, subdev, filters according to sampling rate */ 681 bandwidth_auto = v4l2_ctrl_find(&dev->hdl, 682 V4L2_CID_RF_TUNER_BANDWIDTH_AUTO); 683 if (v4l2_ctrl_g_ctrl(bandwidth_auto)) { 684 bandwidth = v4l2_ctrl_find(&dev->hdl, 685 V4L2_CID_RF_TUNER_BANDWIDTH); 686 v4l2_ctrl_s_ctrl(bandwidth, dev->f_adc); 687 } 688 689 /* select stream format */ 690 switch (dev->pixelformat) { 691 case V4L2_SDR_FMT_CU8: 692 reg7 = 0x000c9407; /* 504 */ 693 break; 694 case V4L2_SDR_FMT_CU16LE: 695 reg7 = 0x00009407; /* 252 */ 696 break; 697 case V4L2_SDR_FMT_CS8: 698 reg7 = 0x000c9407; /* 504 */ 699 break; 700 case MSI2500_PIX_FMT_SDR_MSI2500_384: 701 reg7 = 0x0000a507; /* 384 */ 702 break; 703 case MSI2500_PIX_FMT_SDR_S12: 704 reg7 = 0x00008507; /* 336 */ 705 break; 706 case V4L2_SDR_FMT_CS14LE: 707 reg7 = 0x00009407; /* 252 */ 708 break; 709 default: 710 reg7 = 0x000c9407; /* 504 */ 711 break; 712 } 713 714 /* 715 * Fractional-N synthesizer 716 * 717 * +----------------------------------------+ 718 * v | 719 * Fref +----+ +-------+ +-----+ +------+ +---+ 720 * ------> | PD | --> | VCO | --> | /2 | ------> | /N.F | <-- | K | 721 * +----+ +-------+ +-----+ +------+ +---+ 722 * | 723 * | 724 * v 725 * +-------+ +-----+ Fout 726 * | /Rout | --> | /12 | ------> 727 * +-------+ +-----+ 728 */ 729 /* 730 * Synthesizer config is just a educated guess... 731 * 732 * [7:0] 0x03, register address 733 * [8] 1, power control 734 * [9] ?, power control 735 * [12:10] output divider 736 * [13] 0 ? 737 * [14] 0 ? 738 * [15] fractional MSB, bit 20 739 * [16:19] N 740 * [23:20] ? 741 * [24:31] 0x01 742 * 743 * output divider 744 * val div 745 * 0 - (invalid) 746 * 1 4 747 * 2 6 748 * 3 8 749 * 4 10 750 * 5 12 751 * 6 14 752 * 7 16 753 * 754 * VCO 202000000 - 720000000++ 755 */ 756 757 #define F_REF 24000000 758 #define DIV_PRE_N 2 759 #define DIV_LO_OUT 12 760 reg3 = 0x01000303; 761 reg4 = 0x00000004; 762 763 /* XXX: Filters? AGC? VCO band? */ 764 if (f_sr < 6000000) 765 reg3 |= 0x1 << 20; 766 else if (f_sr < 7000000) 767 reg3 |= 0x5 << 20; 768 else if (f_sr < 8500000) 769 reg3 |= 0x9 << 20; 770 else 771 reg3 |= 0xd << 20; 772 773 for (div_out = 4; div_out < 16; div_out += 2) { 774 f_vco = f_sr * div_out * DIV_LO_OUT; 775 dev_dbg(dev->dev, "div_out=%u f_vco=%u\n", div_out, f_vco); 776 if (f_vco >= 202000000) 777 break; 778 } 779 780 /* Calculate PLL integer and fractional control word. */ 781 div_n = div_u64_rem(f_vco, DIV_PRE_N * F_REF, &k); 782 k_cw = div_u64((u64) k * 0x200000, DIV_PRE_N * F_REF); 783 784 reg3 |= div_n << 16; 785 reg3 |= (div_out / 2 - 1) << 10; 786 reg3 |= ((k_cw >> 20) & 0x000001) << 15; /* [20] */ 787 reg4 |= ((k_cw >> 0) & 0x0fffff) << 8; /* [19:0] */ 788 789 dev_dbg(dev->dev, 790 "f_sr=%u f_vco=%u div_n=%u k=%u div_out=%u reg3=%08x reg4=%08x\n", 791 f_sr, f_vco, div_n, k, div_out, reg3, reg4); 792 793 ret = msi2500_ctrl_msg(dev, CMD_WREG, 0x00608008); 794 if (ret) 795 goto err; 796 797 ret = msi2500_ctrl_msg(dev, CMD_WREG, 0x00000c05); 798 if (ret) 799 goto err; 800 801 ret = msi2500_ctrl_msg(dev, CMD_WREG, 0x00020000); 802 if (ret) 803 goto err; 804 805 ret = msi2500_ctrl_msg(dev, CMD_WREG, 0x00480102); 806 if (ret) 807 goto err; 808 809 ret = msi2500_ctrl_msg(dev, CMD_WREG, 0x00f38008); 810 if (ret) 811 goto err; 812 813 ret = msi2500_ctrl_msg(dev, CMD_WREG, reg7); 814 if (ret) 815 goto err; 816 817 ret = msi2500_ctrl_msg(dev, CMD_WREG, reg4); 818 if (ret) 819 goto err; 820 821 ret = msi2500_ctrl_msg(dev, CMD_WREG, reg3); 822err: 823 return ret; 824} 825 826static int msi2500_start_streaming(struct vb2_queue *vq, unsigned int count) 827{ 828 struct msi2500_dev *dev = vb2_get_drv_priv(vq); 829 int ret; 830 831 dev_dbg(dev->dev, "\n"); 832 833 if (!dev->udev) 834 return -ENODEV; 835 836 if (mutex_lock_interruptible(&dev->v4l2_lock)) 837 return -ERESTARTSYS; 838 839 /* wake-up tuner */ 840 v4l2_subdev_call(dev->v4l2_subdev, core, s_power, 1); 841 842 ret = msi2500_set_usb_adc(dev); 843 844 ret = msi2500_isoc_init(dev); 845 if (ret) 846 msi2500_cleanup_queued_bufs(dev); 847 848 ret = msi2500_ctrl_msg(dev, CMD_START_STREAMING, 0); 849 850 mutex_unlock(&dev->v4l2_lock); 851 852 return ret; 853} 854 855static void msi2500_stop_streaming(struct vb2_queue *vq) 856{ 857 struct msi2500_dev *dev = vb2_get_drv_priv(vq); 858 859 dev_dbg(dev->dev, "\n"); 860 861 mutex_lock(&dev->v4l2_lock); 862 863 if (dev->udev) 864 msi2500_isoc_cleanup(dev); 865 866 msi2500_cleanup_queued_bufs(dev); 867 868 /* according to tests, at least 700us delay is required */ 869 msleep(20); 870 if (dev->udev && !msi2500_ctrl_msg(dev, CMD_STOP_STREAMING, 0)) { 871 /* sleep USB IF / ADC */ 872 msi2500_ctrl_msg(dev, CMD_WREG, 0x01000003); 873 } 874 875 /* sleep tuner */ 876 v4l2_subdev_call(dev->v4l2_subdev, core, s_power, 0); 877 878 mutex_unlock(&dev->v4l2_lock); 879} 880 881static const struct vb2_ops msi2500_vb2_ops = { 882 .queue_setup = msi2500_queue_setup, 883 .buf_queue = msi2500_buf_queue, 884 .start_streaming = msi2500_start_streaming, 885 .stop_streaming = msi2500_stop_streaming, 886}; 887 888static int msi2500_enum_fmt_sdr_cap(struct file *file, void *priv, 889 struct v4l2_fmtdesc *f) 890{ 891 struct msi2500_dev *dev = video_drvdata(file); 892 893 dev_dbg(dev->dev, "index=%d\n", f->index); 894 895 if (f->index >= dev->num_formats) 896 return -EINVAL; 897 898 f->pixelformat = formats[f->index].pixelformat; 899 900 return 0; 901} 902 903static int msi2500_g_fmt_sdr_cap(struct file *file, void *priv, 904 struct v4l2_format *f) 905{ 906 struct msi2500_dev *dev = video_drvdata(file); 907 908 dev_dbg(dev->dev, "pixelformat fourcc %4.4s\n", 909 (char *)&dev->pixelformat); 910 911 f->fmt.sdr.pixelformat = dev->pixelformat; 912 f->fmt.sdr.buffersize = dev->buffersize; 913 914 return 0; 915} 916 917static int msi2500_s_fmt_sdr_cap(struct file *file, void *priv, 918 struct v4l2_format *f) 919{ 920 struct msi2500_dev *dev = video_drvdata(file); 921 struct vb2_queue *q = &dev->vb_queue; 922 int i; 923 924 dev_dbg(dev->dev, "pixelformat fourcc %4.4s\n", 925 (char *)&f->fmt.sdr.pixelformat); 926 927 if (vb2_is_busy(q)) 928 return -EBUSY; 929 930 for (i = 0; i < dev->num_formats; i++) { 931 if (formats[i].pixelformat == f->fmt.sdr.pixelformat) { 932 dev->pixelformat = formats[i].pixelformat; 933 dev->buffersize = formats[i].buffersize; 934 f->fmt.sdr.buffersize = formats[i].buffersize; 935 return 0; 936 } 937 } 938 939 dev->pixelformat = formats[0].pixelformat; 940 dev->buffersize = formats[0].buffersize; 941 f->fmt.sdr.pixelformat = formats[0].pixelformat; 942 f->fmt.sdr.buffersize = formats[0].buffersize; 943 944 return 0; 945} 946 947static int msi2500_try_fmt_sdr_cap(struct file *file, void *priv, 948 struct v4l2_format *f) 949{ 950 struct msi2500_dev *dev = video_drvdata(file); 951 int i; 952 953 dev_dbg(dev->dev, "pixelformat fourcc %4.4s\n", 954 (char *)&f->fmt.sdr.pixelformat); 955 956 for (i = 0; i < dev->num_formats; i++) { 957 if (formats[i].pixelformat == f->fmt.sdr.pixelformat) { 958 f->fmt.sdr.buffersize = formats[i].buffersize; 959 return 0; 960 } 961 } 962 963 f->fmt.sdr.pixelformat = formats[0].pixelformat; 964 f->fmt.sdr.buffersize = formats[0].buffersize; 965 966 return 0; 967} 968 969static int msi2500_s_tuner(struct file *file, void *priv, 970 const struct v4l2_tuner *v) 971{ 972 struct msi2500_dev *dev = video_drvdata(file); 973 int ret; 974 975 dev_dbg(dev->dev, "index=%d\n", v->index); 976 977 if (v->index == 0) 978 ret = 0; 979 else if (v->index == 1) 980 ret = v4l2_subdev_call(dev->v4l2_subdev, tuner, s_tuner, v); 981 else 982 ret = -EINVAL; 983 984 return ret; 985} 986 987static int msi2500_g_tuner(struct file *file, void *priv, struct v4l2_tuner *v) 988{ 989 struct msi2500_dev *dev = video_drvdata(file); 990 int ret; 991 992 dev_dbg(dev->dev, "index=%d\n", v->index); 993 994 if (v->index == 0) { 995 strscpy(v->name, "Mirics MSi2500", sizeof(v->name)); 996 v->type = V4L2_TUNER_ADC; 997 v->capability = V4L2_TUNER_CAP_1HZ | V4L2_TUNER_CAP_FREQ_BANDS; 998 v->rangelow = 1200000; 999 v->rangehigh = 15000000; 1000 ret = 0; 1001 } else if (v->index == 1) { 1002 ret = v4l2_subdev_call(dev->v4l2_subdev, tuner, g_tuner, v); 1003 } else { 1004 ret = -EINVAL; 1005 } 1006 1007 return ret; 1008} 1009 1010static int msi2500_g_frequency(struct file *file, void *priv, 1011 struct v4l2_frequency *f) 1012{ 1013 struct msi2500_dev *dev = video_drvdata(file); 1014 int ret = 0; 1015 1016 dev_dbg(dev->dev, "tuner=%d type=%d\n", f->tuner, f->type); 1017 1018 if (f->tuner == 0) { 1019 f->frequency = dev->f_adc; 1020 ret = 0; 1021 } else if (f->tuner == 1) { 1022 f->type = V4L2_TUNER_RF; 1023 ret = v4l2_subdev_call(dev->v4l2_subdev, tuner, g_frequency, f); 1024 } else { 1025 ret = -EINVAL; 1026 } 1027 1028 return ret; 1029} 1030 1031static int msi2500_s_frequency(struct file *file, void *priv, 1032 const struct v4l2_frequency *f) 1033{ 1034 struct msi2500_dev *dev = video_drvdata(file); 1035 int ret; 1036 1037 dev_dbg(dev->dev, "tuner=%d type=%d frequency=%u\n", 1038 f->tuner, f->type, f->frequency); 1039 1040 if (f->tuner == 0) { 1041 dev->f_adc = clamp_t(unsigned int, f->frequency, 1042 bands[0].rangelow, 1043 bands[0].rangehigh); 1044 dev_dbg(dev->dev, "ADC frequency=%u Hz\n", dev->f_adc); 1045 ret = msi2500_set_usb_adc(dev); 1046 } else if (f->tuner == 1) { 1047 ret = v4l2_subdev_call(dev->v4l2_subdev, tuner, s_frequency, f); 1048 } else { 1049 ret = -EINVAL; 1050 } 1051 1052 return ret; 1053} 1054 1055static int msi2500_enum_freq_bands(struct file *file, void *priv, 1056 struct v4l2_frequency_band *band) 1057{ 1058 struct msi2500_dev *dev = video_drvdata(file); 1059 int ret; 1060 1061 dev_dbg(dev->dev, "tuner=%d type=%d index=%d\n", 1062 band->tuner, band->type, band->index); 1063 1064 if (band->tuner == 0) { 1065 if (band->index >= ARRAY_SIZE(bands)) { 1066 ret = -EINVAL; 1067 } else { 1068 *band = bands[band->index]; 1069 ret = 0; 1070 } 1071 } else if (band->tuner == 1) { 1072 ret = v4l2_subdev_call(dev->v4l2_subdev, tuner, 1073 enum_freq_bands, band); 1074 } else { 1075 ret = -EINVAL; 1076 } 1077 1078 return ret; 1079} 1080 1081static const struct v4l2_ioctl_ops msi2500_ioctl_ops = { 1082 .vidioc_querycap = msi2500_querycap, 1083 1084 .vidioc_enum_fmt_sdr_cap = msi2500_enum_fmt_sdr_cap, 1085 .vidioc_g_fmt_sdr_cap = msi2500_g_fmt_sdr_cap, 1086 .vidioc_s_fmt_sdr_cap = msi2500_s_fmt_sdr_cap, 1087 .vidioc_try_fmt_sdr_cap = msi2500_try_fmt_sdr_cap, 1088 1089 .vidioc_reqbufs = vb2_ioctl_reqbufs, 1090 .vidioc_create_bufs = vb2_ioctl_create_bufs, 1091 .vidioc_prepare_buf = vb2_ioctl_prepare_buf, 1092 .vidioc_querybuf = vb2_ioctl_querybuf, 1093 .vidioc_qbuf = vb2_ioctl_qbuf, 1094 .vidioc_dqbuf = vb2_ioctl_dqbuf, 1095 1096 .vidioc_streamon = vb2_ioctl_streamon, 1097 .vidioc_streamoff = vb2_ioctl_streamoff, 1098 1099 .vidioc_g_tuner = msi2500_g_tuner, 1100 .vidioc_s_tuner = msi2500_s_tuner, 1101 1102 .vidioc_g_frequency = msi2500_g_frequency, 1103 .vidioc_s_frequency = msi2500_s_frequency, 1104 .vidioc_enum_freq_bands = msi2500_enum_freq_bands, 1105 1106 .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 1107 .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 1108 .vidioc_log_status = v4l2_ctrl_log_status, 1109}; 1110 1111static const struct v4l2_file_operations msi2500_fops = { 1112 .owner = THIS_MODULE, 1113 .open = v4l2_fh_open, 1114 .release = vb2_fop_release, 1115 .read = vb2_fop_read, 1116 .poll = vb2_fop_poll, 1117 .mmap = vb2_fop_mmap, 1118 .unlocked_ioctl = video_ioctl2, 1119}; 1120 1121static const struct video_device msi2500_template = { 1122 .name = "Mirics MSi3101 SDR Dongle", 1123 .release = video_device_release_empty, 1124 .fops = &msi2500_fops, 1125 .ioctl_ops = &msi2500_ioctl_ops, 1126}; 1127 1128static void msi2500_video_release(struct v4l2_device *v) 1129{ 1130 struct msi2500_dev *dev = container_of(v, struct msi2500_dev, v4l2_dev); 1131 1132 v4l2_ctrl_handler_free(&dev->hdl); 1133 v4l2_device_unregister(&dev->v4l2_dev); 1134 kfree(dev); 1135} 1136 1137static int msi2500_transfer_one_message(struct spi_controller *ctlr, 1138 struct spi_message *m) 1139{ 1140 struct msi2500_dev *dev = spi_controller_get_devdata(ctlr); 1141 struct spi_transfer *t; 1142 int ret = 0; 1143 u32 data; 1144 1145 list_for_each_entry(t, &m->transfers, transfer_list) { 1146 dev_dbg(dev->dev, "msg=%*ph\n", t->len, t->tx_buf); 1147 data = 0x09; /* reg 9 is SPI adapter */ 1148 data |= ((u8 *)t->tx_buf)[0] << 8; 1149 data |= ((u8 *)t->tx_buf)[1] << 16; 1150 data |= ((u8 *)t->tx_buf)[2] << 24; 1151 ret = msi2500_ctrl_msg(dev, CMD_WREG, data); 1152 } 1153 1154 m->status = ret; 1155 spi_finalize_current_message(ctlr); 1156 return ret; 1157} 1158 1159static int msi2500_probe(struct usb_interface *intf, 1160 const struct usb_device_id *id) 1161{ 1162 struct msi2500_dev *dev; 1163 struct v4l2_subdev *sd; 1164 struct spi_controller *ctlr; 1165 int ret; 1166 static struct spi_board_info board_info = { 1167 .modalias = "msi001", 1168 .bus_num = 0, 1169 .chip_select = 0, 1170 .max_speed_hz = 12000000, 1171 }; 1172 1173 dev = kzalloc(sizeof(*dev), GFP_KERNEL); 1174 if (!dev) { 1175 ret = -ENOMEM; 1176 goto err; 1177 } 1178 1179 mutex_init(&dev->v4l2_lock); 1180 mutex_init(&dev->vb_queue_lock); 1181 spin_lock_init(&dev->queued_bufs_lock); 1182 INIT_LIST_HEAD(&dev->queued_bufs); 1183 dev->dev = &intf->dev; 1184 dev->udev = interface_to_usbdev(intf); 1185 dev->f_adc = bands[0].rangelow; 1186 dev->pixelformat = formats[0].pixelformat; 1187 dev->buffersize = formats[0].buffersize; 1188 dev->num_formats = NUM_FORMATS; 1189 if (!msi2500_emulated_fmt) 1190 dev->num_formats -= 2; 1191 1192 /* Init videobuf2 queue structure */ 1193 dev->vb_queue.type = V4L2_BUF_TYPE_SDR_CAPTURE; 1194 dev->vb_queue.io_modes = VB2_MMAP | VB2_USERPTR | VB2_READ; 1195 dev->vb_queue.drv_priv = dev; 1196 dev->vb_queue.buf_struct_size = sizeof(struct msi2500_frame_buf); 1197 dev->vb_queue.ops = &msi2500_vb2_ops; 1198 dev->vb_queue.mem_ops = &vb2_vmalloc_memops; 1199 dev->vb_queue.timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1200 dev->vb_queue.lock = &dev->vb_queue_lock; 1201 ret = vb2_queue_init(&dev->vb_queue); 1202 if (ret) { 1203 dev_err(dev->dev, "Could not initialize vb2 queue\n"); 1204 goto err_free_mem; 1205 } 1206 1207 /* Init video_device structure */ 1208 dev->vdev = msi2500_template; 1209 dev->vdev.queue = &dev->vb_queue; 1210 video_set_drvdata(&dev->vdev, dev); 1211 1212 /* Register the v4l2_device structure */ 1213 dev->v4l2_dev.release = msi2500_video_release; 1214 ret = v4l2_device_register(&intf->dev, &dev->v4l2_dev); 1215 if (ret) { 1216 dev_err(dev->dev, "Failed to register v4l2-device (%d)\n", ret); 1217 goto err_free_mem; 1218 } 1219 1220 /* SPI host adapter */ 1221 ctlr = spi_alloc_host(dev->dev, 0); 1222 if (ctlr == NULL) { 1223 ret = -ENOMEM; 1224 goto err_unregister_v4l2_dev; 1225 } 1226 1227 dev->ctlr = ctlr; 1228 ctlr->bus_num = -1; 1229 ctlr->num_chipselect = 1; 1230 ctlr->transfer_one_message = msi2500_transfer_one_message; 1231 spi_controller_set_devdata(ctlr, dev); 1232 ret = spi_register_controller(ctlr); 1233 if (ret) { 1234 spi_controller_put(ctlr); 1235 goto err_unregister_v4l2_dev; 1236 } 1237 1238 /* load v4l2 subdevice */ 1239 sd = v4l2_spi_new_subdev(&dev->v4l2_dev, ctlr, &board_info); 1240 dev->v4l2_subdev = sd; 1241 if (sd == NULL) { 1242 dev_err(dev->dev, "cannot get v4l2 subdevice\n"); 1243 ret = -ENODEV; 1244 goto err_unregister_controller; 1245 } 1246 1247 /* Register controls */ 1248 v4l2_ctrl_handler_init(&dev->hdl, 0); 1249 if (dev->hdl.error) { 1250 ret = dev->hdl.error; 1251 dev_err(dev->dev, "Could not initialize controls\n"); 1252 goto err_free_controls; 1253 } 1254 1255 /* currently all controls are from subdev */ 1256 v4l2_ctrl_add_handler(&dev->hdl, sd->ctrl_handler, NULL, true); 1257 1258 dev->v4l2_dev.ctrl_handler = &dev->hdl; 1259 dev->vdev.v4l2_dev = &dev->v4l2_dev; 1260 dev->vdev.lock = &dev->v4l2_lock; 1261 dev->vdev.device_caps = V4L2_CAP_SDR_CAPTURE | V4L2_CAP_STREAMING | 1262 V4L2_CAP_READWRITE | V4L2_CAP_TUNER; 1263 1264 ret = video_register_device(&dev->vdev, VFL_TYPE_SDR, -1); 1265 if (ret) { 1266 dev_err(dev->dev, 1267 "Failed to register as video device (%d)\n", ret); 1268 goto err_unregister_v4l2_dev; 1269 } 1270 dev_info(dev->dev, "Registered as %s\n", 1271 video_device_node_name(&dev->vdev)); 1272 dev_notice(dev->dev, 1273 "SDR API is still slightly experimental and functionality changes may follow\n"); 1274 return 0; 1275err_free_controls: 1276 v4l2_ctrl_handler_free(&dev->hdl); 1277err_unregister_controller: 1278 spi_unregister_controller(dev->ctlr); 1279err_unregister_v4l2_dev: 1280 v4l2_device_unregister(&dev->v4l2_dev); 1281err_free_mem: 1282 kfree(dev); 1283err: 1284 return ret; 1285} 1286 1287/* USB device ID list */ 1288static const struct usb_device_id msi2500_id_table[] = { 1289 {USB_DEVICE(0x1df7, 0x2500)}, /* Mirics MSi3101 SDR Dongle */ 1290 {USB_DEVICE(0x2040, 0xd300)}, /* Hauppauge WinTV 133559 LF */ 1291 {} 1292}; 1293MODULE_DEVICE_TABLE(usb, msi2500_id_table); 1294 1295/* USB subsystem interface */ 1296static struct usb_driver msi2500_driver = { 1297 .name = KBUILD_MODNAME, 1298 .probe = msi2500_probe, 1299 .disconnect = msi2500_disconnect, 1300 .id_table = msi2500_id_table, 1301}; 1302 1303module_usb_driver(msi2500_driver); 1304 1305MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>"); 1306MODULE_DESCRIPTION("Mirics MSi3101 SDR Dongle"); 1307MODULE_LICENSE("GPL");
~/
Read-only file preview.