aboutsummaryrefslogtreecommitdiffstats
diff options
context:
space:
mode:
-rw-r--r--drivers/media/radio/radio-si470x.c122
1 files changed, 67 insertions, 55 deletions
diff --git a/drivers/media/radio/radio-si470x.c b/drivers/media/radio/radio-si470x.c
index 8743a521e4af..dfaaa467c043 100644
--- a/drivers/media/radio/radio-si470x.c
+++ b/drivers/media/radio/radio-si470x.c
@@ -481,7 +481,7 @@ struct si470x_device {
481 481
482 482
483/************************************************************************** 483/**************************************************************************
484 * General Driver Functions 484 * General Driver Functions - REGISTER_REPORTs
485 **************************************************************************/ 485 **************************************************************************/
486 486
487/* 487/*
@@ -567,60 +567,6 @@ static int si470x_set_register(struct si470x_device *radio, int regnr)
567 567
568 568
569/* 569/*
570 * si470x_get_all_registers - read entire registers
571 */
572static int si470x_get_all_registers(struct si470x_device *radio)
573{
574 unsigned char buf[ENTIRE_REPORT_SIZE];
575 int retval;
576 unsigned char regnr;
577
578 buf[0] = ENTIRE_REPORT;
579
580 retval = si470x_get_report(radio, (void *) &buf, sizeof(buf));
581
582 if (retval >= 0)
583 for (regnr = 0; regnr < RADIO_REGISTER_NUM; regnr++)
584 radio->registers[regnr] = get_unaligned_be16(
585 &buf[regnr * RADIO_REGISTER_SIZE + 1]);
586
587 return (retval < 0) ? -EINVAL : 0;
588}
589
590
591/*
592 * si470x_get_rds_registers - read rds registers
593 */
594static int si470x_get_rds_registers(struct si470x_device *radio)
595{
596 unsigned char buf[RDS_REPORT_SIZE];
597 int retval;
598 int size;
599 unsigned char regnr;
600
601 buf[0] = RDS_REPORT;
602
603 retval = usb_interrupt_msg(radio->usbdev,
604 usb_rcvintpipe(radio->usbdev, 1),
605 (void *) &buf, sizeof(buf), &size, usb_timeout);
606 if (size != sizeof(buf))
607 printk(KERN_WARNING DRIVER_NAME ": si470x_get_rds_registers: "
608 "return size differs: %d != %zu\n", size, sizeof(buf));
609 if (retval < 0)
610 printk(KERN_WARNING DRIVER_NAME ": si470x_get_rds_registers: "
611 "usb_interrupt_msg returned %d\n", retval);
612
613 if (retval >= 0)
614 for (regnr = 0; regnr < RDS_REGISTER_NUM; regnr++)
615 radio->registers[STATUSRSSI + regnr] =
616 get_unaligned_be16(
617 &buf[regnr * RADIO_REGISTER_SIZE + 1]);
618
619 return (retval < 0) ? -EINVAL : 0;
620}
621
622
623/*
624 * si470x_set_chan - set the channel 570 * si470x_set_chan - set the channel
625 */ 571 */
626static int si470x_set_chan(struct si470x_device *radio, unsigned short chan) 572static int si470x_set_chan(struct si470x_device *radio, unsigned short chan)
@@ -912,6 +858,70 @@ static int si470x_set_led_state(struct si470x_device *radio,
912 858
913 859
914/************************************************************************** 860/**************************************************************************
861 * General Driver Functions - ENTIRE_REPORT
862 **************************************************************************/
863
864/*
865 * si470x_get_all_registers - read entire registers
866 */
867static int si470x_get_all_registers(struct si470x_device *radio)
868{
869 unsigned char buf[ENTIRE_REPORT_SIZE];
870 int retval;
871 unsigned char regnr;
872
873 buf[0] = ENTIRE_REPORT;
874
875 retval = si470x_get_report(radio, (void *) &buf, sizeof(buf));
876
877 if (retval >= 0)
878 for (regnr = 0; regnr < RADIO_REGISTER_NUM; regnr++)
879 radio->registers[regnr] = get_unaligned_be16(
880 &buf[regnr * RADIO_REGISTER_SIZE + 1]);
881
882 return (retval < 0) ? -EINVAL : 0;
883}
884
885
886
887/**************************************************************************
888 * General Driver Functions - RDS_REPORT
889 **************************************************************************/
890
891/*
892 * si470x_get_rds_registers - read rds registers
893 */
894static int si470x_get_rds_registers(struct si470x_device *radio)
895{
896 unsigned char buf[RDS_REPORT_SIZE];
897 int retval;
898 int size;
899 unsigned char regnr;
900
901 buf[0] = RDS_REPORT;
902
903 retval = usb_interrupt_msg(radio->usbdev,
904 usb_rcvintpipe(radio->usbdev, 1),
905 (void *) &buf, sizeof(buf), &size, usb_timeout);
906 if (size != sizeof(buf))
907 printk(KERN_WARNING DRIVER_NAME ": si470x_get_rds_registers: "
908 "return size differs: %d != %zu\n", size, sizeof(buf));
909 if (retval < 0)
910 printk(KERN_WARNING DRIVER_NAME ": si470x_get_rds_registers: "
911 "usb_interrupt_msg returned %d\n", retval);
912
913 if (retval >= 0)
914 for (regnr = 0; regnr < RDS_REGISTER_NUM; regnr++)
915 radio->registers[STATUSRSSI + regnr] =
916 get_unaligned_be16(
917 &buf[regnr * RADIO_REGISTER_SIZE + 1]);
918
919 return (retval < 0) ? -EINVAL : 0;
920}
921
922
923
924/**************************************************************************
915 * RDS Driver Functions 925 * RDS Driver Functions
916 **************************************************************************/ 926 **************************************************************************/
917 927
@@ -1125,6 +1135,7 @@ static int si470x_fops_open(struct file *file)
1125 } 1135 }
1126 1136
1127 if (radio->users == 1) { 1137 if (radio->users == 1) {
1138 /* start radio */
1128 retval = si470x_start(radio); 1139 retval = si470x_start(radio);
1129 if (retval < 0) 1140 if (retval < 0)
1130 usb_autopm_put_interface(radio->intf); 1141 usb_autopm_put_interface(radio->intf);
@@ -1166,6 +1177,7 @@ static int si470x_fops_release(struct file *file)
1166 /* cancel read processes */ 1177 /* cancel read processes */
1167 wake_up_interruptible(&radio->read_queue); 1178 wake_up_interruptible(&radio->read_queue);
1168 1179
1180 /* stop radio */
1169 retval = si470x_stop(radio); 1181 retval = si470x_stop(radio);
1170 usb_autopm_put_interface(radio->intf); 1182 usb_autopm_put_interface(radio->intf);
1171 } 1183 }