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 type '384'
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 8-bit integer into 32-bit IEEE floating point
508 static u32
msi3101_convert_sample_504(struct msi3101_state
*s
, u16 x
)
510 u32 msb
, exponent
, fraction
, sign
;
512 /* Zero is special */
516 /* Negative / positive value */
519 x
&= 0x7f; /* result is 7 bit ... + sign */
525 /* Get location of the most significant bit */
528 fraction
= ror32(x
, (msb
- I2F_FRAC_BITS
) & 0x1f) & I2F_MASK
;
529 exponent
= (127 + msb
) << I2F_FRAC_BITS
;
531 return (fraction
+ exponent
) | sign
;
534 static int msi3101_convert_stream_504(struct msi3101_state
*s
, u32
*dst
,
535 u8
*src
, unsigned int src_len
)
537 int i
, j
, i_max
, dst_len
= 0;
541 /* There could be 1-3 1024 bytes URB frames */
542 i_max
= src_len
/ 1024;
544 for (i
= 0; i
< i_max
; i
++) {
545 sample_num
[i
] = src
[3] << 24 | src
[2] << 16 | src
[1] << 8 | src
[0] << 0;
546 if (i
== 0 && s
->next_sample
!= sample_num
[0]) {
547 dev_dbg_ratelimited(&s
->udev
->dev
,
548 "%d samples lost, %d %08x:%08x\n",
549 sample_num
[0] - s
->next_sample
,
550 src_len
, s
->next_sample
, sample_num
[0]);
554 * Dump all unknown 'garbage' data - maybe we will discover
555 * someday if there is something rational...
557 dev_dbg_ratelimited(&s
->udev
->dev
, "%*ph\n", 12, &src
[4]);
560 for (j
= 0; j
< 1008; j
+= 2) {
561 sample
[0] = src
[j
+ 0];
562 sample
[1] = src
[j
+ 1];
564 *dst
++ = msi3101_convert_sample_504(s
, sample
[0]);
565 *dst
++ = msi3101_convert_sample_504(s
, sample
[1]);
567 /* 504 x I+Q 32bit float samples */
568 dst_len
+= 504 * 2 * 4;
572 /* calculate samping rate and output it in 10 seconds intervals */
573 if ((s
->jiffies
+ msecs_to_jiffies(10000)) <= jiffies
) {
574 unsigned long jiffies_now
= jiffies
;
575 unsigned long msecs
= jiffies_to_msecs(jiffies_now
) - jiffies_to_msecs(s
->jiffies
);
576 unsigned int samples
= sample_num
[i_max
- 1] - s
->sample
;
577 s
->jiffies
= jiffies_now
;
578 s
->sample
= sample_num
[i_max
- 1];
579 dev_dbg(&s
->udev
->dev
,
580 "slen=%d samples=%u msecs=%lu sampling rate=%lu\n",
581 src_len
, samples
, msecs
,
582 samples
* 1000UL / msecs
);
585 /* next sample (sample = sample + i * 504) */
586 s
->next_sample
= sample_num
[i_max
- 1] + 504;
592 * Converts signed ~10+3-bit integer into 32-bit IEEE floating point
595 static u32
msi3101_convert_sample_384(struct msi3101_state
*s
, u16 x
, int shift
)
597 u32 msb
, exponent
, fraction
, sign
;
598 s
->sample_ctrl_bit
[shift
]++;
600 /* Zero is special */
604 /* Convert 10-bit two's complement to 13-bit */
606 x
|= ~0U << 10; /* set all the rest bits to one */
609 x
&= 0xfff; /* result is 12 bit ... + sign */
616 /* Get location of the most significant bit */
619 fraction
= ror32(x
, (msb
- I2F_FRAC_BITS
) & 0x1f) & I2F_MASK
;
620 exponent
= (127 + msb
) << I2F_FRAC_BITS
;
622 return (fraction
+ exponent
) | sign
;
625 static int msi3101_convert_stream_384(struct msi3101_state
*s
, u32
*dst
,
626 u8
*src
, unsigned int src_len
)
628 int i
, j
, k
, l
, i_max
, dst_len
= 0;
633 /* There could be 1-3 1024 bytes URB frames */
634 i_max
= src_len
/ 1024;
635 for (i
= 0; i
< i_max
; i
++) {
636 sample_num
[i
] = src
[3] << 24 | src
[2] << 16 | src
[1] << 8 | src
[0] << 0;
637 if (i
== 0 && s
->next_sample
!= sample_num
[0]) {
638 dev_dbg_ratelimited(&s
->udev
->dev
,
639 "%d samples lost, %d %08x:%08x\n",
640 sample_num
[0] - s
->next_sample
,
641 src_len
, s
->next_sample
, sample_num
[0]);
645 * Dump all unknown 'garbage' data - maybe we will discover
646 * someday if there is something rational...
648 dev_dbg_ratelimited(&s
->udev
->dev
,
649 "%*ph %*ph\n", 12, &src
[4], 24, &src
[1000]);
652 for (j
= 0; j
< 6; j
++) {
653 bits
= src
[160 + 3] << 24 | src
[160 + 2] << 16 | src
[160 + 1] << 8 | src
[160 + 0] << 0;
654 for (k
= 0; k
< 16; k
++) {
655 for (l
= 0; l
< 10; l
+= 5) {
656 sample
[0] = (src
[l
+ 0] & 0xff) >> 0 | (src
[l
+ 1] & 0x03) << 8;
657 sample
[1] = (src
[l
+ 1] & 0xfc) >> 2 | (src
[l
+ 2] & 0x0f) << 6;
658 sample
[2] = (src
[l
+ 2] & 0xf0) >> 4 | (src
[l
+ 3] & 0x3f) << 4;
659 sample
[3] = (src
[l
+ 3] & 0xc0) >> 6 | (src
[l
+ 4] & 0xff) << 2;
661 *dst
++ = msi3101_convert_sample_384(s
, sample
[0], (bits
>> (2 * k
)) & 0x3);
662 *dst
++ = msi3101_convert_sample_384(s
, sample
[1], (bits
>> (2 * k
)) & 0x3);
663 *dst
++ = msi3101_convert_sample_384(s
, sample
[2], (bits
>> (2 * k
)) & 0x3);
664 *dst
++ = msi3101_convert_sample_384(s
, sample
[3], (bits
>> (2 * k
)) & 0x3);
668 dev_dbg_ratelimited(&s
->udev
->dev
,
669 "sample control bits %08x\n", bits
);
672 /* 384 x I+Q 32bit float samples */
673 dst_len
+= 384 * 2 * 4;
677 /* calculate samping rate and output it in 10 seconds intervals */
678 if ((s
->jiffies
+ msecs_to_jiffies(10000)) <= jiffies
) {
679 unsigned long jiffies_now
= jiffies
;
680 unsigned long msecs
= jiffies_to_msecs(jiffies_now
) - jiffies_to_msecs(s
->jiffies
);
681 unsigned int samples
= sample_num
[i_max
- 1] - s
->sample
;
682 s
->jiffies
= jiffies_now
;
683 s
->sample
= sample_num
[i_max
- 1];
684 dev_dbg(&s
->udev
->dev
,
685 "slen=%d samples=%u msecs=%lu sampling rate=%lu bits=%d.%d.%d.%d\n",
686 src_len
, samples
, msecs
,
687 samples
* 1000UL / msecs
,
688 s
->sample_ctrl_bit
[0], s
->sample_ctrl_bit
[1],
689 s
->sample_ctrl_bit
[2], s
->sample_ctrl_bit
[3]);
692 /* next sample (sample = sample + i * 384) */
693 s
->next_sample
= sample_num
[i_max
- 1] + 384;
699 * Converts signed 12-bit integer into 32-bit IEEE floating point
702 static u32
msi3101_convert_sample_336(struct msi3101_state
*s
, u16 x
)
704 u32 msb
, exponent
, fraction
, sign
;
706 /* Zero is special */
710 /* Negative / positive value */
713 x
&= 0x7ff; /* result is 11 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_336(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
+= 3) {
755 sample
[0] = (src
[j
+ 0] & 0xff) >> 0 | (src
[j
+ 1] & 0x0f) << 8;
756 sample
[1] = (src
[j
+ 1] & 0xf0) >> 4 | (src
[j
+ 2] & 0xff) << 4;
758 *dst
++ = msi3101_convert_sample_336(s
, sample
[0]);
759 *dst
++ = msi3101_convert_sample_336(s
, sample
[1]);
761 /* 336 x I+Q 32bit float samples */
762 dst_len
+= 336 * 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 * 336) */
780 s
->next_sample
= sample_num
[i_max
- 1] + 336;
786 * Converts signed 14-bit integer into 32-bit IEEE floating point
789 static u32
msi3101_convert_sample_252(struct msi3101_state
*s
, u16 x
)
791 u32 msb
, exponent
, fraction
, sign
;
793 /* Zero is special */
797 /* Negative / positive value */
800 x
&= 0x1fff; /* result is 13 bit ... + sign */
806 /* Get location of the most significant bit */
809 fraction
= ror32(x
, (msb
- I2F_FRAC_BITS
) & 0x1f) & I2F_MASK
;
810 exponent
= (127 + msb
) << I2F_FRAC_BITS
;
812 return (fraction
+ exponent
) | sign
;
815 static int msi3101_convert_stream_252(struct msi3101_state
*s
, u32
*dst
,
816 u8
*src
, unsigned int src_len
)
818 int i
, j
, i_max
, dst_len
= 0;
822 /* There could be 1-3 1024 bytes URB frames */
823 i_max
= src_len
/ 1024;
825 for (i
= 0; i
< i_max
; i
++) {
826 sample_num
[i
] = src
[3] << 24 | src
[2] << 16 | src
[1] << 8 | src
[0] << 0;
827 if (i
== 0 && s
->next_sample
!= sample_num
[0]) {
828 dev_dbg_ratelimited(&s
->udev
->dev
,
829 "%d samples lost, %d %08x:%08x\n",
830 sample_num
[0] - s
->next_sample
,
831 src_len
, s
->next_sample
, sample_num
[0]);
835 * Dump all unknown 'garbage' data - maybe we will discover
836 * someday if there is something rational...
838 dev_dbg_ratelimited(&s
->udev
->dev
, "%*ph\n", 12, &src
[4]);
841 for (j
= 0; j
< 1008; j
+= 4) {
842 sample
[0] = src
[j
+ 0] >> 0 | src
[j
+ 1] << 8;
843 sample
[1] = src
[j
+ 2] >> 0 | src
[j
+ 3] << 8;
845 *dst
++ = msi3101_convert_sample_252(s
, sample
[0]);
846 *dst
++ = msi3101_convert_sample_252(s
, sample
[1]);
848 /* 252 x I+Q 32bit float samples */
849 dst_len
+= 252 * 2 * 4;
853 /* calculate samping rate and output it in 10 seconds intervals */
854 if ((s
->jiffies
+ msecs_to_jiffies(10000)) <= jiffies
) {
855 unsigned long jiffies_now
= jiffies
;
856 unsigned long msecs
= jiffies_to_msecs(jiffies_now
) - jiffies_to_msecs(s
->jiffies
);
857 unsigned int samples
= sample_num
[i_max
- 1] - s
->sample
;
858 s
->jiffies
= jiffies_now
;
859 s
->sample
= sample_num
[i_max
- 1];
860 dev_dbg(&s
->udev
->dev
,
861 "slen=%d samples=%u msecs=%lu sampling rate=%lu\n",
862 src_len
, samples
, msecs
,
863 samples
* 1000UL / msecs
);
866 /* next sample (sample = sample + i * 252) */
867 s
->next_sample
= sample_num
[i_max
- 1] + 252;
873 * This gets called for the Isochronous pipe (stream). This is done in interrupt
874 * time, so it has to be fast, not crash, and not stall. Neat.
876 static void msi3101_isoc_handler(struct urb
*urb
)
878 struct msi3101_state
*s
= (struct msi3101_state
*)urb
->context
;
879 int i
, flen
, fstatus
;
880 unsigned char *iso_buf
= NULL
;
881 struct msi3101_frame_buf
*fbuf
;
883 if (urb
->status
== -ENOENT
|| urb
->status
== -ECONNRESET
||
884 urb
->status
== -ESHUTDOWN
) {
885 dev_dbg(&s
->udev
->dev
, "URB (%p) unlinked %ssynchronuously\n",
886 urb
, urb
->status
== -ENOENT
? "" : "a");
890 if (urb
->status
!= 0) {
891 dev_dbg(&s
->udev
->dev
,
892 "msi3101_isoc_handler() called with status %d\n",
894 /* Give up after a number of contiguous errors */
895 if (++s
->isoc_errors
> MAX_ISOC_ERRORS
)
896 dev_dbg(&s
->udev
->dev
,
897 "Too many ISOC errors, bailing out\n");
900 /* Reset ISOC error counter. We did get here, after all. */
905 for (i
= 0; i
< urb
->number_of_packets
; i
++) {
908 /* Check frame error */
909 fstatus
= urb
->iso_frame_desc
[i
].status
;
911 dev_dbg_ratelimited(&s
->udev
->dev
,
912 "frame=%d/%d has error %d skipping\n",
913 i
, urb
->number_of_packets
, fstatus
);
917 /* Check if that frame contains data */
918 flen
= urb
->iso_frame_desc
[i
].actual_length
;
922 iso_buf
= urb
->transfer_buffer
+ urb
->iso_frame_desc
[i
].offset
;
924 /* Get free framebuffer */
925 fbuf
= msi3101_get_next_fill_buf(s
);
928 dev_dbg_ratelimited(&s
->udev
->dev
,
929 "videobuf is full, %d packets dropped\n",
934 /* fill framebuffer */
935 ptr
= vb2_plane_vaddr(&fbuf
->vb
, 0);
936 flen
= s
->convert_stream(s
, ptr
, iso_buf
, flen
);
937 vb2_set_plane_payload(&fbuf
->vb
, 0, flen
);
938 vb2_buffer_done(&fbuf
->vb
, VB2_BUF_STATE_DONE
);
944 i
= usb_submit_urb(urb
, GFP_ATOMIC
);
946 dev_dbg(&s
->udev
->dev
,
947 "Error (%d) re-submitting urb in msi3101_isoc_handler\n",
951 static void msi3101_iso_stop(struct msi3101_state
*s
)
954 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
956 /* Unlinking ISOC buffers one by one */
957 for (i
= 0; i
< MAX_ISO_BUFS
; i
++) {
959 dev_dbg(&s
->udev
->dev
, "Unlinking URB %p\n",
961 usb_kill_urb(s
->urbs
[i
]);
966 static void msi3101_iso_free(struct msi3101_state
*s
)
969 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
971 /* Freeing ISOC buffers one by one */
972 for (i
= 0; i
< MAX_ISO_BUFS
; i
++) {
974 dev_dbg(&s
->udev
->dev
, "Freeing URB\n");
975 if (s
->urbs
[i
]->transfer_buffer
) {
976 usb_free_coherent(s
->udev
,
977 s
->urbs
[i
]->transfer_buffer_length
,
978 s
->urbs
[i
]->transfer_buffer
,
979 s
->urbs
[i
]->transfer_dma
);
981 usb_free_urb(s
->urbs
[i
]);
987 /* Both v4l2_lock and vb_queue_lock should be locked when calling this */
988 static void msi3101_isoc_cleanup(struct msi3101_state
*s
)
990 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
996 /* Both v4l2_lock and vb_queue_lock should be locked when calling this */
997 static int msi3101_isoc_init(struct msi3101_state
*s
)
999 struct usb_device
*udev
;
1002 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
1007 ret
= usb_set_interface(s
->udev
, 0, 1);
1011 /* Allocate and init Isochronuous urbs */
1012 for (i
= 0; i
< MAX_ISO_BUFS
; i
++) {
1013 urb
= usb_alloc_urb(ISO_FRAMES_PER_DESC
, GFP_KERNEL
);
1015 dev_err(&s
->udev
->dev
,
1016 "Failed to allocate urb %d\n", i
);
1017 msi3101_isoc_cleanup(s
);
1021 dev_dbg(&s
->udev
->dev
, "Allocated URB at 0x%p\n", urb
);
1025 urb
->pipe
= usb_rcvisocpipe(udev
, 0x81);
1026 urb
->transfer_flags
= URB_ISO_ASAP
| URB_NO_TRANSFER_DMA_MAP
;
1027 urb
->transfer_buffer
= usb_alloc_coherent(udev
, ISO_BUFFER_SIZE
,
1028 GFP_KERNEL
, &urb
->transfer_dma
);
1029 if (urb
->transfer_buffer
== NULL
) {
1030 dev_err(&s
->udev
->dev
,
1031 "Failed to allocate urb buffer %d\n",
1033 msi3101_isoc_cleanup(s
);
1036 urb
->transfer_buffer_length
= ISO_BUFFER_SIZE
;
1037 urb
->complete
= msi3101_isoc_handler
;
1039 urb
->start_frame
= 0;
1040 urb
->number_of_packets
= ISO_FRAMES_PER_DESC
;
1041 for (j
= 0; j
< ISO_FRAMES_PER_DESC
; j
++) {
1042 urb
->iso_frame_desc
[j
].offset
= j
* ISO_MAX_FRAME_SIZE
;
1043 urb
->iso_frame_desc
[j
].length
= ISO_MAX_FRAME_SIZE
;
1048 for (i
= 0; i
< MAX_ISO_BUFS
; i
++) {
1049 ret
= usb_submit_urb(s
->urbs
[i
], GFP_KERNEL
);
1051 dev_err(&s
->udev
->dev
,
1052 "isoc_init() submit_urb %d failed with error %d\n",
1054 msi3101_isoc_cleanup(s
);
1057 dev_dbg(&s
->udev
->dev
, "URB 0x%p submitted.\n", s
->urbs
[i
]);
1060 /* All is done... */
1064 /* Must be called with vb_queue_lock hold */
1065 static void msi3101_cleanup_queued_bufs(struct msi3101_state
*s
)
1067 unsigned long flags
= 0;
1068 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
1070 spin_lock_irqsave(&s
->queued_bufs_lock
, flags
);
1071 while (!list_empty(&s
->queued_bufs
)) {
1072 struct msi3101_frame_buf
*buf
;
1074 buf
= list_entry(s
->queued_bufs
.next
, struct msi3101_frame_buf
,
1076 list_del(&buf
->list
);
1077 vb2_buffer_done(&buf
->vb
, VB2_BUF_STATE_ERROR
);
1079 spin_unlock_irqrestore(&s
->queued_bufs_lock
, flags
);
1082 /* The user yanked out the cable... */
1083 static void msi3101_disconnect(struct usb_interface
*intf
)
1085 struct v4l2_device
*v
= usb_get_intfdata(intf
);
1086 struct msi3101_state
*s
=
1087 container_of(v
, struct msi3101_state
, v4l2_dev
);
1088 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
1090 mutex_lock(&s
->vb_queue_lock
);
1091 mutex_lock(&s
->v4l2_lock
);
1092 /* No need to keep the urbs around after disconnection */
1095 v4l2_device_disconnect(&s
->v4l2_dev
);
1096 video_unregister_device(&s
->vdev
);
1097 mutex_unlock(&s
->v4l2_lock
);
1098 mutex_unlock(&s
->vb_queue_lock
);
1100 v4l2_device_put(&s
->v4l2_dev
);
1103 static int msi3101_querycap(struct file
*file
, void *fh
,
1104 struct v4l2_capability
*cap
)
1106 struct msi3101_state
*s
= video_drvdata(file
);
1107 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
1109 strlcpy(cap
->driver
, KBUILD_MODNAME
, sizeof(cap
->driver
));
1110 strlcpy(cap
->card
, s
->vdev
.name
, sizeof(cap
->card
));
1111 usb_make_path(s
->udev
, cap
->bus_info
, sizeof(cap
->bus_info
));
1112 cap
->device_caps
= V4L2_CAP_VIDEO_CAPTURE
| V4L2_CAP_STREAMING
|
1114 cap
->device_caps
= V4L2_CAP_TUNER
;
1115 cap
->capabilities
= cap
->device_caps
| V4L2_CAP_DEVICE_CAPS
;
1120 /* Videobuf2 operations */
1121 static int msi3101_queue_setup(struct vb2_queue
*vq
,
1122 const struct v4l2_format
*fmt
, unsigned int *nbuffers
,
1123 unsigned int *nplanes
, unsigned int sizes
[], void *alloc_ctxs
[])
1125 struct msi3101_state
*s
= vb2_get_drv_priv(vq
);
1126 dev_dbg(&s
->udev
->dev
, "%s: *nbuffers=%d\n", __func__
, *nbuffers
);
1128 /* Absolute min and max number of buffers available for mmap() */
1131 sizes
[0] = PAGE_ALIGN(3 * 3072); /* 3 * 768 * 4 */
1132 dev_dbg(&s
->udev
->dev
, "%s: nbuffers=%d sizes[0]=%d\n",
1133 __func__
, *nbuffers
, sizes
[0]);
1137 static int msi3101_buf_prepare(struct vb2_buffer
*vb
)
1139 struct msi3101_state
*s
= vb2_get_drv_priv(vb
->vb2_queue
);
1141 /* Don't allow queing new buffers after device disconnection */
1148 static void msi3101_buf_queue(struct vb2_buffer
*vb
)
1150 struct msi3101_state
*s
= vb2_get_drv_priv(vb
->vb2_queue
);
1151 struct msi3101_frame_buf
*buf
=
1152 container_of(vb
, struct msi3101_frame_buf
, vb
);
1153 unsigned long flags
= 0;
1155 /* Check the device has not disconnected between prep and queuing */
1157 vb2_buffer_done(&buf
->vb
, VB2_BUF_STATE_ERROR
);
1161 spin_lock_irqsave(&s
->queued_bufs_lock
, flags
);
1162 list_add_tail(&buf
->list
, &s
->queued_bufs
);
1163 spin_unlock_irqrestore(&s
->queued_bufs_lock
, flags
);
1166 #define CMD_WREG 0x41
1167 #define CMD_START_STREAMING 0x43
1168 #define CMD_STOP_STREAMING 0x45
1169 #define CMD_READ_UNKNOW 0x48
1171 #define msi3101_dbg_usb_control_msg(udev, r, t, v, _i, b, l) { \
1173 if (t == (USB_TYPE_VENDOR | USB_DIR_OUT)) \
1174 direction = ">>>"; \
1176 direction = "<<<"; \
1177 dev_dbg(&udev->dev, "%s: %02x %02x %02x %02x %02x %02x %02x %02x " \
1178 "%s %*ph\n", __func__, t, r, v & 0xff, v >> 8, \
1179 _i & 0xff, _i >> 8, l & 0xff, l >> 8, direction, l, b); \
1182 static int msi3101_ctrl_msg(struct msi3101_state
*s
, u8 cmd
, u32 data
)
1186 u8 requesttype
= USB_DIR_OUT
| USB_TYPE_VENDOR
;
1187 u16 value
= (data
>> 0) & 0xffff;
1188 u16 index
= (data
>> 16) & 0xffff;
1190 msi3101_dbg_usb_control_msg(s
->udev
,
1191 request
, requesttype
, value
, index
, NULL
, 0);
1193 ret
= usb_control_msg(s
->udev
, usb_sndctrlpipe(s
->udev
, 0),
1194 request
, requesttype
, value
, index
, NULL
, 0, 2000);
1197 dev_err(&s
->udev
->dev
, "%s: failed %d, cmd %02x, data %04x\n",
1198 __func__
, ret
, cmd
, data
);
1203 static int msi3101_tuner_write(struct msi3101_state
*s
, u32 data
)
1205 return msi3101_ctrl_msg(s
, CMD_WREG
, data
<< 8 | 0x09);
1208 #define F_REF 24000000
1210 static int msi3101_set_usb_adc(struct msi3101_state
*s
)
1212 int ret
, div_n
, div_m
, div_r_out
, f_sr
, f_vco
, fract
;
1213 u32 reg3
, reg4
, reg7
;
1215 f_sr
= s
->ctrl_sampling_rate
->val64
;
1217 /* select stream format */
1218 if (f_sr
< 6000000) {
1219 s
->convert_stream
= msi3101_convert_stream_252
;
1221 } else if (f_sr
< 8000000) {
1222 s
->convert_stream
= msi3101_convert_stream_336
;
1224 } else if (f_sr
< 9000000) {
1225 s
->convert_stream
= msi3101_convert_stream_384
;
1228 s
->convert_stream
= msi3101_convert_stream_504
;
1233 * Synthesizer config is just a educated guess...
1235 * [7:0] 0x03, register address
1238 * [12:10] output divider
1241 * [15] fractional MSB, bit 20
1257 * VCO 202000000 - 720000000++
1262 /* XXX: Filters? AGC? */
1265 else if (f_sr
< 7000000)
1267 else if (f_sr
< 8500000)
1272 for (div_r_out
= 4; div_r_out
< 16; div_r_out
+= 2) {
1273 f_vco
= f_sr
* div_r_out
* 12;
1274 dev_dbg(&s
->udev
->dev
, "%s: div_r_out=%d f_vco=%d\n",
1275 __func__
, div_r_out
, f_vco
);
1276 if (f_vco
>= 202000000)
1280 div_n
= f_vco
/ (F_REF
* DIV_R_IN
);
1281 div_m
= f_vco
% (F_REF
* DIV_R_IN
);
1282 fract
= 0x200000ul
* div_m
/ (F_REF
* DIV_R_IN
);
1284 reg3
|= div_n
<< 16;
1285 reg3
|= (div_r_out
/ 2 - 1) << 10;
1286 reg3
|= ((fract
>> 20) & 0x000001) << 15; /* [20] */
1287 reg4
|= ((fract
>> 0) & 0x0fffff) << 8; /* [19:0] */
1289 dev_dbg(&s
->udev
->dev
,
1290 "%s: f_sr=%d f_vco=%d div_n=%d div_m=%d div_r_out=%d reg3=%08x reg4=%08x\n",
1291 __func__
, f_sr
, f_vco
, div_n
, div_m
, div_r_out
, reg3
, reg4
);
1293 ret
= msi3101_ctrl_msg(s
, CMD_WREG
, 0x00608008);
1297 ret
= msi3101_ctrl_msg(s
, CMD_WREG
, 0x00000c05);
1301 ret
= msi3101_ctrl_msg(s
, CMD_WREG
, 0x00020000);
1305 ret
= msi3101_ctrl_msg(s
, CMD_WREG
, 0x00480102);
1309 ret
= msi3101_ctrl_msg(s
, CMD_WREG
, 0x00f38008);
1313 ret
= msi3101_ctrl_msg(s
, CMD_WREG
, reg7
);
1317 ret
= msi3101_ctrl_msg(s
, CMD_WREG
, reg4
);
1321 ret
= msi3101_ctrl_msg(s
, CMD_WREG
, reg3
);
1328 static int msi3101_set_tuner(struct msi3101_state
*s
)
1331 unsigned int n
, m
, thresh
, frac
, vco_step
, tmp
;
1335 const struct msi3101_gain
*gain_lut
;
1336 static const struct {
1341 { 47000000, 0x01, 16}, /* AM_MODE1 */
1342 {108000000, 0x02, 32}, /* VHF_MODE */
1343 {330000000, 0x04, 16}, /* B3_MODE */
1344 {960000000, 0x08, 4}, /* B45_MODE */
1345 { ~0U, 0x10, 2}, /* BL_MODE */
1347 static const struct {
1351 { 0, 0x03}, /* Zero IF */
1352 { 450000, 0x02}, /* 450 kHz IF */
1353 {1620000, 0x01}, /* 1.62 MHz IF */
1354 {2048000, 0x00}, /* 2.048 MHz IF */
1356 static const struct {
1359 } bandwidth_lut
[] = {
1360 { 200000, 0x00}, /* 200 kHz */
1361 { 300000, 0x01}, /* 300 kHz */
1362 { 600000, 0x02}, /* 600 kHz */
1363 {1536000, 0x03}, /* 1.536 MHz */
1364 {5000000, 0x04}, /* 5 MHz */
1365 {6000000, 0x05}, /* 6 MHz */
1366 {7000000, 0x06}, /* 7 MHz */
1367 {8000000, 0x07}, /* 8 MHz */
1370 unsigned int rf_freq
= s
->ctrl_tuner_rf
->val64
;
1374 * 200000, 300000, 600000, 1536000, 5000000, 6000000, 7000000, 8000000
1376 int bandwidth
= s
->ctrl_tuner_bw
->val
;
1379 * intermediate frequency (Hz)
1380 * 0, 450000, 1620000, 2048000
1382 int if_freq
= s
->ctrl_tuner_if
->val
;
1385 * gain reduction (dB)
1386 * 0 - 102 below 420 MHz
1387 * 0 - 85 above 420 MHz
1389 int gain
= s
->ctrl_tuner_gain
->val
;
1391 dev_dbg(&s
->udev
->dev
,
1392 "%s: rf_freq=%d bandwidth=%d if_freq=%d gain=%d\n",
1393 __func__
, rf_freq
, bandwidth
, if_freq
, gain
);
1397 for (i
= 0; i
< ARRAY_SIZE(band_lut
); i
++) {
1398 if (rf_freq
<= band_lut
[i
].rf
) {
1399 mode
= band_lut
[i
].mode
;
1400 lo_div
= band_lut
[i
].lo_div
;
1405 if (i
== ARRAY_SIZE(band_lut
))
1408 for (i
= 0; i
< ARRAY_SIZE(if_freq_lut
); i
++) {
1409 if (if_freq
== if_freq_lut
[i
].freq
) {
1410 if_freq
= if_freq_lut
[i
].val
;
1415 if (i
== ARRAY_SIZE(if_freq_lut
))
1418 for (i
= 0; i
< ARRAY_SIZE(bandwidth_lut
); i
++) {
1419 if (bandwidth
== bandwidth_lut
[i
].freq
) {
1420 bandwidth
= bandwidth_lut
[i
].val
;
1425 if (i
== ARRAY_SIZE(bandwidth_lut
))
1428 #define F_OUT_STEP 1
1431 f_vco
= (rf_freq
+ F_IF
) * lo_div
;
1432 n
= f_vco
/ (F_REF
* R_REF
);
1433 m
= f_vco
% (F_REF
* R_REF
);
1435 vco_step
= F_OUT_STEP
* lo_div
;
1436 thresh
= (F_REF
* R_REF
) / vco_step
;
1437 frac
= 1ul * thresh
* m
/ (F_REF
* R_REF
);
1439 /* Divide to reg max. After that RF resolution will be +-500Hz. */
1440 tmp
= DIV_ROUND_UP(thresh
, 4095);
1441 thresh
= DIV_ROUND_CLOSEST(thresh
, tmp
);
1442 frac
= DIV_ROUND_CLOSEST(frac
, tmp
);
1444 /* calc real RF set */
1445 tmp
= 1ul * F_REF
* R_REF
* n
;
1446 tmp
+= 1ul * F_REF
* R_REF
* frac
/ thresh
;
1449 dev_dbg(&s
->udev
->dev
,
1450 "%s: rf=%u:%u n=%d thresh=%d frac=%d\n",
1451 __func__
, rf_freq
, tmp
, n
, thresh
, frac
);
1453 ret
= msi3101_tuner_write(s
, 0x00000e);
1454 ret
= msi3101_tuner_write(s
, 0x000003);
1459 reg
|= if_freq
<< 12;
1460 reg
|= bandwidth
<< 14;
1463 ret
= msi3101_tuner_write(s
, reg
);
1471 ret
= msi3101_tuner_write(s
, reg
);
1478 ret
= msi3101_tuner_write(s
, reg
);
1482 if (rf_freq
< 120000000) {
1483 gain_lut
= msi3101_gain_lut_120
;
1484 len
= ARRAY_SIZE(msi3101_gain_lut_120
);
1485 } else if (rf_freq
< 245000000) {
1486 gain_lut
= msi3101_gain_lut_245
;
1487 len
= ARRAY_SIZE(msi3101_gain_lut_120
);
1489 gain_lut
= msi3101_gain_lut_1000
;
1490 len
= ARRAY_SIZE(msi3101_gain_lut_1000
);
1493 for (i
= 0; i
< len
; i
++) {
1494 if (gain_lut
[i
].tot
>= gain
)
1501 dev_dbg(&s
->udev
->dev
,
1502 "%s: gain tot=%d baseband=%d lna=%d mixer=%d\n",
1503 __func__
, gain_lut
[i
].tot
, gain_lut
[i
].baseband
,
1504 gain_lut
[i
].lna
, gain_lut
[i
].mixer
);
1507 reg
|= gain_lut
[i
].baseband
<< 4;
1509 reg
|= gain_lut
[i
].mixer
<< 12;
1510 reg
|= gain_lut
[i
].lna
<< 13;
1513 ret
= msi3101_tuner_write(s
, reg
);
1520 ret
= msi3101_tuner_write(s
, reg
);
1526 dev_dbg(&s
->udev
->dev
, "%s: failed %d\n", __func__
, ret
);
1530 static int msi3101_start_streaming(struct vb2_queue
*vq
, unsigned int count
)
1532 struct msi3101_state
*s
= vb2_get_drv_priv(vq
);
1534 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
1539 if (mutex_lock_interruptible(&s
->v4l2_lock
))
1540 return -ERESTARTSYS
;
1542 ret
= msi3101_set_usb_adc(s
);
1544 ret
= msi3101_isoc_init(s
);
1546 msi3101_cleanup_queued_bufs(s
);
1548 ret
= msi3101_ctrl_msg(s
, CMD_START_STREAMING
, 0);
1550 mutex_unlock(&s
->v4l2_lock
);
1555 static int msi3101_stop_streaming(struct vb2_queue
*vq
)
1557 struct msi3101_state
*s
= vb2_get_drv_priv(vq
);
1558 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
1560 if (mutex_lock_interruptible(&s
->v4l2_lock
))
1561 return -ERESTARTSYS
;
1564 msi3101_isoc_cleanup(s
);
1566 msi3101_cleanup_queued_bufs(s
);
1568 /* according to tests, at least 700us delay is required */
1570 msi3101_ctrl_msg(s
, CMD_STOP_STREAMING
, 0);
1572 mutex_unlock(&s
->v4l2_lock
);
1577 static struct vb2_ops msi3101_vb2_ops
= {
1578 .queue_setup
= msi3101_queue_setup
,
1579 .buf_prepare
= msi3101_buf_prepare
,
1580 .buf_queue
= msi3101_buf_queue
,
1581 .start_streaming
= msi3101_start_streaming
,
1582 .stop_streaming
= msi3101_stop_streaming
,
1583 .wait_prepare
= vb2_ops_wait_prepare
,
1584 .wait_finish
= vb2_ops_wait_finish
,
1587 static int msi3101_enum_input(struct file
*file
, void *fh
, struct v4l2_input
*i
)
1592 strlcpy(i
->name
, "SDR data", sizeof(i
->name
));
1593 i
->type
= V4L2_INPUT_TYPE_CAMERA
;
1598 static int msi3101_g_input(struct file
*file
, void *fh
, unsigned int *i
)
1605 static int msi3101_s_input(struct file
*file
, void *fh
, unsigned int i
)
1607 return i
? -EINVAL
: 0;
1610 static int vidioc_s_tuner(struct file
*file
, void *priv
,
1611 const struct v4l2_tuner
*v
)
1613 struct msi3101_state
*s
= video_drvdata(file
);
1614 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
1619 static int vidioc_g_tuner(struct file
*file
, void *priv
, struct v4l2_tuner
*v
)
1621 struct msi3101_state
*s
= video_drvdata(file
);
1622 dev_dbg(&s
->udev
->dev
, "%s:\n", __func__
);
1624 strcpy(v
->name
, "SDR RX");
1625 v
->capability
= V4L2_TUNER_CAP_LOW
;
1630 static int vidioc_s_frequency(struct file
*file
, void *priv
,
1631 const struct v4l2_frequency
*f
)
1633 struct msi3101_state
*s
= video_drvdata(file
);
1634 dev_dbg(&s
->udev
->dev
, "%s: frequency=%lu Hz (%u)\n",
1635 __func__
, f
->frequency
* 625UL / 10UL, f
->frequency
);
1637 return v4l2_ctrl_s_ctrl_int64(s
->ctrl_tuner_rf
,
1638 f
->frequency
* 625UL / 10UL);
1641 const struct v4l2_ioctl_ops msi3101_ioctl_ops
= {
1642 .vidioc_querycap
= msi3101_querycap
,
1644 .vidioc_enum_input
= msi3101_enum_input
,
1645 .vidioc_g_input
= msi3101_g_input
,
1646 .vidioc_s_input
= msi3101_s_input
,
1648 .vidioc_reqbufs
= vb2_ioctl_reqbufs
,
1649 .vidioc_create_bufs
= vb2_ioctl_create_bufs
,
1650 .vidioc_prepare_buf
= vb2_ioctl_prepare_buf
,
1651 .vidioc_querybuf
= vb2_ioctl_querybuf
,
1652 .vidioc_qbuf
= vb2_ioctl_qbuf
,
1653 .vidioc_dqbuf
= vb2_ioctl_dqbuf
,
1655 .vidioc_streamon
= vb2_ioctl_streamon
,
1656 .vidioc_streamoff
= vb2_ioctl_streamoff
,
1658 .vidioc_g_tuner
= vidioc_g_tuner
,
1659 .vidioc_s_tuner
= vidioc_s_tuner
,
1660 .vidioc_s_frequency
= vidioc_s_frequency
,
1662 .vidioc_subscribe_event
= v4l2_ctrl_subscribe_event
,
1663 .vidioc_unsubscribe_event
= v4l2_event_unsubscribe
,
1664 .vidioc_log_status
= v4l2_ctrl_log_status
,
1667 static const struct v4l2_file_operations msi3101_fops
= {
1668 .owner
= THIS_MODULE
,
1669 .open
= v4l2_fh_open
,
1670 .release
= vb2_fop_release
,
1671 .read
= vb2_fop_read
,
1672 .poll
= vb2_fop_poll
,
1673 .mmap
= vb2_fop_mmap
,
1674 .unlocked_ioctl
= video_ioctl2
,
1677 static struct video_device msi3101_template
= {
1678 .name
= "Mirics MSi3101 SDR Dongle",
1679 .release
= video_device_release_empty
,
1680 .fops
= &msi3101_fops
,
1681 .ioctl_ops
= &msi3101_ioctl_ops
,
1684 static int msi3101_s_ctrl(struct v4l2_ctrl
*ctrl
)
1686 struct msi3101_state
*s
=
1687 container_of(ctrl
->handler
, struct msi3101_state
,
1690 dev_dbg(&s
->udev
->dev
,
1691 "%s: id=%d name=%s val=%d min=%d max=%d step=%d\n",
1692 __func__
, ctrl
->id
, ctrl
->name
, ctrl
->val
,
1693 ctrl
->minimum
, ctrl
->maximum
, ctrl
->step
);
1696 case MSI3101_CID_SAMPLING_MODE
:
1697 case MSI3101_CID_SAMPLING_RATE
:
1698 case MSI3101_CID_SAMPLING_RESOLUTION
:
1701 case MSI3101_CID_TUNER_RF
:
1702 case MSI3101_CID_TUNER_BW
:
1703 case MSI3101_CID_TUNER_IF
:
1704 case MSI3101_CID_TUNER_GAIN
:
1705 ret
= msi3101_set_tuner(s
);
1714 static const struct v4l2_ctrl_ops msi3101_ctrl_ops
= {
1715 .s_ctrl
= msi3101_s_ctrl
,
1718 static void msi3101_video_release(struct v4l2_device
*v
)
1720 struct msi3101_state
*s
=
1721 container_of(v
, struct msi3101_state
, v4l2_dev
);
1723 v4l2_ctrl_handler_free(&s
->ctrl_handler
);
1724 v4l2_device_unregister(&s
->v4l2_dev
);
1728 static int msi3101_probe(struct usb_interface
*intf
,
1729 const struct usb_device_id
*id
)
1731 struct usb_device
*udev
= interface_to_usbdev(intf
);
1732 struct msi3101_state
*s
= NULL
;
1734 static const char * const ctrl_sampling_mode_qmenu_strings
[] = {
1735 "Quadrature Sampling",
1738 static const struct v4l2_ctrl_config ctrl_sampling_mode
= {
1739 .ops
= &msi3101_ctrl_ops
,
1740 .id
= MSI3101_CID_SAMPLING_MODE
,
1741 .type
= V4L2_CTRL_TYPE_MENU
,
1742 .flags
= V4L2_CTRL_FLAG_INACTIVE
,
1743 .name
= "Sampling Mode",
1744 .qmenu
= ctrl_sampling_mode_qmenu_strings
,
1746 static const struct v4l2_ctrl_config ctrl_sampling_rate
= {
1747 .ops
= &msi3101_ctrl_ops
,
1748 .id
= MSI3101_CID_SAMPLING_RATE
,
1749 .type
= V4L2_CTRL_TYPE_INTEGER64
,
1750 .name
= "Sampling Rate",
1756 static const struct v4l2_ctrl_config ctrl_sampling_resolution
= {
1757 .ops
= &msi3101_ctrl_ops
,
1758 .id
= MSI3101_CID_SAMPLING_RESOLUTION
,
1759 .type
= V4L2_CTRL_TYPE_INTEGER
,
1760 .flags
= V4L2_CTRL_FLAG_INACTIVE
,
1761 .name
= "Sampling Resolution",
1767 static const struct v4l2_ctrl_config ctrl_tuner_rf
= {
1768 .ops
= &msi3101_ctrl_ops
,
1769 .id
= MSI3101_CID_TUNER_RF
,
1770 .type
= V4L2_CTRL_TYPE_INTEGER64
,
1777 static const struct v4l2_ctrl_config ctrl_tuner_bw
= {
1778 .ops
= &msi3101_ctrl_ops
,
1779 .id
= MSI3101_CID_TUNER_BW
,
1780 .type
= V4L2_CTRL_TYPE_INTEGER
,
1787 static const struct v4l2_ctrl_config ctrl_tuner_if
= {
1788 .ops
= &msi3101_ctrl_ops
,
1789 .id
= MSI3101_CID_TUNER_IF
,
1790 .type
= V4L2_CTRL_TYPE_INTEGER
,
1791 .flags
= V4L2_CTRL_FLAG_INACTIVE
,
1798 static const struct v4l2_ctrl_config ctrl_tuner_gain
= {
1799 .ops
= &msi3101_ctrl_ops
,
1800 .id
= MSI3101_CID_TUNER_GAIN
,
1801 .type
= V4L2_CTRL_TYPE_INTEGER
,
1802 .name
= "Tuner Gain",
1809 s
= kzalloc(sizeof(struct msi3101_state
), GFP_KERNEL
);
1811 pr_err("Could not allocate memory for msi3101_state\n");
1815 mutex_init(&s
->v4l2_lock
);
1816 mutex_init(&s
->vb_queue_lock
);
1817 spin_lock_init(&s
->queued_bufs_lock
);
1818 INIT_LIST_HEAD(&s
->queued_bufs
);
1822 /* Init videobuf2 queue structure */
1823 s
->vb_queue
.type
= V4L2_BUF_TYPE_VIDEO_CAPTURE
;
1824 s
->vb_queue
.io_modes
= VB2_MMAP
| VB2_USERPTR
| VB2_READ
;
1825 s
->vb_queue
.drv_priv
= s
;
1826 s
->vb_queue
.buf_struct_size
= sizeof(struct msi3101_frame_buf
);
1827 s
->vb_queue
.ops
= &msi3101_vb2_ops
;
1828 s
->vb_queue
.mem_ops
= &vb2_vmalloc_memops
;
1829 s
->vb_queue
.timestamp_type
= V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC
;
1830 ret
= vb2_queue_init(&s
->vb_queue
);
1832 dev_err(&s
->udev
->dev
, "Could not initialize vb2 queue\n");
1836 /* Init video_device structure */
1837 s
->vdev
= msi3101_template
;
1838 s
->vdev
.queue
= &s
->vb_queue
;
1839 s
->vdev
.queue
->lock
= &s
->vb_queue_lock
;
1840 set_bit(V4L2_FL_USE_FH_PRIO
, &s
->vdev
.flags
);
1841 video_set_drvdata(&s
->vdev
, s
);
1843 /* Register controls */
1844 v4l2_ctrl_handler_init(&s
->ctrl_handler
, 7);
1845 v4l2_ctrl_new_custom(&s
->ctrl_handler
, &ctrl_sampling_mode
, NULL
);
1846 s
->ctrl_sampling_rate
= v4l2_ctrl_new_custom(&s
->ctrl_handler
, &ctrl_sampling_rate
, NULL
);
1847 v4l2_ctrl_new_custom(&s
->ctrl_handler
, &ctrl_sampling_resolution
, NULL
);
1848 s
->ctrl_tuner_rf
= v4l2_ctrl_new_custom(&s
->ctrl_handler
, &ctrl_tuner_rf
, NULL
);
1849 s
->ctrl_tuner_bw
= v4l2_ctrl_new_custom(&s
->ctrl_handler
, &ctrl_tuner_bw
, NULL
);
1850 s
->ctrl_tuner_if
= v4l2_ctrl_new_custom(&s
->ctrl_handler
, &ctrl_tuner_if
, NULL
);
1851 s
->ctrl_tuner_gain
= v4l2_ctrl_new_custom(&s
->ctrl_handler
, &ctrl_tuner_gain
, NULL
);
1852 if (s
->ctrl_handler
.error
) {
1853 ret
= s
->ctrl_handler
.error
;
1854 dev_err(&s
->udev
->dev
, "Could not initialize controls\n");
1855 goto err_free_controls
;
1858 /* Register the v4l2_device structure */
1859 s
->v4l2_dev
.release
= msi3101_video_release
;
1860 ret
= v4l2_device_register(&intf
->dev
, &s
->v4l2_dev
);
1862 dev_err(&s
->udev
->dev
,
1863 "Failed to register v4l2-device (%d)\n", ret
);
1864 goto err_free_controls
;
1867 s
->v4l2_dev
.ctrl_handler
= &s
->ctrl_handler
;
1868 s
->vdev
.v4l2_dev
= &s
->v4l2_dev
;
1869 s
->vdev
.lock
= &s
->v4l2_lock
;
1871 ret
= video_register_device(&s
->vdev
, VFL_TYPE_GRABBER
, -1);
1873 dev_err(&s
->udev
->dev
,
1874 "Failed to register as video device (%d)\n",
1876 goto err_unregister_v4l2_dev
;
1878 dev_info(&s
->udev
->dev
, "Registered as %s\n",
1879 video_device_node_name(&s
->vdev
));
1883 err_unregister_v4l2_dev
:
1884 v4l2_device_unregister(&s
->v4l2_dev
);
1886 v4l2_ctrl_handler_free(&s
->ctrl_handler
);
1892 /* USB device ID list */
1893 static struct usb_device_id msi3101_id_table
[] = {
1894 { USB_DEVICE(0x1df7, 0x2500) }, /* Mirics MSi3101 SDR Dongle */
1895 { USB_DEVICE(0x2040, 0xd300) }, /* Hauppauge WinTV 133559 LF */
1898 MODULE_DEVICE_TABLE(usb
, msi3101_id_table
);
1900 /* USB subsystem interface */
1901 static struct usb_driver msi3101_driver
= {
1902 .name
= KBUILD_MODNAME
,
1903 .probe
= msi3101_probe
,
1904 .disconnect
= msi3101_disconnect
,
1905 .id_table
= msi3101_id_table
,
1908 module_usb_driver(msi3101_driver
);
1910 MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>");
1911 MODULE_DESCRIPTION("Mirics MSi3101 SDR Dongle");
1912 MODULE_LICENSE("GPL");