forked from Minki/linux
V4L/DVB (7091): radio-si470x improvements and seldom problem fixed in tuning functions
I updated the radio-si470x driver another time. Here are the commented history entries: - number of seek_retries changed to tune_timeout The last versions checked for the end of frequency tuning by polling a si470x register. Therefore polling depended on the usb utilization. This was changed to have a constant timeout now. - fixed problem with incomplete tune operations by own buffers The last version used a shared buffer to assembly the USB HID reports. It sometimes happened, that multiple functions were modifing this buffer simultanuously. When sending such reports, the hardware returned USB stalls (-EPIPE). Now buffers of the correct size (smaller than before) are allocated as local variables. - optimization of variables The size of some variables has been reduced to allow the compiler to generate more optimized code. - improved error logging At some important location, error checking was improved. Especially the usb transfers to access si470x registers and the tuning functions were modified. Signed-off-by: Tobias Lorenz <tobias.lorenz@gmx.net> Signed-off-by: Mauro Carvalho Chehab <mchehab@infradead.org>
This commit is contained in:
parent
2de3a5a5c5
commit
0e3301ec23
@ -62,6 +62,12 @@
|
|||||||
* - code cleaned of unnecessary rds_commands
|
* - code cleaned of unnecessary rds_commands
|
||||||
* - USB Vendor/Product ID for ADS/Tech FM Radio Receiver verified
|
* - USB Vendor/Product ID for ADS/Tech FM Radio Receiver verified
|
||||||
* (thanks to Guillaume RAMOUSSE)
|
* (thanks to Guillaume RAMOUSSE)
|
||||||
|
* 2008-01-27 Tobias Lorenz <tobias.lorenz@gmx.net>
|
||||||
|
* Version 1.0.5
|
||||||
|
* - number of seek_retries changed to tune_timeout
|
||||||
|
* - fixed problem with incomplete tune operations by own buffers
|
||||||
|
* - optimization of variables
|
||||||
|
* - improved error logging
|
||||||
*
|
*
|
||||||
* ToDo:
|
* ToDo:
|
||||||
* - add seeking support
|
* - add seeking support
|
||||||
@ -74,9 +80,10 @@
|
|||||||
/* driver definitions */
|
/* driver definitions */
|
||||||
#define DRIVER_AUTHOR "Tobias Lorenz <tobias.lorenz@gmx.net>"
|
#define DRIVER_AUTHOR "Tobias Lorenz <tobias.lorenz@gmx.net>"
|
||||||
#define DRIVER_NAME "radio-si470x"
|
#define DRIVER_NAME "radio-si470x"
|
||||||
#define DRIVER_VERSION KERNEL_VERSION(1, 0, 4)
|
#define DRIVER_KERNEL_VERSION KERNEL_VERSION(1, 0, 5)
|
||||||
#define DRIVER_CARD "Silicon Labs Si470x FM Radio Receiver"
|
#define DRIVER_CARD "Silicon Labs Si470x FM Radio Receiver"
|
||||||
#define DRIVER_DESC "USB radio driver for Si470x FM Radio Receivers"
|
#define DRIVER_DESC "USB radio driver for Si470x FM Radio Receivers"
|
||||||
|
#define DRIVER_VERSION "1.0.5"
|
||||||
|
|
||||||
|
|
||||||
/* kernel includes */
|
/* kernel includes */
|
||||||
@ -119,56 +126,56 @@ MODULE_PARM_DESC(radio_nr, "Radio Nr");
|
|||||||
/* 0: 200 kHz (USA, Australia) */
|
/* 0: 200 kHz (USA, Australia) */
|
||||||
/* 1: 100 kHz (Europe, Japan) */
|
/* 1: 100 kHz (Europe, Japan) */
|
||||||
/* 2: 50 kHz */
|
/* 2: 50 kHz */
|
||||||
static int space = 2;
|
static unsigned short space = 2;
|
||||||
module_param(space, int, 0);
|
module_param(space, ushort, 0);
|
||||||
MODULE_PARM_DESC(radio_nr, "Spacing: 0=200kHz 1=100kHz *2=50kHz*");
|
MODULE_PARM_DESC(radio_nr, "Spacing: 0=200kHz 1=100kHz *2=50kHz*");
|
||||||
|
|
||||||
/* Bottom of Band (MHz) */
|
/* Bottom of Band (MHz) */
|
||||||
/* 0: 87.5 - 108 MHz (USA, Europe)*/
|
/* 0: 87.5 - 108 MHz (USA, Europe)*/
|
||||||
/* 1: 76 - 108 MHz (Japan wide band) */
|
/* 1: 76 - 108 MHz (Japan wide band) */
|
||||||
/* 2: 76 - 90 MHz (Japan) */
|
/* 2: 76 - 90 MHz (Japan) */
|
||||||
static int band = 1;
|
static unsigned short band = 1;
|
||||||
module_param(band, int, 0);
|
module_param(band, ushort, 0);
|
||||||
MODULE_PARM_DESC(radio_nr, "Band: 0=87.5..108MHz *1=76..108MHz* 2=76..90MHz");
|
MODULE_PARM_DESC(radio_nr, "Band: 0=87.5..108MHz *1=76..108MHz* 2=76..90MHz");
|
||||||
|
|
||||||
/* De-emphasis */
|
/* De-emphasis */
|
||||||
/* 0: 75 us (USA) */
|
/* 0: 75 us (USA) */
|
||||||
/* 1: 50 us (Europe, Australia, Japan) */
|
/* 1: 50 us (Europe, Australia, Japan) */
|
||||||
static int de = 1;
|
static unsigned short de = 1;
|
||||||
module_param(de, int, 0);
|
module_param(de, ushort, 0);
|
||||||
MODULE_PARM_DESC(radio_nr, "De-emphasis: 0=75us *1=50us*");
|
MODULE_PARM_DESC(radio_nr, "De-emphasis: 0=75us *1=50us*");
|
||||||
|
|
||||||
/* USB timeout */
|
/* USB timeout */
|
||||||
static int usb_timeout = 500;
|
static unsigned int usb_timeout = 500;
|
||||||
module_param(usb_timeout, int, 0);
|
module_param(usb_timeout, uint, 0);
|
||||||
MODULE_PARM_DESC(usb_timeout, "USB timeout (ms): *500*");
|
MODULE_PARM_DESC(usb_timeout, "USB timeout (ms): *500*");
|
||||||
|
|
||||||
/* Seek retries */
|
/* Tune timeout */
|
||||||
static int seek_retries = 100;
|
static unsigned int tune_timeout = 3000;
|
||||||
module_param(seek_retries, int, 0);
|
module_param(tune_timeout, uint, 0);
|
||||||
MODULE_PARM_DESC(seek_retries, "Seek retries: *100*");
|
MODULE_PARM_DESC(tune_timeout, "Tune timeout: *3000*");
|
||||||
|
|
||||||
/* RDS buffer blocks */
|
/* RDS buffer blocks */
|
||||||
static int rds_buf = 100;
|
static unsigned int rds_buf = 100;
|
||||||
module_param(rds_buf, int, 0);
|
module_param(rds_buf, uint, 0);
|
||||||
MODULE_PARM_DESC(rds_buf, "RDS buffer entries: *100*");
|
MODULE_PARM_DESC(rds_buf, "RDS buffer entries: *100*");
|
||||||
|
|
||||||
/* RDS maximum block errors */
|
/* RDS maximum block errors */
|
||||||
static int max_rds_errors = 1;
|
static unsigned short max_rds_errors = 1;
|
||||||
/* 0 means 0 errors requiring correction */
|
/* 0 means 0 errors requiring correction */
|
||||||
/* 1 means 1-2 errors requiring correction (used by original USBRadio.exe) */
|
/* 1 means 1-2 errors requiring correction (used by original USBRadio.exe) */
|
||||||
/* 2 means 3-5 errors requiring correction */
|
/* 2 means 3-5 errors requiring correction */
|
||||||
/* 3 means 6+ errors or errors in checkword, correction not possible */
|
/* 3 means 6+ errors or errors in checkword, correction not possible */
|
||||||
module_param(max_rds_errors, int, 0);
|
module_param(max_rds_errors, ushort, 0);
|
||||||
MODULE_PARM_DESC(max_rds_errors, "RDS maximum block errors: *1*");
|
MODULE_PARM_DESC(max_rds_errors, "RDS maximum block errors: *1*");
|
||||||
|
|
||||||
/* RDS poll frequency */
|
/* RDS poll frequency */
|
||||||
static int rds_poll_time = 40;
|
static unsigned int rds_poll_time = 40;
|
||||||
/* 40 is used by the original USBRadio.exe */
|
/* 40 is used by the original USBRadio.exe */
|
||||||
/* 50 is used by radio-cadet */
|
/* 50 is used by radio-cadet */
|
||||||
/* 75 should be okay */
|
/* 75 should be okay */
|
||||||
/* 80 is the usual RDS receive interval */
|
/* 80 is the usual RDS receive interval */
|
||||||
module_param(rds_poll_time, int, 0);
|
module_param(rds_poll_time, uint, 0);
|
||||||
MODULE_PARM_DESC(rds_poll_time, "RDS poll time (ms): *40*");
|
MODULE_PARM_DESC(rds_poll_time, "RDS poll time (ms): *40*");
|
||||||
|
|
||||||
|
|
||||||
@ -395,11 +402,8 @@ struct si470x_device {
|
|||||||
struct usb_device *usbdev;
|
struct usb_device *usbdev;
|
||||||
struct video_device *videodev;
|
struct video_device *videodev;
|
||||||
|
|
||||||
/* are these really necessary ? */
|
/* driver management */
|
||||||
int users;
|
unsigned int users;
|
||||||
|
|
||||||
/* report buffer (maximum 64 bytes) */
|
|
||||||
unsigned char buf[64];
|
|
||||||
|
|
||||||
/* Silabs internal registers (0..15) */
|
/* Silabs internal registers (0..15) */
|
||||||
unsigned short registers[RADIO_REGISTER_NUM];
|
unsigned short registers[RADIO_REGISTER_NUM];
|
||||||
@ -434,28 +438,46 @@ struct si470x_device {
|
|||||||
/*
|
/*
|
||||||
* si470x_get_report - receive a HID report
|
* si470x_get_report - receive a HID report
|
||||||
*/
|
*/
|
||||||
static int si470x_get_report(struct si470x_device *radio, int size)
|
static int si470x_get_report(struct si470x_device *radio, void *buf, int size)
|
||||||
{
|
{
|
||||||
return usb_control_msg(radio->usbdev,
|
unsigned char *report = (unsigned char *) buf;
|
||||||
|
int retval;
|
||||||
|
|
||||||
|
retval = usb_control_msg(radio->usbdev,
|
||||||
usb_rcvctrlpipe(radio->usbdev, 0),
|
usb_rcvctrlpipe(radio->usbdev, 0),
|
||||||
HID_REQ_GET_REPORT,
|
HID_REQ_GET_REPORT,
|
||||||
USB_TYPE_CLASS | USB_RECIP_INTERFACE | USB_DIR_IN,
|
USB_TYPE_CLASS | USB_RECIP_INTERFACE | USB_DIR_IN,
|
||||||
radio->buf[0], 2,
|
report[0], 2,
|
||||||
radio->buf, size, usb_timeout);
|
buf, size, usb_timeout);
|
||||||
|
if (retval < 0)
|
||||||
|
printk(KERN_WARNING DRIVER_NAME
|
||||||
|
": si470x_get_report: usb_control_msg returned %d\n",
|
||||||
|
retval);
|
||||||
|
|
||||||
|
return retval;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* si470x_set_report - send a HID report
|
* si470x_set_report - send a HID report
|
||||||
*/
|
*/
|
||||||
static int si470x_set_report(struct si470x_device *radio, int size)
|
static int si470x_set_report(struct si470x_device *radio, void *buf, int size)
|
||||||
{
|
{
|
||||||
return usb_control_msg(radio->usbdev,
|
unsigned char *report = (unsigned char *) buf;
|
||||||
|
int retval;
|
||||||
|
|
||||||
|
retval = usb_control_msg(radio->usbdev,
|
||||||
usb_sndctrlpipe(radio->usbdev, 0),
|
usb_sndctrlpipe(radio->usbdev, 0),
|
||||||
HID_REQ_SET_REPORT,
|
HID_REQ_SET_REPORT,
|
||||||
USB_TYPE_CLASS | USB_RECIP_INTERFACE | USB_DIR_OUT,
|
USB_TYPE_CLASS | USB_RECIP_INTERFACE | USB_DIR_OUT,
|
||||||
radio->buf[0], 2,
|
report[0], 2,
|
||||||
radio->buf, size, usb_timeout);
|
buf, size, usb_timeout);
|
||||||
|
if (retval < 0)
|
||||||
|
printk(KERN_WARNING DRIVER_NAME
|
||||||
|
": si470x_set_report: usb_control_msg returned %d\n",
|
||||||
|
retval);
|
||||||
|
|
||||||
|
return retval;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
@ -464,13 +486,15 @@ static int si470x_set_report(struct si470x_device *radio, int size)
|
|||||||
*/
|
*/
|
||||||
static int si470x_get_register(struct si470x_device *radio, int regnr)
|
static int si470x_get_register(struct si470x_device *radio, int regnr)
|
||||||
{
|
{
|
||||||
|
unsigned char buf[REGISTER_REPORT_SIZE];
|
||||||
int retval;
|
int retval;
|
||||||
|
|
||||||
radio->buf[0] = REGISTER_REPORT(regnr);
|
buf[0] = REGISTER_REPORT(regnr);
|
||||||
|
|
||||||
|
retval = si470x_get_report(radio, (void *) &buf, sizeof(buf));
|
||||||
|
|
||||||
retval = si470x_get_report(radio, REGISTER_REPORT_SIZE);
|
|
||||||
if (retval >= 0)
|
if (retval >= 0)
|
||||||
radio->registers[regnr] = (radio->buf[1] << 8) | radio->buf[2];
|
radio->registers[regnr] = (buf[1] << 8) | buf[2];
|
||||||
|
|
||||||
return (retval < 0) ? -EINVAL : 0;
|
return (retval < 0) ? -EINVAL : 0;
|
||||||
}
|
}
|
||||||
@ -481,13 +505,14 @@ static int si470x_get_register(struct si470x_device *radio, int regnr)
|
|||||||
*/
|
*/
|
||||||
static int si470x_set_register(struct si470x_device *radio, int regnr)
|
static int si470x_set_register(struct si470x_device *radio, int regnr)
|
||||||
{
|
{
|
||||||
|
unsigned char buf[REGISTER_REPORT_SIZE];
|
||||||
int retval;
|
int retval;
|
||||||
|
|
||||||
radio->buf[0] = REGISTER_REPORT(regnr);
|
buf[0] = REGISTER_REPORT(regnr);
|
||||||
radio->buf[1] = (radio->registers[regnr] & 0xff00) >> 8;
|
buf[1] = (radio->registers[regnr] & 0xff00) >> 8;
|
||||||
radio->buf[2] = (radio->registers[regnr] & 0x00ff);
|
buf[2] = (radio->registers[regnr] & 0x00ff);
|
||||||
|
|
||||||
retval = si470x_set_report(radio, REGISTER_REPORT_SIZE);
|
retval = si470x_set_report(radio, (void *) &buf, sizeof(buf));
|
||||||
|
|
||||||
return (retval < 0) ? -EINVAL : 0;
|
return (retval < 0) ? -EINVAL : 0;
|
||||||
}
|
}
|
||||||
@ -498,18 +523,19 @@ static int si470x_set_register(struct si470x_device *radio, int regnr)
|
|||||||
*/
|
*/
|
||||||
static int si470x_get_all_registers(struct si470x_device *radio)
|
static int si470x_get_all_registers(struct si470x_device *radio)
|
||||||
{
|
{
|
||||||
|
unsigned char buf[ENTIRE_REPORT_SIZE];
|
||||||
int retval;
|
int retval;
|
||||||
int regnr;
|
unsigned char regnr;
|
||||||
|
|
||||||
radio->buf[0] = ENTIRE_REPORT;
|
buf[0] = ENTIRE_REPORT;
|
||||||
|
|
||||||
retval = si470x_get_report(radio, ENTIRE_REPORT_SIZE);
|
retval = si470x_get_report(radio, (void *) &buf, sizeof(buf));
|
||||||
|
|
||||||
if (retval >= 0)
|
if (retval >= 0)
|
||||||
for (regnr = 0; regnr < RADIO_REGISTER_NUM; regnr++)
|
for (regnr = 0; regnr < RADIO_REGISTER_NUM; regnr++)
|
||||||
radio->registers[regnr] =
|
radio->registers[regnr] =
|
||||||
(radio->buf[regnr * RADIO_REGISTER_SIZE + 1] << 8) |
|
(buf[regnr * RADIO_REGISTER_SIZE + 1] << 8) |
|
||||||
radio->buf[regnr * RADIO_REGISTER_SIZE + 2];
|
buf[regnr * RADIO_REGISTER_SIZE + 2];
|
||||||
|
|
||||||
return (retval < 0) ? -EINVAL : 0;
|
return (retval < 0) ? -EINVAL : 0;
|
||||||
}
|
}
|
||||||
@ -520,21 +546,28 @@ static int si470x_get_all_registers(struct si470x_device *radio)
|
|||||||
*/
|
*/
|
||||||
static int si470x_get_rds_registers(struct si470x_device *radio)
|
static int si470x_get_rds_registers(struct si470x_device *radio)
|
||||||
{
|
{
|
||||||
|
unsigned char buf[RDS_REPORT_SIZE];
|
||||||
int retval;
|
int retval;
|
||||||
int regnr;
|
|
||||||
int size;
|
int size;
|
||||||
|
unsigned char regnr;
|
||||||
|
|
||||||
radio->buf[0] = RDS_REPORT;
|
buf[0] = RDS_REPORT;
|
||||||
|
|
||||||
retval = usb_interrupt_msg(radio->usbdev,
|
retval = usb_interrupt_msg(radio->usbdev,
|
||||||
usb_rcvctrlpipe(radio->usbdev, 1),
|
usb_rcvintpipe(radio->usbdev, 1),
|
||||||
radio->buf, RDS_REPORT_SIZE, &size, usb_timeout);
|
(void *) &buf, sizeof(buf), &size, usb_timeout);
|
||||||
|
if (size != sizeof(buf))
|
||||||
|
printk(KERN_WARNING DRIVER_NAME ": si470x_get_rds_register: "
|
||||||
|
"return size differs: %d != %d\n", size, sizeof(buf));
|
||||||
|
if (retval < 0)
|
||||||
|
printk(KERN_WARNING DRIVER_NAME ": si470x_get_rds_registers: "
|
||||||
|
"usb_interrupt_msg returned %d\n", retval);
|
||||||
|
|
||||||
if (retval >= 0)
|
if (retval >= 0)
|
||||||
for (regnr = 0; regnr < RDS_REGISTER_NUM; regnr++)
|
for (regnr = 0; regnr < RDS_REGISTER_NUM; regnr++)
|
||||||
radio->registers[STATUSRSSI + regnr] =
|
radio->registers[STATUSRSSI + regnr] =
|
||||||
(radio->buf[regnr * RADIO_REGISTER_SIZE + 1] << 8) |
|
(buf[regnr * RADIO_REGISTER_SIZE + 1] << 8) |
|
||||||
radio->buf[regnr * RADIO_REGISTER_SIZE + 2];
|
buf[regnr * RADIO_REGISTER_SIZE + 2];
|
||||||
|
|
||||||
return (retval < 0) ? -EINVAL : 0;
|
return (retval < 0) ? -EINVAL : 0;
|
||||||
}
|
}
|
||||||
@ -543,9 +576,11 @@ static int si470x_get_rds_registers(struct si470x_device *radio)
|
|||||||
/*
|
/*
|
||||||
* si470x_set_chan - set the channel
|
* si470x_set_chan - set the channel
|
||||||
*/
|
*/
|
||||||
static int si470x_set_chan(struct si470x_device *radio, int chan)
|
static int si470x_set_chan(struct si470x_device *radio, unsigned short chan)
|
||||||
{
|
{
|
||||||
int retval, i;
|
int retval;
|
||||||
|
unsigned long timeout;
|
||||||
|
bool timed_out = 0;
|
||||||
|
|
||||||
/* start tuning */
|
/* start tuning */
|
||||||
radio->registers[CHANNEL] &= ~CHANNEL_CHAN;
|
radio->registers[CHANNEL] &= ~CHANNEL_CHAN;
|
||||||
@ -555,16 +590,17 @@ static int si470x_set_chan(struct si470x_device *radio, int chan)
|
|||||||
return retval;
|
return retval;
|
||||||
|
|
||||||
/* wait till seek operation has completed */
|
/* wait till seek operation has completed */
|
||||||
i = 0;
|
timeout = jiffies + msecs_to_jiffies(tune_timeout);
|
||||||
do {
|
do {
|
||||||
retval = si470x_get_register(radio, STATUSRSSI);
|
retval = si470x_get_register(radio, STATUSRSSI);
|
||||||
if (retval < 0)
|
if (retval < 0)
|
||||||
return retval;
|
return retval;
|
||||||
} while ((radio->registers[STATUSRSSI] & STATUSRSSI_STC) &&
|
timed_out = time_after(jiffies, timeout);
|
||||||
(++i < seek_retries));
|
} while (((radio->registers[STATUSRSSI] & STATUSRSSI_STC) == 0) &&
|
||||||
if (i >= seek_retries)
|
(!timed_out));
|
||||||
|
if (timed_out)
|
||||||
printk(KERN_WARNING DRIVER_NAME
|
printk(KERN_WARNING DRIVER_NAME
|
||||||
": seek does not finish after %d tries\n", i);
|
": seek does not finish after %d ms\n", tune_timeout);
|
||||||
|
|
||||||
/* stop tuning */
|
/* stop tuning */
|
||||||
radio->registers[CHANNEL] &= ~CHANNEL_TUNE;
|
radio->registers[CHANNEL] &= ~CHANNEL_TUNE;
|
||||||
@ -575,9 +611,10 @@ static int si470x_set_chan(struct si470x_device *radio, int chan)
|
|||||||
/*
|
/*
|
||||||
* si470x_get_freq - get the frequency
|
* si470x_get_freq - get the frequency
|
||||||
*/
|
*/
|
||||||
static int si470x_get_freq(struct si470x_device *radio)
|
static unsigned int si470x_get_freq(struct si470x_device *radio)
|
||||||
{
|
{
|
||||||
int spacing, band_bottom, chan, freq;
|
unsigned int spacing, band_bottom, freq;
|
||||||
|
unsigned short chan;
|
||||||
int retval;
|
int retval;
|
||||||
|
|
||||||
/* Spacing (kHz) */
|
/* Spacing (kHz) */
|
||||||
@ -616,9 +653,10 @@ static int si470x_get_freq(struct si470x_device *radio)
|
|||||||
/*
|
/*
|
||||||
* si470x_set_freq - set the frequency
|
* si470x_set_freq - set the frequency
|
||||||
*/
|
*/
|
||||||
static int si470x_set_freq(struct si470x_device *radio, int freq)
|
static int si470x_set_freq(struct si470x_device *radio, unsigned int freq)
|
||||||
{
|
{
|
||||||
int spacing, band_bottom, chan;
|
unsigned int spacing, band_bottom;
|
||||||
|
unsigned short chan;
|
||||||
|
|
||||||
/* Spacing (kHz) */
|
/* Spacing (kHz) */
|
||||||
switch (space) {
|
switch (space) {
|
||||||
@ -725,12 +763,6 @@ static int si470x_rds_on(struct si470x_device *radio)
|
|||||||
*/
|
*/
|
||||||
static void si470x_rds(struct si470x_device *radio)
|
static void si470x_rds(struct si470x_device *radio)
|
||||||
{
|
{
|
||||||
unsigned char tmpbuf[3];
|
|
||||||
unsigned char blocknum;
|
|
||||||
unsigned char bler; /* rds block errors */
|
|
||||||
unsigned short rds;
|
|
||||||
unsigned int i;
|
|
||||||
|
|
||||||
/* get rds blocks */
|
/* get rds blocks */
|
||||||
if (si470x_get_rds_registers(radio) < 0)
|
if (si470x_get_rds_registers(radio) < 0)
|
||||||
return;
|
return;
|
||||||
@ -745,6 +777,12 @@ static void si470x_rds(struct si470x_device *radio)
|
|||||||
|
|
||||||
/* copy four RDS blocks to internal buffer */
|
/* copy four RDS blocks to internal buffer */
|
||||||
if (spin_trylock(&radio->lock)) {
|
if (spin_trylock(&radio->lock)) {
|
||||||
|
unsigned char blocknum;
|
||||||
|
unsigned short bler; /* rds block errors */
|
||||||
|
unsigned short rds;
|
||||||
|
unsigned char tmpbuf[3];
|
||||||
|
unsigned char i;
|
||||||
|
|
||||||
/* process each rds block */
|
/* process each rds block */
|
||||||
for (blocknum = 0; blocknum < 4; blocknum++) {
|
for (blocknum = 0; blocknum < 4; blocknum++) {
|
||||||
switch (blocknum) {
|
switch (blocknum) {
|
||||||
@ -847,7 +885,6 @@ static ssize_t si470x_fops_read(struct file *file, char __user *buf,
|
|||||||
{
|
{
|
||||||
struct si470x_device *radio = video_get_drvdata(video_devdata(file));
|
struct si470x_device *radio = video_get_drvdata(video_devdata(file));
|
||||||
int retval = 0;
|
int retval = 0;
|
||||||
unsigned int block_count = 0;
|
|
||||||
|
|
||||||
/* switch on rds reception */
|
/* switch on rds reception */
|
||||||
if ((radio->registers[SYSCONFIG1] & SYSCONFIG1_RDS) == 0) {
|
if ((radio->registers[SYSCONFIG1] & SYSCONFIG1_RDS) == 0) {
|
||||||
@ -867,6 +904,7 @@ static ssize_t si470x_fops_read(struct file *file, char __user *buf,
|
|||||||
|
|
||||||
/* copy RDS block out of internal buffer and to user buffer */
|
/* copy RDS block out of internal buffer and to user buffer */
|
||||||
if (spin_trylock(&radio->lock)) {
|
if (spin_trylock(&radio->lock)) {
|
||||||
|
unsigned int block_count = 0;
|
||||||
while (block_count < count) {
|
while (block_count < count) {
|
||||||
if (radio->rd_index == radio->wr_index)
|
if (radio->rd_index == radio->wr_index)
|
||||||
break;
|
break;
|
||||||
@ -1030,7 +1068,7 @@ static int si470x_vidioc_querycap(struct file *file, void *priv,
|
|||||||
strlcpy(capability->driver, DRIVER_NAME, sizeof(capability->driver));
|
strlcpy(capability->driver, DRIVER_NAME, sizeof(capability->driver));
|
||||||
strlcpy(capability->card, DRIVER_CARD, sizeof(capability->card));
|
strlcpy(capability->card, DRIVER_CARD, sizeof(capability->card));
|
||||||
sprintf(capability->bus_info, "USB");
|
sprintf(capability->bus_info, "USB");
|
||||||
capability->version = DRIVER_VERSION;
|
capability->version = DRIVER_KERNEL_VERSION;
|
||||||
capability->capabilities = V4L2_CAP_TUNER | V4L2_CAP_RADIO;
|
capability->capabilities = V4L2_CAP_TUNER | V4L2_CAP_RADIO;
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
@ -1067,16 +1105,21 @@ static int si470x_vidioc_s_input(struct file *filp, void *priv, unsigned int i)
|
|||||||
static int si470x_vidioc_queryctrl(struct file *file, void *priv,
|
static int si470x_vidioc_queryctrl(struct file *file, void *priv,
|
||||||
struct v4l2_queryctrl *qc)
|
struct v4l2_queryctrl *qc)
|
||||||
{
|
{
|
||||||
int i;
|
unsigned char i;
|
||||||
|
int retval = -EINVAL;
|
||||||
|
|
||||||
for (i = 0; i < ARRAY_SIZE(si470x_v4l2_queryctrl); i++) {
|
for (i = 0; i < ARRAY_SIZE(si470x_v4l2_queryctrl); i++) {
|
||||||
if (qc->id && qc->id == si470x_v4l2_queryctrl[i].id) {
|
if (qc->id && qc->id == si470x_v4l2_queryctrl[i].id) {
|
||||||
memcpy(qc, &(si470x_v4l2_queryctrl[i]), sizeof(*qc));
|
memcpy(qc, &(si470x_v4l2_queryctrl[i]), sizeof(*qc));
|
||||||
return 0;
|
retval = 0;
|
||||||
|
break;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
if (retval < 0)
|
||||||
|
printk(KERN_WARNING DRIVER_NAME
|
||||||
|
": query control failed with %d\n", retval);
|
||||||
|
|
||||||
return -EINVAL;
|
return retval;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
@ -1110,21 +1153,29 @@ static int si470x_vidioc_s_ctrl(struct file *file, void *priv,
|
|||||||
struct v4l2_control *ctrl)
|
struct v4l2_control *ctrl)
|
||||||
{
|
{
|
||||||
struct si470x_device *radio = video_get_drvdata(video_devdata(file));
|
struct si470x_device *radio = video_get_drvdata(video_devdata(file));
|
||||||
|
int retval;
|
||||||
|
|
||||||
switch (ctrl->id) {
|
switch (ctrl->id) {
|
||||||
case V4L2_CID_AUDIO_VOLUME:
|
case V4L2_CID_AUDIO_VOLUME:
|
||||||
radio->registers[SYSCONFIG2] &= ~SYSCONFIG2_VOLUME;
|
radio->registers[SYSCONFIG2] &= ~SYSCONFIG2_VOLUME;
|
||||||
radio->registers[SYSCONFIG2] |= ctrl->value;
|
radio->registers[SYSCONFIG2] |= ctrl->value;
|
||||||
return si470x_set_register(radio, SYSCONFIG2);
|
retval = si470x_set_register(radio, SYSCONFIG2);
|
||||||
|
break;
|
||||||
case V4L2_CID_AUDIO_MUTE:
|
case V4L2_CID_AUDIO_MUTE:
|
||||||
if (ctrl->value == 1)
|
if (ctrl->value == 1)
|
||||||
radio->registers[POWERCFG] &= ~POWERCFG_DMUTE;
|
radio->registers[POWERCFG] &= ~POWERCFG_DMUTE;
|
||||||
else
|
else
|
||||||
radio->registers[POWERCFG] |= POWERCFG_DMUTE;
|
radio->registers[POWERCFG] |= POWERCFG_DMUTE;
|
||||||
return si470x_set_register(radio, POWERCFG);
|
retval = si470x_set_register(radio, POWERCFG);
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
retval = -EINVAL;
|
||||||
}
|
}
|
||||||
|
if (retval < 0)
|
||||||
|
printk(KERN_WARNING DRIVER_NAME
|
||||||
|
": set control failed with %d\n", retval);
|
||||||
|
|
||||||
return -EINVAL;
|
return retval;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
@ -1163,8 +1214,8 @@ static int si470x_vidioc_s_audio(struct file *file, void *priv,
|
|||||||
static int si470x_vidioc_g_tuner(struct file *file, void *priv,
|
static int si470x_vidioc_g_tuner(struct file *file, void *priv,
|
||||||
struct v4l2_tuner *tuner)
|
struct v4l2_tuner *tuner)
|
||||||
{
|
{
|
||||||
int retval;
|
|
||||||
struct si470x_device *radio = video_get_drvdata(video_devdata(file));
|
struct si470x_device *radio = video_get_drvdata(video_devdata(file));
|
||||||
|
int retval;
|
||||||
|
|
||||||
if (tuner->index > 0)
|
if (tuner->index > 0)
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
@ -1220,6 +1271,7 @@ static int si470x_vidioc_s_tuner(struct file *file, void *priv,
|
|||||||
struct v4l2_tuner *tuner)
|
struct v4l2_tuner *tuner)
|
||||||
{
|
{
|
||||||
struct si470x_device *radio = video_get_drvdata(video_devdata(file));
|
struct si470x_device *radio = video_get_drvdata(video_devdata(file));
|
||||||
|
int retval;
|
||||||
|
|
||||||
if (tuner->index > 0)
|
if (tuner->index > 0)
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
@ -1229,7 +1281,12 @@ static int si470x_vidioc_s_tuner(struct file *file, void *priv,
|
|||||||
else
|
else
|
||||||
radio->registers[POWERCFG] &= ~POWERCFG_MONO; /* try stereo */
|
radio->registers[POWERCFG] &= ~POWERCFG_MONO; /* try stereo */
|
||||||
|
|
||||||
return si470x_set_register(radio, POWERCFG);
|
retval = si470x_set_register(radio, POWERCFG);
|
||||||
|
if (retval < 0)
|
||||||
|
printk(KERN_WARNING DRIVER_NAME
|
||||||
|
": set tuner failed with %d\n", retval);
|
||||||
|
|
||||||
|
return retval;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
@ -1255,11 +1312,17 @@ static int si470x_vidioc_s_frequency(struct file *file, void *priv,
|
|||||||
struct v4l2_frequency *freq)
|
struct v4l2_frequency *freq)
|
||||||
{
|
{
|
||||||
struct si470x_device *radio = video_get_drvdata(video_devdata(file));
|
struct si470x_device *radio = video_get_drvdata(video_devdata(file));
|
||||||
|
int retval;
|
||||||
|
|
||||||
if (freq->type != V4L2_TUNER_RADIO)
|
if (freq->type != V4L2_TUNER_RADIO)
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
|
|
||||||
return si470x_set_freq(radio, freq->frequency);
|
retval = si470x_set_freq(radio, freq->frequency);
|
||||||
|
if (retval < 0)
|
||||||
|
printk(KERN_WARNING DRIVER_NAME
|
||||||
|
": set frequency failed with %d\n", retval);
|
||||||
|
|
||||||
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
@ -1409,7 +1472,7 @@ static struct usb_driver si470x_usb_driver = {
|
|||||||
*/
|
*/
|
||||||
static int __init si470x_module_init(void)
|
static int __init si470x_module_init(void)
|
||||||
{
|
{
|
||||||
printk(KERN_INFO DRIVER_DESC "\n");
|
printk(KERN_INFO DRIVER_DESC ", Version " DRIVER_VERSION "\n");
|
||||||
return usb_register(&si470x_usb_driver);
|
return usb_register(&si470x_usb_driver);
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -1429,4 +1492,4 @@ module_exit(si470x_module_exit);
|
|||||||
MODULE_LICENSE("GPL");
|
MODULE_LICENSE("GPL");
|
||||||
MODULE_AUTHOR(DRIVER_AUTHOR);
|
MODULE_AUTHOR(DRIVER_AUTHOR);
|
||||||
MODULE_DESCRIPTION(DRIVER_DESC);
|
MODULE_DESCRIPTION(DRIVER_DESC);
|
||||||
MODULE_VERSION("1.0.4");
|
MODULE_VERSION(DRIVER_VERSION);
|
||||||
|
Loading…
Reference in New Issue
Block a user