2 * Mirics MSi3101 SDR Dongle driver
4 * Copyright (C) 2013 Antti Palosaari <crope@iki.fi>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License along
17 * with this program; if not, write to the Free Software Foundation, Inc.,
18 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
20 * That driver is somehow based of pwc driver:
21 * (C) 1999-2004 Nemosoft Unv.
22 * (C) 2004-2006 Luc Saillard (luc@saillard.org)
23 * (C) 2011 Hans de Goede <hdegoede@redhat.com>
25 * Development tree of that driver will be on:
26 * http://git.linuxtv.org/anttip/media_tree.git/shortlog/refs/heads/mirics
28 * GNU Radio plugin "gr-kernel" for device usage will be on:
29 * http://git.linuxtv.org/anttip/gr-kernel.git
33 * - split RF tuner and USB ADC interface to own drivers (msi2500 and msi001)
34 * - move controls to V4L2 API
36 * Help is very highly welcome for these + all the others you could imagine:
37 * - use libv4l2 for stream format conversions
38 * - gr-kernel: switch to v4l2_mmap (current read eats a lot of cpu)
42 #include <linux/module.h>
43 #include <linux/slab.h>
44 #include <media/v4l2-device.h>
45 #include <media/v4l2-ioctl.h>
46 #include <media/v4l2-ctrls.h>
47 #include <media/v4l2-event.h>
48 #include <linux/usb.h>
49 #include <media/videobuf2-vmalloc.h>
58 /* 60 – 120 MHz band, lna 24dB, mixer 19dB */
59 static const struct msi3101_gain msi3101_gain_lut_120
[] = {
165 /* 120 – 245 MHz band, lna 24dB, mixer 19dB */
166 static const struct msi3101_gain msi3101_gain_lut_245
[] = {
272 /* 420 – 1000 MHz band, lna 7dB, mixer 19dB */
273 static const struct msi3101_gain msi3101_gain_lut_1000
[] = {
365 * bAlternateSetting 1
367 * bEndpointAddress 0x81 EP 1 IN
369 * Transfer Type Isochronous
370 * wMaxPacketSize 0x1400 3x 1024 bytes
373 #define MAX_ISO_BUFS (8)
374 #define ISO_FRAMES_PER_DESC (8)
375 #define ISO_MAX_FRAME_SIZE (3 * 1024)
376 #define ISO_BUFFER_SIZE (ISO_FRAMES_PER_DESC * ISO_MAX_FRAME_SIZE)
377 #define MAX_ISOC_ERRORS 20
379 /* TODO: These should be moved to V4L2 API */
380 #define MSI3101_CID_SAMPLING_MODE ((V4L2_CID_USER_BASE | 0xf000) + 0)
381 #define MSI3101_CID_SAMPLING_RATE ((V4L2_CID_USER_BASE | 0xf000) + 1)
382 #define MSI3101_CID_SAMPLING_RESOLUTION ((V4L2_CID_USER_BASE | 0xf000) + 2)
383 #define MSI3101_CID_TUNER_RF ((V4L2_CID_USER_BASE | 0xf000) + 10)
384 #define MSI3101_CID_TUNER_BW ((V4L2_CID_USER_BASE | 0xf000) + 11)
385 #define MSI3101_CID_TUNER_IF ((V4L2_CID_USER_BASE | 0xf000) + 12)
386 #define MSI3101_CID_TUNER_GAIN ((V4L2_CID_USER_BASE | 0xf000) + 13)
388 /* intermediate buffers with raw data from the USB device */
389 struct msi3101_frame_buf
{
390 struct vb2_buffer vb
; /* common v4l buffer stuff -- must be first */
391 struct list_head list
;
394 struct msi3101_state
{
395 struct video_device vdev
;
396 struct v4l2_device v4l2_dev
;
398 /* videobuf2 queue and queued buffers list */
399 struct vb2_queue vb_queue
;
400 struct list_head queued_bufs
;
401 spinlock_t queued_bufs_lock
; /* Protects queued_bufs */
403 /* Note if taking both locks v4l2_lock must always be locked first! */
404 struct mutex v4l2_lock
; /* Protects everything else */
405 struct mutex vb_queue_lock
; /* Protects vb_queue and capt_file */
407 /* Pointer to our usb_device, will be NULL after unplug */
408 struct usb_device
*udev
; /* Both mutexes most be hold when setting! */
410 unsigned int isoc_errors
; /* number of contiguous ISOC errors */
411 unsigned int vb_full
; /* vb is full and packets dropped */
413 struct urb
*urbs
[MAX_ISO_BUFS
];
414 int (*convert_stream
) (struct msi3101_state
*s
, u32
*dst
, u8
*src
,
415 unsigned int src_len
);
418 struct v4l2_ctrl_handler ctrl_handler
;
419 struct v4l2_ctrl
*ctrl_sampling_rate
;
420 struct v4l2_ctrl
*ctrl_tuner_rf
;
421 struct v4l2_ctrl
*ctrl_tuner_bw
;
422 struct v4l2_ctrl
*ctrl_tuner_if
;
423 struct v4l2_ctrl
*ctrl_tuner_gain
;
425 u32 next_sample
; /* for track lost packets */
426 u32 sample
; /* for sample rate calc */
427 unsigned long jiffies
;
428 unsigned int sample_ctrl_bit
[4];
431 /* Private functions */
432 static struct msi3101_frame_buf
*msi3101_get_next_fill_buf(
433 struct msi3101_state
*s
)
435 unsigned long flags
= 0;
436 struct msi3101_frame_buf
*buf
= NULL
;
438 spin_lock_irqsave(&s
->queued_bufs_lock
, flags
);
439 if (list_empty(&s
->queued_bufs
))
442 buf
= list_entry(s
->queued_bufs
.next
, struct msi3101_frame_buf
, list
);
443 list_del(&buf
->list
);
445 spin_unlock_irqrestore(&s
->queued_bufs_lock
, flags
);
450 * +===========================================================================
451 * | 00-1023 | USB packet
452 * +===========================================================================
453 * | 00- 03 | sequence number of first sample in that USB packet
454 * +---------------------------------------------------------------------------
456 * +---------------------------------------------------------------------------
457 * | 16- 175 | samples
458 * +---------------------------------------------------------------------------
459 * | 176- 179 | control bits for previous samples
460 * +---------------------------------------------------------------------------
461 * | 180- 339 | samples
462 * +---------------------------------------------------------------------------
463 * | 340- 343 | control bits for previous samples
464 * +---------------------------------------------------------------------------
465 * | 344- 503 | samples
466 * +---------------------------------------------------------------------------
467 * | 504- 507 | control bits for previous samples
468 * +---------------------------------------------------------------------------
469 * | 508- 667 | samples
470 * +---------------------------------------------------------------------------
471 * | 668- 671 | control bits for previous samples
472 * +---------------------------------------------------------------------------
473 * | 672- 831 | samples
474 * +---------------------------------------------------------------------------
475 * | 832- 835 | control bits for previous samples
476 * +---------------------------------------------------------------------------
477 * | 836- 995 | samples
478 * +---------------------------------------------------------------------------
479 * | 996- 999 | control bits for previous samples
480 * +---------------------------------------------------------------------------
481 * | 1000-1023 | garbage
482 * +---------------------------------------------------------------------------
484 * Bytes 4 - 7 could have some meaning?
486 * Control bits for previous samples is 32-bit field, containing 16 x 2-bit
487 * numbers. This results one 2-bit number for 8 samples. It is likely used for
488 * for bit shifting sample by given bits, increasing actual sampling resolution.
489 * Number 2 (0b10) was never seen.
491 * 6 * 16 * 2 * 4 = 768 samples. 768 * 4 = 3072 bytes
495 * Integer to 32-bit IEEE floating point representation routine is taken
496 * from Radeon R600 driver (drivers/gpu/drm/radeon/r600_blit_kms.c).
498 * TODO: Currently we do conversion here in Kernel, but in future that will
499 * be moved to the libv4l2 library as video format conversions are.
501 #define I2F_FRAC_BITS 23
502 #define I2F_MASK ((1 << I2F_FRAC_BITS) - 1)
505 * Converts signed ~10+3-bit integer into 32-bit IEEE floating point
508 static u32
msi3101_convert_sample_384(struct msi3101_state
*s
, u16 x
, int shift
)
510 u32 msb
, exponent
, fraction
, sign
;
511 s
->sample_ctrl_bit
[shift
]++;
513 /* Zero is special */
517 /* Convert 10-bit two's complement to 13-bit */
519 x
|= ~0U << 10; /* set all the rest bits to one */
522 x
&= 0xfff; /* result is 12 bit ... + sign */
529 /* Get location of the most significant bit */
532 fraction
= ror32(x
, (msb
- I2F_FRAC_BITS
) & 0x1f) & I2F_MASK
;
533 exponent
= (127 + msb
) << I2F_FRAC_BITS
;
535 return (fraction
+ exponent
) | sign
;
538 static int msi3101_convert_stream_384(struct msi3101_state
*s
, u32
*dst
,
539 u8
*src
, unsigned int src_len
)
541 int i
, j
, k
, l
, i_max
, dst_len
= 0;
546 /* There could be 1-3 1024 bytes URB frames */
547 i_max
= src_len
/ 1024;
548 for (i
= 0; i
< i_max
; i
++) {
549 sample_num
[i
] = src
[3] << 24 | src
[2] << 16 | src
[1] << 8 | src
[0] << 0;
550 if (i
== 0 && s
->next_sample
!= sample_num
[0]) {
551 dev_dbg_ratelimited(&s
->udev
->dev
,
552 "%d samples lost, %d %08x:%08x\n",
553 sample_num
[0] - s
->next_sample
,
554 src_len
, s
->next_sample
, sample_num
[0]);
558 * Dump all unknown 'garbage' data - maybe we will discover
559 * someday if there is something rational...
561 dev_dbg_ratelimited(&s
->udev
->dev
,
562 "%*ph %*ph\n", 12, &src
[4], 24, &src
[1000]);
565 for (j
= 0; j
< 6; j
++) {
566 bits
= src
[160 + 3] << 24 | src
[160 + 2] << 16 | src
[160 + 1] << 8 | src
[160 + 0] << 0;
567 for (k
= 0; k
< 16; k
++) {
568 for (l
= 0; l
< 10; l
+= 5) {
569 sample
[0] = (src
[l
+ 0] & 0xff) >> 0 | (src
[l
+ 1] & 0x03) << 8;
570 sample
[1] = (src
[l
+ 1] & 0xfc) >> 2 | (src
[l
+ 2] & 0x0f) << 6;
571 sample
[2] = (src
[l
+ 2] & 0xf0) >> 4 | (src
[l
+ 3] & 0x3f) << 4;
572 sample
[3] = (src
[l
+ 3] & 0xc0) >> 6 | (src
[l
+ 4] & 0xff) << 2;
574 *dst
++ = msi3101_convert_sample_384(s
, sample
[0], (bits
>> (2 * k
)) & 0x3);
575 *dst
++ = msi3101_convert_sample_384(s
, sample
[1], (bits
>> (2 * k
)) & 0x3);
576 *dst
++ = msi3101_convert_sample_384(s
, sample
[2], (bits
>> (2 * k
)) & 0x3);
577 *dst
++ = msi3101_convert_sample_384(s
, sample
[3], (bits
>> (2 * k
)) & 0x3);
581 dev_dbg_ratelimited(&s
->udev
->dev
,
582 "sample control bits %08x\n", bits
);
585 /* 384 x I+Q 32bit float samples */
586 dst_len
+= 384 * 2 * 4;
590 /* calculate samping rate and output it in 10 seconds intervals */
591 if ((s
->jiffies
+ msecs_to_jiffies(10000)) <= jiffies
) {
592 unsigned long jiffies_now
= jiffies
;
593 unsigned long msecs
= jiffies_to_msecs(jiffies_now
) - jiffies_to_msecs(s
->jiffies
);
594 unsigned int samples
= sample_num
[i_max
- 1] - s
->sample
;
595 s
->jiffies
= jiffies_now
;
596 s
->sample
= sample_num
[i_max
- 1];
597 dev_dbg(&s
->udev
->dev
,
598 "slen=%d samples=%u msecs=%lu sampling rate=%lu bits=%d.%d.%d.%d\n",
599 src_len
, samples
, msecs
,
600 samples
* 1000UL / msecs
,
601 s
->sample_ctrl_bit
[0], s
->sample_ctrl_bit
[1],
602 s
->sample_ctrl_bit
[2], s
->sample_ctrl_bit
[3]);
605 /* next sample (sample = sample + i * 384) */
606 s
->next_sample
= sample_num
[i_max
- 1] + 384;
612 * Converts signed 12-bit integer into 32-bit IEEE floating point
615 static u32
msi3101_convert_sample_336(struct msi3101_state
*s
, u16 x
)
617 u32 msb
, exponent
, fraction
, sign
;
619 /* Zero is special */
623 /* Negative / positive value */
626 x
&= 0x7ff; /* result is 11 bit ... + sign */
632 /* Get location of the most significant bit */
635 fraction
= ror32(x
, (msb
- I2F_FRAC_BITS
) & 0x1f) & I2F_MASK
;
636 exponent
= (127 + msb
) << I2F_FRAC_BITS
;
638 return (fraction
+ exponent
) | sign
;
641 static int msi3101_convert_stream_336(struct msi3101_state
*s
, u32
*dst
,
642 u8
*src
, unsigned int src_len
)
644 int i
, j
, i_max
, dst_len
= 0;
648 /* There could be 1-3 1024 bytes URB frames */
649 i_max
= src_len
/ 1024;
651 for (i
= 0; i
< i_max
; i
++) {
652 sample_num
[i
] = src
[3] << 24 | src
[2] << 16 | src
[1] << 8 | src
[0] << 0;
653 if (i
== 0 && s
->next_sample
!= sample_num
[0]) {
654 dev_dbg_ratelimited(&s
->udev
->dev
,
655 "%d samples lost, %d %08x:%08x\n",
656 sample_num
[0] - s
->next_sample
,
657 src_len
, s
->next_sample
, sample_num
[0]);
661 * Dump all unknown 'garbage' data - maybe we will discover
662 * someday if there is something rational...
664 dev_dbg_ratelimited(&s
->udev
->dev
, "%*ph\n", 12, &src
[4]);
667 for (j
= 0; j
< 1008; j
+= 3) {
668 sample
[0] = (src
[j
+ 0] & 0xff) >> 0 | (src
[j
+ 1] & 0x0f) << 8;
669 sample
[1] = (src
[j
+ 1] & 0xf0) >> 4 | (src
[j
+ 2] & 0xff) << 4;
671 *dst
++ = msi3101_convert_sample_336(s
, sample
[0]);
672 *dst
++ = msi3101_convert_sample_336(s
, sample
[1]);
674 /* 336 x I+Q 32bit float samples */
675 dst_len
+= 336 * 2 * 4;
679 /* calculate samping rate and output it in 10 seconds intervals */
680 if ((s
->jiffies
+ msecs_to_jiffies(10000)) <= jiffies
) {
681 unsigned long jiffies_now
= jiffies
;
682 unsigned long msecs
= jiffies_to_msecs(jiffies_now
) - jiffies_to_msecs(s
->jiffies
);
683 unsigned int samples
= sample_num
[i_max
- 1] - s
->sample
;
684 s
->jiffies
= jiffies_now
;
685 s
->sample
= sample_num
[i_max
- 1];
686 dev_dbg(&s
->udev
->dev
,
687 "slen=%d samples=%u msecs=%lu sampling rate=%lu\n",
688 src_len
, samples
, msecs
,
689 samples
* 1000UL / msecs
);
692 /* next sample (sample = sample + i * 336) */
693 s
->next_sample
= sample_num
[i_max
- 1] + 336;
699 * Converts signed 14-bit integer into 32-bit IEEE floating point
702 static u32
msi3101_convert_sample_252(struct msi3101_state
*s
, u16 x
)
704 u32 msb
, exponent
, fraction
, sign
;
706 /* Zero is special */
710 /* Negative / positive value */
713 x
&= 0x1fff; /* result is 13 bit ... + sign */
719 /* Get location of the most significant bit */
722 fraction
= ror32(x
, (msb
- I2F_FRAC_BITS
) & 0x1f) & I2F_MASK
;
723 exponent
= (127 + msb
) << I2F_FRAC_BITS
;
725 return (fraction
+ exponent
) | sign
;
728 static int msi3101_convert_stream_252(struct msi3101_state
*s
, u32
*dst
,
729 u8
*src
, unsigned int src_len
)
731 int i
, j
, i_max
, dst_len
= 0;
735 /* There could be 1-3 1024 bytes URB frames */
736 i_max
= src_len
/ 1024;
738 for (i
= 0; i
< i_max
; i
++) {
739 sample_num
[i
] = src
[3] << 24 | src
[2] << 16 | src
[1] << 8 | src
[0] << 0;
740 if (i
== 0 && s
->next_sample
!= sample_num
[0]) {
741 dev_dbg_ratelimited(&s
->udev
->dev
,
742 "%d samples lost, %d %08x:%08x\n",
743 sample_num
[0] - s
->next_sample
,
744 src_len
, s
->next_sample
, sample_num
[0]);
748 * Dump all unknown 'garbage' data - maybe we will discover
749 * someday if there is something rational...
751 dev_dbg_ratelimited(&s
->udev
->dev
, "%*ph\n", 12, &src
[4]);
754 for (j
= 0; j
< 1008; j
+= 4) {
755 sample
[0] = src
[j
+ 0] >> 0 | src
[j
+ 1] << 8;
756 sample
[1] = src
[j
+ 2] >> 0 | src
[j
+ 3] << 8;
758 *dst
++ = msi3101_convert_sample_252(s
, sample
[0]);
759 *dst
++ = msi3101_convert_sample_252(s
, sample
[1]);
761 /* 252 x I+Q 32bit float samples */
762 dst_len
+= 252 * 2 * 4;
766 /* calculate samping rate and output it in 10 seconds intervals */
767 if ((s
->jiffies
+ msecs_to_jiffies(10000)) <= jiffies
) {
768 unsigned long jiffies_now
= jiffies
;
769 unsigned long msecs
= jiffies_to_msecs(jiffies_now
) - jiffies_to_msecs(s
->jiffies
);
770 unsigned int samples
= sample_num
[i_max
- 1] - s
->sample
;
771 s
->jiffies
= jiffies_now
;
772 s
->sample
= sample_num
[i_max
- 1];
773 dev_dbg(&s
->udev
->dev
,
774 "slen=%d samples=%u msecs=%lu sampling rate=%lu\n",
775 src_len
, samples
, msecs
,
776 samples
* 1000UL / msecs
);
779 /* next sample (sample = sample + i * 252) */
780 s
->next_sample
= sample_num
[i_max
- 1] + 252;
786 * This gets called for the Isochronous pipe (stream). This is done in interrupt
787 * time, so it has to be fast, not crash, and not stall. Neat.
789 static void msi3101_isoc_handler(struct urb
*urb
)
791 struct msi3101_state
*s
= (struct msi3101_state
*)urb
->context
;
792 int i
, flen
, fstatus
;
793 unsigned char *iso_buf
= NULL
;
794 struct msi3101_frame_buf
*fbuf
;
796 if (urb
->status
== -ENOENT
|| urb
->status
== -ECONNRESET
||
797 urb
->status
== -ESHUTDOWN
) {
798 dev_dbg(&s
->udev
->dev
, "URB (%p) unlinked %ssynchronuously\n",
799 urb
, urb
->status
== -ENOENT
? "" : "a");
803 if (urb
->status
!= 0) {
804 dev_dbg(&s
->udev
->dev
,
805 "msi3101_isoc_handler() called with status %d\n",
807 /* Give up after a number of contiguous errors */
808 if (++s
->isoc_errors
> MAX_ISOC_ERRORS
)
809 dev_dbg(&s
->udev
->dev
,
810 "Too many ISOC errors, bailing out\n");
813 /* Reset ISOC error counter. We did get here, after all. */
818 for (i
= 0; i
< urb
->number_of_packets
; i
++) {
821 /* Check frame error */
822 fstatus
= urb
->iso_frame_desc
[i
].status
;
824 dev_dbg_ratelimited(&s
->udev
->dev
,
825 "frame=%d/%d has error %d skipping\n",
826 i
, urb
->number_of_packets
, fstatus
);
830 /* Check if that frame contains data */
831 flen
= urb
->iso_frame_desc
[i
].actual_length
;
835 iso_buf
= urb
->transfer_buffer
+ urb
->iso_frame_desc
[i
].offset
;
837 /* Get free framebuffer */
838 fbuf
= msi3101_get_next_fill_buf(s
);
841 dev_dbg_ratelimited(&s
->udev
->dev
,
842 "videobuf is full, %d packets dropped\n",
847 /* fill framebuffer */
848 ptr
= vb2_plane_vaddr(&fbuf
->vb
, 0);
849 flen
= s
->convert_stream(s
, ptr
, iso_buf
, flen
);
850 vb2_set_plane_payload(&fbuf
->vb
, 0, flen
);
851 vb2_buffer_done(&fbuf
->vb
, VB2_BUF_STATE_DONE
);
857 i
= usb_submit_urb(urb
, GFP_ATOMIC
);
859 dev_dbg(&s
->udev
->dev
,
860 "Error (%d) re-submitting urb in msi3101_isoc_handler\n",
864 static void msi3101_iso_stop(struct msi3101_state
*s
)
867 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
869 /* Unlinking ISOC buffers one by one */
870 for (i
= 0; i
< MAX_ISO_BUFS
; i
++) {
872 dev_dbg(&s
->udev
->dev
, "Unlinking URB %p\n",
874 usb_kill_urb(s
->urbs
[i
]);
879 static void msi3101_iso_free(struct msi3101_state
*s
)
882 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
884 /* Freeing ISOC buffers one by one */
885 for (i
= 0; i
< MAX_ISO_BUFS
; i
++) {
887 dev_dbg(&s
->udev
->dev
, "Freeing URB\n");
888 if (s
->urbs
[i
]->transfer_buffer
) {
889 usb_free_coherent(s
->udev
,
890 s
->urbs
[i
]->transfer_buffer_length
,
891 s
->urbs
[i
]->transfer_buffer
,
892 s
->urbs
[i
]->transfer_dma
);
894 usb_free_urb(s
->urbs
[i
]);
900 /* Both v4l2_lock and vb_queue_lock should be locked when calling this */
901 static void msi3101_isoc_cleanup(struct msi3101_state
*s
)
903 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
909 /* Both v4l2_lock and vb_queue_lock should be locked when calling this */
910 static int msi3101_isoc_init(struct msi3101_state
*s
)
912 struct usb_device
*udev
;
915 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
920 ret
= usb_set_interface(s
->udev
, 0, 1);
924 /* Allocate and init Isochronuous urbs */
925 for (i
= 0; i
< MAX_ISO_BUFS
; i
++) {
926 urb
= usb_alloc_urb(ISO_FRAMES_PER_DESC
, GFP_KERNEL
);
928 dev_err(&s
->udev
->dev
,
929 "Failed to allocate urb %d\n", i
);
930 msi3101_isoc_cleanup(s
);
934 dev_dbg(&s
->udev
->dev
, "Allocated URB at 0x%p\n", urb
);
938 urb
->pipe
= usb_rcvisocpipe(udev
, 0x81);
939 urb
->transfer_flags
= URB_ISO_ASAP
| URB_NO_TRANSFER_DMA_MAP
;
940 urb
->transfer_buffer
= usb_alloc_coherent(udev
, ISO_BUFFER_SIZE
,
941 GFP_KERNEL
, &urb
->transfer_dma
);
942 if (urb
->transfer_buffer
== NULL
) {
943 dev_err(&s
->udev
->dev
,
944 "Failed to allocate urb buffer %d\n",
946 msi3101_isoc_cleanup(s
);
949 urb
->transfer_buffer_length
= ISO_BUFFER_SIZE
;
950 urb
->complete
= msi3101_isoc_handler
;
952 urb
->start_frame
= 0;
953 urb
->number_of_packets
= ISO_FRAMES_PER_DESC
;
954 for (j
= 0; j
< ISO_FRAMES_PER_DESC
; j
++) {
955 urb
->iso_frame_desc
[j
].offset
= j
* ISO_MAX_FRAME_SIZE
;
956 urb
->iso_frame_desc
[j
].length
= ISO_MAX_FRAME_SIZE
;
961 for (i
= 0; i
< MAX_ISO_BUFS
; i
++) {
962 ret
= usb_submit_urb(s
->urbs
[i
], GFP_KERNEL
);
964 dev_err(&s
->udev
->dev
,
965 "isoc_init() submit_urb %d failed with error %d\n",
967 msi3101_isoc_cleanup(s
);
970 dev_dbg(&s
->udev
->dev
, "URB 0x%p submitted.\n", s
->urbs
[i
]);
977 /* Must be called with vb_queue_lock hold */
978 static void msi3101_cleanup_queued_bufs(struct msi3101_state
*s
)
980 unsigned long flags
= 0;
981 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
983 spin_lock_irqsave(&s
->queued_bufs_lock
, flags
);
984 while (!list_empty(&s
->queued_bufs
)) {
985 struct msi3101_frame_buf
*buf
;
987 buf
= list_entry(s
->queued_bufs
.next
, struct msi3101_frame_buf
,
989 list_del(&buf
->list
);
990 vb2_buffer_done(&buf
->vb
, VB2_BUF_STATE_ERROR
);
992 spin_unlock_irqrestore(&s
->queued_bufs_lock
, flags
);
995 /* The user yanked out the cable... */
996 static void msi3101_disconnect(struct usb_interface
*intf
)
998 struct v4l2_device
*v
= usb_get_intfdata(intf
);
999 struct msi3101_state
*s
=
1000 container_of(v
, struct msi3101_state
, v4l2_dev
);
1001 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
1003 mutex_lock(&s
->vb_queue_lock
);
1004 mutex_lock(&s
->v4l2_lock
);
1005 /* No need to keep the urbs around after disconnection */
1008 v4l2_device_disconnect(&s
->v4l2_dev
);
1009 video_unregister_device(&s
->vdev
);
1010 mutex_unlock(&s
->v4l2_lock
);
1011 mutex_unlock(&s
->vb_queue_lock
);
1013 v4l2_device_put(&s
->v4l2_dev
);
1016 static int msi3101_querycap(struct file
*file
, void *fh
,
1017 struct v4l2_capability
*cap
)
1019 struct msi3101_state
*s
= video_drvdata(file
);
1020 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
1022 strlcpy(cap
->driver
, KBUILD_MODNAME
, sizeof(cap
->driver
));
1023 strlcpy(cap
->card
, s
->vdev
.name
, sizeof(cap
->card
));
1024 usb_make_path(s
->udev
, cap
->bus_info
, sizeof(cap
->bus_info
));
1025 cap
->device_caps
= V4L2_CAP_VIDEO_CAPTURE
| V4L2_CAP_STREAMING
|
1027 cap
->device_caps
= V4L2_CAP_TUNER
;
1028 cap
->capabilities
= cap
->device_caps
| V4L2_CAP_DEVICE_CAPS
;
1033 /* Videobuf2 operations */
1034 static int msi3101_queue_setup(struct vb2_queue
*vq
,
1035 const struct v4l2_format
*fmt
, unsigned int *nbuffers
,
1036 unsigned int *nplanes
, unsigned int sizes
[], void *alloc_ctxs
[])
1038 struct msi3101_state
*s
= vb2_get_drv_priv(vq
);
1039 dev_dbg(&s
->udev
->dev
, "%s: *nbuffers=%d\n", __func__
, *nbuffers
);
1041 /* Absolute min and max number of buffers available for mmap() */
1044 sizes
[0] = PAGE_ALIGN(3 * 3072); /* 3 * 768 * 4 */
1045 dev_dbg(&s
->udev
->dev
, "%s: nbuffers=%d sizes[0]=%d\n",
1046 __func__
, *nbuffers
, sizes
[0]);
1050 static int msi3101_buf_prepare(struct vb2_buffer
*vb
)
1052 struct msi3101_state
*s
= vb2_get_drv_priv(vb
->vb2_queue
);
1054 /* Don't allow queing new buffers after device disconnection */
1061 static void msi3101_buf_queue(struct vb2_buffer
*vb
)
1063 struct msi3101_state
*s
= vb2_get_drv_priv(vb
->vb2_queue
);
1064 struct msi3101_frame_buf
*buf
=
1065 container_of(vb
, struct msi3101_frame_buf
, vb
);
1066 unsigned long flags
= 0;
1068 /* Check the device has not disconnected between prep and queuing */
1070 vb2_buffer_done(&buf
->vb
, VB2_BUF_STATE_ERROR
);
1074 spin_lock_irqsave(&s
->queued_bufs_lock
, flags
);
1075 list_add_tail(&buf
->list
, &s
->queued_bufs
);
1076 spin_unlock_irqrestore(&s
->queued_bufs_lock
, flags
);
1079 #define CMD_WREG 0x41
1080 #define CMD_START_STREAMING 0x43
1081 #define CMD_STOP_STREAMING 0x45
1082 #define CMD_READ_UNKNOW 0x48
1084 #define msi3101_dbg_usb_control_msg(udev, r, t, v, _i, b, l) { \
1086 if (t == (USB_TYPE_VENDOR | USB_DIR_OUT)) \
1087 direction = ">>>"; \
1089 direction = "<<<"; \
1090 dev_dbg(&udev->dev, "%s: %02x %02x %02x %02x %02x %02x %02x %02x " \
1091 "%s %*ph\n", __func__, t, r, v & 0xff, v >> 8, \
1092 _i & 0xff, _i >> 8, l & 0xff, l >> 8, direction, l, b); \
1095 static int msi3101_ctrl_msg(struct msi3101_state
*s
, u8 cmd
, u32 data
)
1099 u8 requesttype
= USB_DIR_OUT
| USB_TYPE_VENDOR
;
1100 u16 value
= (data
>> 0) & 0xffff;
1101 u16 index
= (data
>> 16) & 0xffff;
1103 msi3101_dbg_usb_control_msg(s
->udev
,
1104 request
, requesttype
, value
, index
, NULL
, 0);
1106 ret
= usb_control_msg(s
->udev
, usb_sndctrlpipe(s
->udev
, 0),
1107 request
, requesttype
, value
, index
, NULL
, 0, 2000);
1110 dev_err(&s
->udev
->dev
, "%s: failed %d, cmd %02x, data %04x\n",
1111 __func__
, ret
, cmd
, data
);
1116 static int msi3101_tuner_write(struct msi3101_state
*s
, u32 data
)
1118 return msi3101_ctrl_msg(s
, CMD_WREG
, data
<< 8 | 0x09);
1121 #define F_REF 24000000
1123 static int msi3101_set_usb_adc(struct msi3101_state
*s
)
1125 int ret
, div_n
, div_m
, div_r_out
, f_sr
, f_vco
, fract
;
1126 u32 reg3
, reg4
, reg7
;
1128 f_sr
= s
->ctrl_sampling_rate
->val64
;
1130 /* select stream format */
1131 if (f_sr
< 6000000) {
1132 s
->convert_stream
= msi3101_convert_stream_252
;
1134 } else if (f_sr
< 8000000) {
1135 s
->convert_stream
= msi3101_convert_stream_336
;
1138 s
->convert_stream
= msi3101_convert_stream_384
;
1143 * Synthesizer config is just a educated guess...
1145 * [7:0] 0x03, register address
1148 * [12:10] output divider
1151 * [15] fractional MSB, bit 20
1167 * VCO 202000000 - 720000000++
1172 /* XXX: Filters? AGC? */
1175 else if (f_sr
< 7000000)
1177 else if (f_sr
< 8500000)
1182 for (div_r_out
= 4; div_r_out
< 16; div_r_out
+= 2) {
1183 f_vco
= f_sr
* div_r_out
* 12;
1184 dev_dbg(&s
->udev
->dev
, "%s: div_r_out=%d f_vco=%d\n",
1185 __func__
, div_r_out
, f_vco
);
1186 if (f_vco
>= 202000000)
1190 div_n
= f_vco
/ (F_REF
* DIV_R_IN
);
1191 div_m
= f_vco
% (F_REF
* DIV_R_IN
);
1192 fract
= 0x200000ul
* div_m
/ (F_REF
* DIV_R_IN
);
1194 reg3
|= div_n
<< 16;
1195 reg3
|= (div_r_out
/ 2 - 1) << 10;
1196 reg3
|= ((fract
>> 20) & 0x000001) << 15; /* [20] */
1197 reg4
|= ((fract
>> 0) & 0x0fffff) << 8; /* [19:0] */
1199 dev_dbg(&s
->udev
->dev
,
1200 "%s: f_sr=%d f_vco=%d div_n=%d div_m=%d div_r_out=%d reg3=%08x reg4=%08x\n",
1201 __func__
, f_sr
, f_vco
, div_n
, div_m
, div_r_out
, reg3
, reg4
);
1203 ret
= msi3101_ctrl_msg(s
, CMD_WREG
, 0x00608008);
1207 ret
= msi3101_ctrl_msg(s
, CMD_WREG
, 0x00000c05);
1211 ret
= msi3101_ctrl_msg(s
, CMD_WREG
, 0x00020000);
1215 ret
= msi3101_ctrl_msg(s
, CMD_WREG
, 0x00480102);
1219 ret
= msi3101_ctrl_msg(s
, CMD_WREG
, 0x00f38008);
1223 ret
= msi3101_ctrl_msg(s
, CMD_WREG
, reg7
);
1227 ret
= msi3101_ctrl_msg(s
, CMD_WREG
, reg4
);
1231 ret
= msi3101_ctrl_msg(s
, CMD_WREG
, reg3
);
1238 static int msi3101_set_tuner(struct msi3101_state
*s
)
1241 unsigned int n
, m
, thresh
, frac
, vco_step
, tmp
;
1245 const struct msi3101_gain
*gain_lut
;
1246 static const struct {
1251 { 47000000, 0x01, 16}, /* AM_MODE1 */
1252 {108000000, 0x02, 32}, /* VHF_MODE */
1253 {330000000, 0x04, 16}, /* B3_MODE */
1254 {960000000, 0x08, 4}, /* B45_MODE */
1255 { ~0U, 0x10, 2}, /* BL_MODE */
1257 static const struct {
1261 { 0, 0x03}, /* Zero IF */
1262 { 450000, 0x02}, /* 450 kHz IF */
1263 {1620000, 0x01}, /* 1.62 MHz IF */
1264 {2048000, 0x00}, /* 2.048 MHz IF */
1266 static const struct {
1269 } bandwidth_lut
[] = {
1270 { 200000, 0x00}, /* 200 kHz */
1271 { 300000, 0x01}, /* 300 kHz */
1272 { 600000, 0x02}, /* 600 kHz */
1273 {1536000, 0x03}, /* 1.536 MHz */
1274 {5000000, 0x04}, /* 5 MHz */
1275 {6000000, 0x05}, /* 6 MHz */
1276 {7000000, 0x06}, /* 7 MHz */
1277 {8000000, 0x07}, /* 8 MHz */
1280 unsigned int rf_freq
= s
->ctrl_tuner_rf
->val64
;
1284 * 200000, 300000, 600000, 1536000, 5000000, 6000000, 7000000, 8000000
1286 int bandwidth
= s
->ctrl_tuner_bw
->val
;
1289 * intermediate frequency (Hz)
1290 * 0, 450000, 1620000, 2048000
1292 int if_freq
= s
->ctrl_tuner_if
->val
;
1295 * gain reduction (dB)
1296 * 0 - 102 below 420 MHz
1297 * 0 - 85 above 420 MHz
1299 int gain
= s
->ctrl_tuner_gain
->val
;
1301 dev_dbg(&s
->udev
->dev
,
1302 "%s: rf_freq=%d bandwidth=%d if_freq=%d gain=%d\n",
1303 __func__
, rf_freq
, bandwidth
, if_freq
, gain
);
1307 for (i
= 0; i
< ARRAY_SIZE(band_lut
); i
++) {
1308 if (rf_freq
<= band_lut
[i
].rf
) {
1309 mode
= band_lut
[i
].mode
;
1310 lo_div
= band_lut
[i
].lo_div
;
1315 if (i
== ARRAY_SIZE(band_lut
))
1318 for (i
= 0; i
< ARRAY_SIZE(if_freq_lut
); i
++) {
1319 if (if_freq
== if_freq_lut
[i
].freq
) {
1320 if_freq
= if_freq_lut
[i
].val
;
1325 if (i
== ARRAY_SIZE(if_freq_lut
))
1328 for (i
= 0; i
< ARRAY_SIZE(bandwidth_lut
); i
++) {
1329 if (bandwidth
== bandwidth_lut
[i
].freq
) {
1330 bandwidth
= bandwidth_lut
[i
].val
;
1335 if (i
== ARRAY_SIZE(bandwidth_lut
))
1338 #define F_OUT_STEP 1
1341 f_vco
= (rf_freq
+ F_IF
) * lo_div
;
1342 n
= f_vco
/ (F_REF
* R_REF
);
1343 m
= f_vco
% (F_REF
* R_REF
);
1345 vco_step
= F_OUT_STEP
* lo_div
;
1346 thresh
= (F_REF
* R_REF
) / vco_step
;
1347 frac
= 1ul * thresh
* m
/ (F_REF
* R_REF
);
1349 /* Divide to reg max. After that RF resolution will be +-500Hz. */
1350 tmp
= DIV_ROUND_UP(thresh
, 4095);
1351 thresh
= DIV_ROUND_CLOSEST(thresh
, tmp
);
1352 frac
= DIV_ROUND_CLOSEST(frac
, tmp
);
1354 /* calc real RF set */
1355 tmp
= 1ul * F_REF
* R_REF
* n
;
1356 tmp
+= 1ul * F_REF
* R_REF
* frac
/ thresh
;
1359 dev_dbg(&s
->udev
->dev
,
1360 "%s: rf=%u:%u n=%d thresh=%d frac=%d\n",
1361 __func__
, rf_freq
, tmp
, n
, thresh
, frac
);
1363 ret
= msi3101_tuner_write(s
, 0x00000e);
1364 ret
= msi3101_tuner_write(s
, 0x000003);
1369 reg
|= if_freq
<< 12;
1370 reg
|= bandwidth
<< 14;
1373 ret
= msi3101_tuner_write(s
, reg
);
1381 ret
= msi3101_tuner_write(s
, reg
);
1388 ret
= msi3101_tuner_write(s
, reg
);
1392 if (rf_freq
< 120000000) {
1393 gain_lut
= msi3101_gain_lut_120
;
1394 len
= ARRAY_SIZE(msi3101_gain_lut_120
);
1395 } else if (rf_freq
< 245000000) {
1396 gain_lut
= msi3101_gain_lut_245
;
1397 len
= ARRAY_SIZE(msi3101_gain_lut_120
);
1399 gain_lut
= msi3101_gain_lut_1000
;
1400 len
= ARRAY_SIZE(msi3101_gain_lut_1000
);
1403 for (i
= 0; i
< len
; i
++) {
1404 if (gain_lut
[i
].tot
>= gain
)
1411 dev_dbg(&s
->udev
->dev
,
1412 "%s: gain tot=%d baseband=%d lna=%d mixer=%d\n",
1413 __func__
, gain_lut
[i
].tot
, gain_lut
[i
].baseband
,
1414 gain_lut
[i
].lna
, gain_lut
[i
].mixer
);
1417 reg
|= gain_lut
[i
].baseband
<< 4;
1419 reg
|= gain_lut
[i
].mixer
<< 12;
1420 reg
|= gain_lut
[i
].lna
<< 13;
1423 ret
= msi3101_tuner_write(s
, reg
);
1430 ret
= msi3101_tuner_write(s
, reg
);
1436 dev_dbg(&s
->udev
->dev
, "%s: failed %d\n", __func__
, ret
);
1440 static int msi3101_start_streaming(struct vb2_queue
*vq
, unsigned int count
)
1442 struct msi3101_state
*s
= vb2_get_drv_priv(vq
);
1444 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
1449 if (mutex_lock_interruptible(&s
->v4l2_lock
))
1450 return -ERESTARTSYS
;
1452 ret
= msi3101_set_usb_adc(s
);
1454 ret
= msi3101_isoc_init(s
);
1456 msi3101_cleanup_queued_bufs(s
);
1458 ret
= msi3101_ctrl_msg(s
, CMD_START_STREAMING
, 0);
1460 mutex_unlock(&s
->v4l2_lock
);
1465 static int msi3101_stop_streaming(struct vb2_queue
*vq
)
1467 struct msi3101_state
*s
= vb2_get_drv_priv(vq
);
1468 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
1470 if (mutex_lock_interruptible(&s
->v4l2_lock
))
1471 return -ERESTARTSYS
;
1474 msi3101_isoc_cleanup(s
);
1476 msi3101_cleanup_queued_bufs(s
);
1478 /* according to tests, at least 700us delay is required */
1480 msi3101_ctrl_msg(s
, CMD_STOP_STREAMING
, 0);
1482 mutex_unlock(&s
->v4l2_lock
);
1487 static struct vb2_ops msi3101_vb2_ops
= {
1488 .queue_setup
= msi3101_queue_setup
,
1489 .buf_prepare
= msi3101_buf_prepare
,
1490 .buf_queue
= msi3101_buf_queue
,
1491 .start_streaming
= msi3101_start_streaming
,
1492 .stop_streaming
= msi3101_stop_streaming
,
1493 .wait_prepare
= vb2_ops_wait_prepare
,
1494 .wait_finish
= vb2_ops_wait_finish
,
1497 static int msi3101_enum_input(struct file
*file
, void *fh
, struct v4l2_input
*i
)
1502 strlcpy(i
->name
, "SDR data", sizeof(i
->name
));
1503 i
->type
= V4L2_INPUT_TYPE_CAMERA
;
1508 static int msi3101_g_input(struct file
*file
, void *fh
, unsigned int *i
)
1515 static int msi3101_s_input(struct file
*file
, void *fh
, unsigned int i
)
1517 return i
? -EINVAL
: 0;
1520 static int vidioc_s_tuner(struct file
*file
, void *priv
,
1521 const struct v4l2_tuner
*v
)
1523 struct msi3101_state
*s
= video_drvdata(file
);
1524 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
1529 static int vidioc_g_tuner(struct file
*file
, void *priv
, struct v4l2_tuner
*v
)
1531 struct msi3101_state
*s
= video_drvdata(file
);
1532 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
1534 strcpy(v
->name
, "SDR RX");
1535 v
->capability
= V4L2_TUNER_CAP_LOW
;
1540 static int vidioc_s_frequency(struct file
*file
, void *priv
,
1541 const struct v4l2_frequency
*f
)
1543 struct msi3101_state
*s
= video_drvdata(file
);
1544 dev_dbg(&s
->udev
->dev
, "%s: frequency=%lu Hz (%u)\n",
1545 __func__
, f
->frequency
* 625UL / 10UL, f
->frequency
);
1547 return v4l2_ctrl_s_ctrl_int64(s
->ctrl_tuner_rf
,
1548 f
->frequency
* 625UL / 10UL);
1551 const struct v4l2_ioctl_ops msi3101_ioctl_ops
= {
1552 .vidioc_querycap
= msi3101_querycap
,
1554 .vidioc_enum_input
= msi3101_enum_input
,
1555 .vidioc_g_input
= msi3101_g_input
,
1556 .vidioc_s_input
= msi3101_s_input
,
1558 .vidioc_reqbufs
= vb2_ioctl_reqbufs
,
1559 .vidioc_create_bufs
= vb2_ioctl_create_bufs
,
1560 .vidioc_prepare_buf
= vb2_ioctl_prepare_buf
,
1561 .vidioc_querybuf
= vb2_ioctl_querybuf
,
1562 .vidioc_qbuf
= vb2_ioctl_qbuf
,
1563 .vidioc_dqbuf
= vb2_ioctl_dqbuf
,
1565 .vidioc_streamon
= vb2_ioctl_streamon
,
1566 .vidioc_streamoff
= vb2_ioctl_streamoff
,
1568 .vidioc_g_tuner
= vidioc_g_tuner
,
1569 .vidioc_s_tuner
= vidioc_s_tuner
,
1570 .vidioc_s_frequency
= vidioc_s_frequency
,
1572 .vidioc_subscribe_event
= v4l2_ctrl_subscribe_event
,
1573 .vidioc_unsubscribe_event
= v4l2_event_unsubscribe
,
1574 .vidioc_log_status
= v4l2_ctrl_log_status
,
1577 static const struct v4l2_file_operations msi3101_fops
= {
1578 .owner
= THIS_MODULE
,
1579 .open
= v4l2_fh_open
,
1580 .release
= vb2_fop_release
,
1581 .read
= vb2_fop_read
,
1582 .poll
= vb2_fop_poll
,
1583 .mmap
= vb2_fop_mmap
,
1584 .unlocked_ioctl
= video_ioctl2
,
1587 static struct video_device msi3101_template
= {
1588 .name
= "Mirics MSi3101 SDR Dongle",
1589 .release
= video_device_release_empty
,
1590 .fops
= &msi3101_fops
,
1591 .ioctl_ops
= &msi3101_ioctl_ops
,
1594 static int msi3101_s_ctrl(struct v4l2_ctrl
*ctrl
)
1596 struct msi3101_state
*s
=
1597 container_of(ctrl
->handler
, struct msi3101_state
,
1600 dev_dbg(&s
->udev
->dev
,
1601 "%s: id=%d name=%s val=%d min=%d max=%d step=%d\n",
1602 __func__
, ctrl
->id
, ctrl
->name
, ctrl
->val
,
1603 ctrl
->minimum
, ctrl
->maximum
, ctrl
->step
);
1606 case MSI3101_CID_SAMPLING_MODE
:
1607 case MSI3101_CID_SAMPLING_RATE
:
1608 case MSI3101_CID_SAMPLING_RESOLUTION
:
1611 case MSI3101_CID_TUNER_RF
:
1612 case MSI3101_CID_TUNER_BW
:
1613 case MSI3101_CID_TUNER_IF
:
1614 case MSI3101_CID_TUNER_GAIN
:
1615 ret
= msi3101_set_tuner(s
);
1624 static const struct v4l2_ctrl_ops msi3101_ctrl_ops
= {
1625 .s_ctrl
= msi3101_s_ctrl
,
1628 static void msi3101_video_release(struct v4l2_device
*v
)
1630 struct msi3101_state
*s
=
1631 container_of(v
, struct msi3101_state
, v4l2_dev
);
1633 v4l2_ctrl_handler_free(&s
->ctrl_handler
);
1634 v4l2_device_unregister(&s
->v4l2_dev
);
1638 static int msi3101_probe(struct usb_interface
*intf
,
1639 const struct usb_device_id
*id
)
1641 struct usb_device
*udev
= interface_to_usbdev(intf
);
1642 struct msi3101_state
*s
= NULL
;
1644 static const char * const ctrl_sampling_mode_qmenu_strings
[] = {
1645 "Quadrature Sampling",
1648 static const struct v4l2_ctrl_config ctrl_sampling_mode
= {
1649 .ops
= &msi3101_ctrl_ops
,
1650 .id
= MSI3101_CID_SAMPLING_MODE
,
1651 .type
= V4L2_CTRL_TYPE_MENU
,
1652 .flags
= V4L2_CTRL_FLAG_INACTIVE
,
1653 .name
= "Sampling Mode",
1654 .qmenu
= ctrl_sampling_mode_qmenu_strings
,
1656 static const struct v4l2_ctrl_config ctrl_sampling_rate
= {
1657 .ops
= &msi3101_ctrl_ops
,
1658 .id
= MSI3101_CID_SAMPLING_RATE
,
1659 .type
= V4L2_CTRL_TYPE_INTEGER64
,
1660 .name
= "Sampling Rate",
1666 static const struct v4l2_ctrl_config ctrl_sampling_resolution
= {
1667 .ops
= &msi3101_ctrl_ops
,
1668 .id
= MSI3101_CID_SAMPLING_RESOLUTION
,
1669 .type
= V4L2_CTRL_TYPE_INTEGER
,
1670 .flags
= V4L2_CTRL_FLAG_INACTIVE
,
1671 .name
= "Sampling Resolution",
1677 static const struct v4l2_ctrl_config ctrl_tuner_rf
= {
1678 .ops
= &msi3101_ctrl_ops
,
1679 .id
= MSI3101_CID_TUNER_RF
,
1680 .type
= V4L2_CTRL_TYPE_INTEGER64
,
1687 static const struct v4l2_ctrl_config ctrl_tuner_bw
= {
1688 .ops
= &msi3101_ctrl_ops
,
1689 .id
= MSI3101_CID_TUNER_BW
,
1690 .type
= V4L2_CTRL_TYPE_INTEGER
,
1697 static const struct v4l2_ctrl_config ctrl_tuner_if
= {
1698 .ops
= &msi3101_ctrl_ops
,
1699 .id
= MSI3101_CID_TUNER_IF
,
1700 .type
= V4L2_CTRL_TYPE_INTEGER
,
1701 .flags
= V4L2_CTRL_FLAG_INACTIVE
,
1708 static const struct v4l2_ctrl_config ctrl_tuner_gain
= {
1709 .ops
= &msi3101_ctrl_ops
,
1710 .id
= MSI3101_CID_TUNER_GAIN
,
1711 .type
= V4L2_CTRL_TYPE_INTEGER
,
1712 .name
= "Tuner Gain",
1719 s
= kzalloc(sizeof(struct msi3101_state
), GFP_KERNEL
);
1721 pr_err("Could not allocate memory for msi3101_state\n");
1725 mutex_init(&s
->v4l2_lock
);
1726 mutex_init(&s
->vb_queue_lock
);
1727 spin_lock_init(&s
->queued_bufs_lock
);
1728 INIT_LIST_HEAD(&s
->queued_bufs
);
1732 /* Init videobuf2 queue structure */
1733 s
->vb_queue
.type
= V4L2_BUF_TYPE_VIDEO_CAPTURE
;
1734 s
->vb_queue
.io_modes
= VB2_MMAP
| VB2_USERPTR
| VB2_READ
;
1735 s
->vb_queue
.drv_priv
= s
;
1736 s
->vb_queue
.buf_struct_size
= sizeof(struct msi3101_frame_buf
);
1737 s
->vb_queue
.ops
= &msi3101_vb2_ops
;
1738 s
->vb_queue
.mem_ops
= &vb2_vmalloc_memops
;
1739 s
->vb_queue
.timestamp_type
= V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC
;
1740 ret
= vb2_queue_init(&s
->vb_queue
);
1742 dev_err(&s
->udev
->dev
, "Could not initialize vb2 queue\n");
1746 /* Init video_device structure */
1747 s
->vdev
= msi3101_template
;
1748 s
->vdev
.queue
= &s
->vb_queue
;
1749 s
->vdev
.queue
->lock
= &s
->vb_queue_lock
;
1750 set_bit(V4L2_FL_USE_FH_PRIO
, &s
->vdev
.flags
);
1751 video_set_drvdata(&s
->vdev
, s
);
1753 /* Register controls */
1754 v4l2_ctrl_handler_init(&s
->ctrl_handler
, 7);
1755 v4l2_ctrl_new_custom(&s
->ctrl_handler
, &ctrl_sampling_mode
, NULL
);
1756 s
->ctrl_sampling_rate
= v4l2_ctrl_new_custom(&s
->ctrl_handler
, &ctrl_sampling_rate
, NULL
);
1757 v4l2_ctrl_new_custom(&s
->ctrl_handler
, &ctrl_sampling_resolution
, NULL
);
1758 s
->ctrl_tuner_rf
= v4l2_ctrl_new_custom(&s
->ctrl_handler
, &ctrl_tuner_rf
, NULL
);
1759 s
->ctrl_tuner_bw
= v4l2_ctrl_new_custom(&s
->ctrl_handler
, &ctrl_tuner_bw
, NULL
);
1760 s
->ctrl_tuner_if
= v4l2_ctrl_new_custom(&s
->ctrl_handler
, &ctrl_tuner_if
, NULL
);
1761 s
->ctrl_tuner_gain
= v4l2_ctrl_new_custom(&s
->ctrl_handler
, &ctrl_tuner_gain
, NULL
);
1762 if (s
->ctrl_handler
.error
) {
1763 ret
= s
->ctrl_handler
.error
;
1764 dev_err(&s
->udev
->dev
, "Could not initialize controls\n");
1765 goto err_free_controls
;
1768 /* Register the v4l2_device structure */
1769 s
->v4l2_dev
.release
= msi3101_video_release
;
1770 ret
= v4l2_device_register(&intf
->dev
, &s
->v4l2_dev
);
1772 dev_err(&s
->udev
->dev
,
1773 "Failed to register v4l2-device (%d)\n", ret
);
1774 goto err_free_controls
;
1777 s
->v4l2_dev
.ctrl_handler
= &s
->ctrl_handler
;
1778 s
->vdev
.v4l2_dev
= &s
->v4l2_dev
;
1779 s
->vdev
.lock
= &s
->v4l2_lock
;
1781 ret
= video_register_device(&s
->vdev
, VFL_TYPE_GRABBER
, -1);
1783 dev_err(&s
->udev
->dev
,
1784 "Failed to register as video device (%d)\n",
1786 goto err_unregister_v4l2_dev
;
1788 dev_info(&s
->udev
->dev
, "Registered as %s\n",
1789 video_device_node_name(&s
->vdev
));
1793 err_unregister_v4l2_dev
:
1794 v4l2_device_unregister(&s
->v4l2_dev
);
1796 v4l2_ctrl_handler_free(&s
->ctrl_handler
);
1802 /* USB device ID list */
1803 static struct usb_device_id msi3101_id_table
[] = {
1804 { USB_DEVICE(0x1df7, 0x2500) }, /* Mirics MSi3101 SDR Dongle */
1805 { USB_DEVICE(0x2040, 0xd300) }, /* Hauppauge WinTV 133559 LF */
1808 MODULE_DEVICE_TABLE(usb
, msi3101_id_table
);
1810 /* USB subsystem interface */
1811 static struct usb_driver msi3101_driver
= {
1812 .name
= KBUILD_MODNAME
,
1813 .probe
= msi3101_probe
,
1814 .disconnect
= msi3101_disconnect
,
1815 .id_table
= msi3101_id_table
,
1818 module_usb_driver(msi3101_driver
);
1820 MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>");
1821 MODULE_DESCRIPTION("Mirics MSi3101 SDR Dongle");
1822 MODULE_LICENSE("GPL");