radio-si470x-usb.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869
  1. /*
  2. * drivers/media/radio/si470x/radio-si470x-usb.c
  3. *
  4. * USB driver for radios with Silicon Labs Si470x FM Radio Receivers
  5. *
  6. * Copyright (c) 2009 Tobias Lorenz <tobias.lorenz@gmx.net>
  7. *
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License as published by
  10. * the Free Software Foundation; either version 2 of the License, or
  11. * (at your option) any later version.
  12. *
  13. * This program is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16. * GNU General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU General Public License
  19. * along with this program; if not, write to the Free Software
  20. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  21. */
  22. /*
  23. * ToDo:
  24. * - add firmware download/update support
  25. */
  26. /* driver definitions */
  27. #define DRIVER_AUTHOR "Tobias Lorenz <tobias.lorenz@gmx.net>"
  28. #define DRIVER_CARD "Silicon Labs Si470x FM Radio Receiver"
  29. #define DRIVER_DESC "USB radio driver for Si470x FM Radio Receivers"
  30. #define DRIVER_VERSION "1.0.10"
  31. /* kernel includes */
  32. #include <linux/usb.h>
  33. #include <linux/hid.h>
  34. #include <linux/slab.h>
  35. #include "radio-si470x.h"
  36. /* USB Device ID List */
  37. static struct usb_device_id si470x_usb_driver_id_table[] = {
  38. /* Silicon Labs USB FM Radio Reference Design */
  39. { USB_DEVICE_AND_INTERFACE_INFO(0x10c4, 0x818a, USB_CLASS_HID, 0, 0) },
  40. /* ADS/Tech FM Radio Receiver (formerly Instant FM Music) */
  41. { USB_DEVICE_AND_INTERFACE_INFO(0x06e1, 0xa155, USB_CLASS_HID, 0, 0) },
  42. /* KWorld USB FM Radio SnapMusic Mobile 700 (FM700) */
  43. { USB_DEVICE_AND_INTERFACE_INFO(0x1b80, 0xd700, USB_CLASS_HID, 0, 0) },
  44. /* Sanei Electric, Inc. FM USB Radio (sold as DealExtreme.com PCear) */
  45. { USB_DEVICE_AND_INTERFACE_INFO(0x10c5, 0x819a, USB_CLASS_HID, 0, 0) },
  46. /* Terminating entry */
  47. { }
  48. };
  49. MODULE_DEVICE_TABLE(usb, si470x_usb_driver_id_table);
  50. /**************************************************************************
  51. * Module Parameters
  52. **************************************************************************/
  53. /* Radio Nr */
  54. static int radio_nr = -1;
  55. module_param(radio_nr, int, 0444);
  56. MODULE_PARM_DESC(radio_nr, "Radio Nr");
  57. /* USB timeout */
  58. static unsigned int usb_timeout = 500;
  59. module_param(usb_timeout, uint, 0644);
  60. MODULE_PARM_DESC(usb_timeout, "USB timeout (ms): *500*");
  61. /* RDS buffer blocks */
  62. static unsigned int rds_buf = 100;
  63. module_param(rds_buf, uint, 0444);
  64. MODULE_PARM_DESC(rds_buf, "RDS buffer entries: *100*");
  65. /* RDS maximum block errors */
  66. static unsigned short max_rds_errors = 1;
  67. /* 0 means 0 errors requiring correction */
  68. /* 1 means 1-2 errors requiring correction (used by original USBRadio.exe) */
  69. /* 2 means 3-5 errors requiring correction */
  70. /* 3 means 6+ errors or errors in checkword, correction not possible */
  71. module_param(max_rds_errors, ushort, 0644);
  72. MODULE_PARM_DESC(max_rds_errors, "RDS maximum block errors: *1*");
  73. /**************************************************************************
  74. * USB HID Reports
  75. **************************************************************************/
  76. /* Reports 1-16 give direct read/write access to the 16 Si470x registers */
  77. /* with the (REPORT_ID - 1) corresponding to the register address across USB */
  78. /* endpoint 0 using GET_REPORT and SET_REPORT */
  79. #define REGISTER_REPORT_SIZE (RADIO_REGISTER_SIZE + 1)
  80. #define REGISTER_REPORT(reg) ((reg) + 1)
  81. /* Report 17 gives direct read/write access to the entire Si470x register */
  82. /* map across endpoint 0 using GET_REPORT and SET_REPORT */
  83. #define ENTIRE_REPORT_SIZE (RADIO_REGISTER_NUM * RADIO_REGISTER_SIZE + 1)
  84. #define ENTIRE_REPORT 17
  85. /* Report 18 is used to send the lowest 6 Si470x registers up the HID */
  86. /* interrupt endpoint 1 to Windows every 20 milliseconds for status */
  87. #define RDS_REPORT_SIZE (RDS_REGISTER_NUM * RADIO_REGISTER_SIZE + 1)
  88. #define RDS_REPORT 18
  89. /* Report 19: LED state */
  90. #define LED_REPORT_SIZE 3
  91. #define LED_REPORT 19
  92. /* Report 19: stream */
  93. #define STREAM_REPORT_SIZE 3
  94. #define STREAM_REPORT 19
  95. /* Report 20: scratch */
  96. #define SCRATCH_PAGE_SIZE 63
  97. #define SCRATCH_REPORT_SIZE (SCRATCH_PAGE_SIZE + 1)
  98. #define SCRATCH_REPORT 20
  99. /* Reports 19-22: flash upgrade of the C8051F321 */
  100. #define WRITE_REPORT_SIZE 4
  101. #define WRITE_REPORT 19
  102. #define FLASH_REPORT_SIZE 64
  103. #define FLASH_REPORT 20
  104. #define CRC_REPORT_SIZE 3
  105. #define CRC_REPORT 21
  106. #define RESPONSE_REPORT_SIZE 2
  107. #define RESPONSE_REPORT 22
  108. /* Report 23: currently unused, but can accept 60 byte reports on the HID */
  109. /* interrupt out endpoint 2 every 1 millisecond */
  110. #define UNUSED_REPORT 23
  111. /**************************************************************************
  112. * Software/Hardware Versions from Scratch Page
  113. **************************************************************************/
  114. #define RADIO_SW_VERSION_NOT_BOOTLOADABLE 6
  115. #define RADIO_SW_VERSION 7
  116. #define RADIO_HW_VERSION 1
  117. /**************************************************************************
  118. * LED State Definitions
  119. **************************************************************************/
  120. #define LED_COMMAND 0x35
  121. #define NO_CHANGE_LED 0x00
  122. #define ALL_COLOR_LED 0x01 /* streaming state */
  123. #define BLINK_GREEN_LED 0x02 /* connect state */
  124. #define BLINK_RED_LED 0x04
  125. #define BLINK_ORANGE_LED 0x10 /* disconnect state */
  126. #define SOLID_GREEN_LED 0x20 /* tuning/seeking state */
  127. #define SOLID_RED_LED 0x40 /* bootload state */
  128. #define SOLID_ORANGE_LED 0x80
  129. /**************************************************************************
  130. * Stream State Definitions
  131. **************************************************************************/
  132. #define STREAM_COMMAND 0x36
  133. #define STREAM_VIDPID 0x00
  134. #define STREAM_AUDIO 0xff
  135. /**************************************************************************
  136. * Bootloader / Flash Commands
  137. **************************************************************************/
  138. /* unique id sent to bootloader and required to put into a bootload state */
  139. #define UNIQUE_BL_ID 0x34
  140. /* mask for the flash data */
  141. #define FLASH_DATA_MASK 0x55
  142. /* bootloader commands */
  143. #define GET_SW_VERSION_COMMAND 0x00
  144. #define SET_PAGE_COMMAND 0x01
  145. #define ERASE_PAGE_COMMAND 0x02
  146. #define WRITE_PAGE_COMMAND 0x03
  147. #define CRC_ON_PAGE_COMMAND 0x04
  148. #define READ_FLASH_BYTE_COMMAND 0x05
  149. #define RESET_DEVICE_COMMAND 0x06
  150. #define GET_HW_VERSION_COMMAND 0x07
  151. #define BLANK 0xff
  152. /* bootloader command responses */
  153. #define COMMAND_OK 0x01
  154. #define COMMAND_FAILED 0x02
  155. #define COMMAND_PENDING 0x03
  156. /**************************************************************************
  157. * General Driver Functions - REGISTER_REPORTs
  158. **************************************************************************/
  159. /*
  160. * si470x_get_report - receive a HID report
  161. */
  162. static int si470x_get_report(struct si470x_device *radio, void *buf, int size)
  163. {
  164. unsigned char *report = (unsigned char *) buf;
  165. int retval;
  166. retval = usb_control_msg(radio->usbdev,
  167. usb_rcvctrlpipe(radio->usbdev, 0),
  168. HID_REQ_GET_REPORT,
  169. USB_TYPE_CLASS | USB_RECIP_INTERFACE | USB_DIR_IN,
  170. report[0], 2,
  171. buf, size, usb_timeout);
  172. if (retval < 0)
  173. dev_warn(&radio->intf->dev,
  174. "si470x_get_report: usb_control_msg returned %d\n",
  175. retval);
  176. return retval;
  177. }
  178. /*
  179. * si470x_set_report - send a HID report
  180. */
  181. static int si470x_set_report(struct si470x_device *radio, void *buf, int size)
  182. {
  183. unsigned char *report = (unsigned char *) buf;
  184. int retval;
  185. retval = usb_control_msg(radio->usbdev,
  186. usb_sndctrlpipe(radio->usbdev, 0),
  187. HID_REQ_SET_REPORT,
  188. USB_TYPE_CLASS | USB_RECIP_INTERFACE | USB_DIR_OUT,
  189. report[0], 2,
  190. buf, size, usb_timeout);
  191. if (retval < 0)
  192. dev_warn(&radio->intf->dev,
  193. "si470x_set_report: usb_control_msg returned %d\n",
  194. retval);
  195. return retval;
  196. }
  197. /*
  198. * si470x_get_register - read register
  199. */
  200. int si470x_get_register(struct si470x_device *radio, int regnr)
  201. {
  202. unsigned char buf[REGISTER_REPORT_SIZE];
  203. int retval;
  204. buf[0] = REGISTER_REPORT(regnr);
  205. retval = si470x_get_report(radio, (void *) &buf, sizeof(buf));
  206. if (retval >= 0)
  207. radio->registers[regnr] = get_unaligned_be16(&buf[1]);
  208. return (retval < 0) ? -EINVAL : 0;
  209. }
  210. /*
  211. * si470x_set_register - write register
  212. */
  213. int si470x_set_register(struct si470x_device *radio, int regnr)
  214. {
  215. unsigned char buf[REGISTER_REPORT_SIZE];
  216. int retval;
  217. buf[0] = REGISTER_REPORT(regnr);
  218. put_unaligned_be16(radio->registers[regnr], &buf[1]);
  219. retval = si470x_set_report(radio, (void *) &buf, sizeof(buf));
  220. return (retval < 0) ? -EINVAL : 0;
  221. }
  222. /**************************************************************************
  223. * General Driver Functions - ENTIRE_REPORT
  224. **************************************************************************/
  225. /*
  226. * si470x_get_all_registers - read entire registers
  227. */
  228. static int si470x_get_all_registers(struct si470x_device *radio)
  229. {
  230. unsigned char buf[ENTIRE_REPORT_SIZE];
  231. int retval;
  232. unsigned char regnr;
  233. buf[0] = ENTIRE_REPORT;
  234. retval = si470x_get_report(radio, (void *) &buf, sizeof(buf));
  235. if (retval >= 0)
  236. for (regnr = 0; regnr < RADIO_REGISTER_NUM; regnr++)
  237. radio->registers[regnr] = get_unaligned_be16(
  238. &buf[regnr * RADIO_REGISTER_SIZE + 1]);
  239. return (retval < 0) ? -EINVAL : 0;
  240. }
  241. /**************************************************************************
  242. * General Driver Functions - LED_REPORT
  243. **************************************************************************/
  244. /*
  245. * si470x_set_led_state - sets the led state
  246. */
  247. static int si470x_set_led_state(struct si470x_device *radio,
  248. unsigned char led_state)
  249. {
  250. unsigned char buf[LED_REPORT_SIZE];
  251. int retval;
  252. buf[0] = LED_REPORT;
  253. buf[1] = LED_COMMAND;
  254. buf[2] = led_state;
  255. retval = si470x_set_report(radio, (void *) &buf, sizeof(buf));
  256. return (retval < 0) ? -EINVAL : 0;
  257. }
  258. /**************************************************************************
  259. * General Driver Functions - SCRATCH_REPORT
  260. **************************************************************************/
  261. /*
  262. * si470x_get_scratch_versions - gets the scratch page and version infos
  263. */
  264. static int si470x_get_scratch_page_versions(struct si470x_device *radio)
  265. {
  266. unsigned char buf[SCRATCH_REPORT_SIZE];
  267. int retval;
  268. buf[0] = SCRATCH_REPORT;
  269. retval = si470x_get_report(radio, (void *) &buf, sizeof(buf));
  270. if (retval < 0)
  271. dev_warn(&radio->intf->dev, "si470x_get_scratch: "
  272. "si470x_get_report returned %d\n", retval);
  273. else {
  274. radio->software_version = buf[1];
  275. radio->hardware_version = buf[2];
  276. }
  277. return (retval < 0) ? -EINVAL : 0;
  278. }
  279. /**************************************************************************
  280. * General Driver Functions - DISCONNECT_CHECK
  281. **************************************************************************/
  282. /*
  283. * si470x_disconnect_check - check whether radio disconnects
  284. */
  285. int si470x_disconnect_check(struct si470x_device *radio)
  286. {
  287. if (radio->disconnected)
  288. return -EIO;
  289. else
  290. return 0;
  291. }
  292. /**************************************************************************
  293. * RDS Driver Functions
  294. **************************************************************************/
  295. /*
  296. * si470x_int_in_callback - rds callback and processing function
  297. *
  298. * TODO: do we need to use mutex locks in some sections?
  299. */
  300. static void si470x_int_in_callback(struct urb *urb)
  301. {
  302. struct si470x_device *radio = urb->context;
  303. int retval;
  304. unsigned char regnr;
  305. unsigned char blocknum;
  306. unsigned short bler; /* rds block errors */
  307. unsigned short rds;
  308. unsigned char tmpbuf[3];
  309. if (urb->status) {
  310. if (urb->status == -ENOENT ||
  311. urb->status == -ECONNRESET ||
  312. urb->status == -ESHUTDOWN) {
  313. return;
  314. } else {
  315. dev_warn(&radio->intf->dev,
  316. "non-zero urb status (%d)\n", urb->status);
  317. goto resubmit; /* Maybe we can recover. */
  318. }
  319. }
  320. /* safety checks */
  321. if (radio->disconnected)
  322. return;
  323. if ((radio->registers[SYSCONFIG1] & SYSCONFIG1_RDS) == 0)
  324. goto resubmit;
  325. if (urb->actual_length > 0) {
  326. /* Update RDS registers with URB data */
  327. for (regnr = 0; regnr < RDS_REGISTER_NUM; regnr++)
  328. radio->registers[STATUSRSSI + regnr] =
  329. get_unaligned_be16(&radio->int_in_buffer[
  330. regnr * RADIO_REGISTER_SIZE + 1]);
  331. /* get rds blocks */
  332. if ((radio->registers[STATUSRSSI] & STATUSRSSI_RDSR) == 0) {
  333. /* No RDS group ready, better luck next time */
  334. goto resubmit;
  335. }
  336. if ((radio->registers[STATUSRSSI] & STATUSRSSI_RDSS) == 0) {
  337. /* RDS decoder not synchronized */
  338. goto resubmit;
  339. }
  340. for (blocknum = 0; blocknum < 4; blocknum++) {
  341. switch (blocknum) {
  342. default:
  343. bler = (radio->registers[STATUSRSSI] &
  344. STATUSRSSI_BLERA) >> 9;
  345. rds = radio->registers[RDSA];
  346. break;
  347. case 1:
  348. bler = (radio->registers[READCHAN] &
  349. READCHAN_BLERB) >> 14;
  350. rds = radio->registers[RDSB];
  351. break;
  352. case 2:
  353. bler = (radio->registers[READCHAN] &
  354. READCHAN_BLERC) >> 12;
  355. rds = radio->registers[RDSC];
  356. break;
  357. case 3:
  358. bler = (radio->registers[READCHAN] &
  359. READCHAN_BLERD) >> 10;
  360. rds = radio->registers[RDSD];
  361. break;
  362. };
  363. /* Fill the V4L2 RDS buffer */
  364. put_unaligned_le16(rds, &tmpbuf);
  365. tmpbuf[2] = blocknum; /* offset name */
  366. tmpbuf[2] |= blocknum << 3; /* received offset */
  367. if (bler > max_rds_errors)
  368. tmpbuf[2] |= 0x80; /* uncorrectable errors */
  369. else if (bler > 0)
  370. tmpbuf[2] |= 0x40; /* corrected error(s) */
  371. /* copy RDS block to internal buffer */
  372. memcpy(&radio->buffer[radio->wr_index], &tmpbuf, 3);
  373. radio->wr_index += 3;
  374. /* wrap write pointer */
  375. if (radio->wr_index >= radio->buf_size)
  376. radio->wr_index = 0;
  377. /* check for overflow */
  378. if (radio->wr_index == radio->rd_index) {
  379. /* increment and wrap read pointer */
  380. radio->rd_index += 3;
  381. if (radio->rd_index >= radio->buf_size)
  382. radio->rd_index = 0;
  383. }
  384. }
  385. if (radio->wr_index != radio->rd_index)
  386. wake_up_interruptible(&radio->read_queue);
  387. }
  388. resubmit:
  389. /* Resubmit if we're still running. */
  390. if (radio->int_in_running && radio->usbdev) {
  391. retval = usb_submit_urb(radio->int_in_urb, GFP_ATOMIC);
  392. if (retval) {
  393. dev_warn(&radio->intf->dev,
  394. "resubmitting urb failed (%d)", retval);
  395. radio->int_in_running = 0;
  396. }
  397. }
  398. }
  399. /**************************************************************************
  400. * File Operations Interface
  401. **************************************************************************/
  402. /*
  403. * si470x_fops_open - file open
  404. */
  405. int si470x_fops_open(struct file *file)
  406. {
  407. struct si470x_device *radio = video_drvdata(file);
  408. int retval;
  409. mutex_lock(&radio->lock);
  410. radio->users++;
  411. retval = usb_autopm_get_interface(radio->intf);
  412. if (retval < 0) {
  413. radio->users--;
  414. retval = -EIO;
  415. goto done;
  416. }
  417. if (radio->users == 1) {
  418. /* start radio */
  419. retval = si470x_start(radio);
  420. if (retval < 0) {
  421. usb_autopm_put_interface(radio->intf);
  422. goto done;
  423. }
  424. /* initialize interrupt urb */
  425. usb_fill_int_urb(radio->int_in_urb, radio->usbdev,
  426. usb_rcvintpipe(radio->usbdev,
  427. radio->int_in_endpoint->bEndpointAddress),
  428. radio->int_in_buffer,
  429. le16_to_cpu(radio->int_in_endpoint->wMaxPacketSize),
  430. si470x_int_in_callback,
  431. radio,
  432. radio->int_in_endpoint->bInterval);
  433. radio->int_in_running = 1;
  434. mb();
  435. retval = usb_submit_urb(radio->int_in_urb, GFP_KERNEL);
  436. if (retval) {
  437. dev_info(&radio->intf->dev,
  438. "submitting int urb failed (%d)\n", retval);
  439. radio->int_in_running = 0;
  440. usb_autopm_put_interface(radio->intf);
  441. }
  442. }
  443. done:
  444. mutex_unlock(&radio->lock);
  445. return retval;
  446. }
  447. /*
  448. * si470x_fops_release - file release
  449. */
  450. int si470x_fops_release(struct file *file)
  451. {
  452. struct si470x_device *radio = video_drvdata(file);
  453. int retval = 0;
  454. /* safety check */
  455. if (!radio) {
  456. retval = -ENODEV;
  457. goto done;
  458. }
  459. mutex_lock(&radio->lock);
  460. radio->users--;
  461. if (radio->users == 0) {
  462. /* shutdown interrupt handler */
  463. if (radio->int_in_running) {
  464. radio->int_in_running = 0;
  465. if (radio->int_in_urb)
  466. usb_kill_urb(radio->int_in_urb);
  467. }
  468. if (radio->disconnected) {
  469. video_unregister_device(radio->videodev);
  470. kfree(radio->int_in_buffer);
  471. kfree(radio->buffer);
  472. mutex_unlock(&radio->lock);
  473. kfree(radio);
  474. goto done;
  475. }
  476. /* cancel read processes */
  477. wake_up_interruptible(&radio->read_queue);
  478. /* stop radio */
  479. retval = si470x_stop(radio);
  480. usb_autopm_put_interface(radio->intf);
  481. }
  482. mutex_unlock(&radio->lock);
  483. done:
  484. return retval;
  485. }
  486. /**************************************************************************
  487. * Video4Linux Interface
  488. **************************************************************************/
  489. /*
  490. * si470x_vidioc_querycap - query device capabilities
  491. */
  492. int si470x_vidioc_querycap(struct file *file, void *priv,
  493. struct v4l2_capability *capability)
  494. {
  495. struct si470x_device *radio = video_drvdata(file);
  496. strlcpy(capability->driver, DRIVER_NAME, sizeof(capability->driver));
  497. strlcpy(capability->card, DRIVER_CARD, sizeof(capability->card));
  498. usb_make_path(radio->usbdev, capability->bus_info,
  499. sizeof(capability->bus_info));
  500. capability->capabilities = V4L2_CAP_HW_FREQ_SEEK |
  501. V4L2_CAP_TUNER | V4L2_CAP_RADIO | V4L2_CAP_RDS_CAPTURE;
  502. return 0;
  503. }
  504. /**************************************************************************
  505. * USB Interface
  506. **************************************************************************/
  507. /*
  508. * si470x_usb_driver_probe - probe for the device
  509. */
  510. static int si470x_usb_driver_probe(struct usb_interface *intf,
  511. const struct usb_device_id *id)
  512. {
  513. struct si470x_device *radio;
  514. struct usb_host_interface *iface_desc;
  515. struct usb_endpoint_descriptor *endpoint;
  516. int i, int_end_size, retval = 0;
  517. unsigned char version_warning = 0;
  518. /* private data allocation and initialization */
  519. radio = kzalloc(sizeof(struct si470x_device), GFP_KERNEL);
  520. if (!radio) {
  521. retval = -ENOMEM;
  522. goto err_initial;
  523. }
  524. radio->users = 0;
  525. radio->disconnected = 0;
  526. radio->usbdev = interface_to_usbdev(intf);
  527. radio->intf = intf;
  528. mutex_init(&radio->lock);
  529. iface_desc = intf->cur_altsetting;
  530. /* Set up interrupt endpoint information. */
  531. for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) {
  532. endpoint = &iface_desc->endpoint[i].desc;
  533. if (((endpoint->bEndpointAddress & USB_ENDPOINT_DIR_MASK) ==
  534. USB_DIR_IN) && ((endpoint->bmAttributes &
  535. USB_ENDPOINT_XFERTYPE_MASK) == USB_ENDPOINT_XFER_INT))
  536. radio->int_in_endpoint = endpoint;
  537. }
  538. if (!radio->int_in_endpoint) {
  539. dev_info(&intf->dev, "could not find interrupt in endpoint\n");
  540. retval = -EIO;
  541. goto err_radio;
  542. }
  543. int_end_size = le16_to_cpu(radio->int_in_endpoint->wMaxPacketSize);
  544. radio->int_in_buffer = kmalloc(int_end_size, GFP_KERNEL);
  545. if (!radio->int_in_buffer) {
  546. dev_info(&intf->dev, "could not allocate int_in_buffer");
  547. retval = -ENOMEM;
  548. goto err_radio;
  549. }
  550. radio->int_in_urb = usb_alloc_urb(0, GFP_KERNEL);
  551. if (!radio->int_in_urb) {
  552. dev_info(&intf->dev, "could not allocate int_in_urb");
  553. retval = -ENOMEM;
  554. goto err_intbuffer;
  555. }
  556. /* video device allocation and initialization */
  557. radio->videodev = video_device_alloc();
  558. if (!radio->videodev) {
  559. retval = -ENOMEM;
  560. goto err_urb;
  561. }
  562. memcpy(radio->videodev, &si470x_viddev_template,
  563. sizeof(si470x_viddev_template));
  564. video_set_drvdata(radio->videodev, radio);
  565. /* get device and chip versions */
  566. if (si470x_get_all_registers(radio) < 0) {
  567. retval = -EIO;
  568. goto err_video;
  569. }
  570. dev_info(&intf->dev, "DeviceID=0x%4.4hx ChipID=0x%4.4hx\n",
  571. radio->registers[DEVICEID], radio->registers[CHIPID]);
  572. if ((radio->registers[CHIPID] & CHIPID_FIRMWARE) < RADIO_FW_VERSION) {
  573. dev_warn(&intf->dev,
  574. "This driver is known to work with "
  575. "firmware version %hu,\n", RADIO_FW_VERSION);
  576. dev_warn(&intf->dev,
  577. "but the device has firmware version %hu.\n",
  578. radio->registers[CHIPID] & CHIPID_FIRMWARE);
  579. version_warning = 1;
  580. }
  581. /* get software and hardware versions */
  582. if (si470x_get_scratch_page_versions(radio) < 0) {
  583. retval = -EIO;
  584. goto err_video;
  585. }
  586. dev_info(&intf->dev, "software version %d, hardware version %d\n",
  587. radio->software_version, radio->hardware_version);
  588. if (radio->software_version < RADIO_SW_VERSION) {
  589. dev_warn(&intf->dev,
  590. "This driver is known to work with "
  591. "software version %hu,\n", RADIO_SW_VERSION);
  592. dev_warn(&intf->dev,
  593. "but the device has software version %hu.\n",
  594. radio->software_version);
  595. version_warning = 1;
  596. }
  597. if (radio->hardware_version < RADIO_HW_VERSION) {
  598. dev_warn(&intf->dev,
  599. "This driver is known to work with "
  600. "hardware version %hu,\n", RADIO_HW_VERSION);
  601. dev_warn(&intf->dev,
  602. "but the device has hardware version %hu.\n",
  603. radio->hardware_version);
  604. version_warning = 1;
  605. }
  606. /* give out version warning */
  607. if (version_warning == 1) {
  608. dev_warn(&intf->dev,
  609. "If you have some trouble using this driver,\n");
  610. dev_warn(&intf->dev,
  611. "please report to V4L ML at "
  612. "linux-media@vger.kernel.org\n");
  613. }
  614. /* set initial frequency */
  615. si470x_set_freq(radio, 87.5 * FREQ_MUL); /* available in all regions */
  616. /* set led to connect state */
  617. si470x_set_led_state(radio, BLINK_GREEN_LED);
  618. /* rds buffer allocation */
  619. radio->buf_size = rds_buf * 3;
  620. radio->buffer = kmalloc(radio->buf_size, GFP_KERNEL);
  621. if (!radio->buffer) {
  622. retval = -EIO;
  623. goto err_video;
  624. }
  625. /* rds buffer configuration */
  626. radio->wr_index = 0;
  627. radio->rd_index = 0;
  628. init_waitqueue_head(&radio->read_queue);
  629. /* register video device */
  630. retval = video_register_device(radio->videodev, VFL_TYPE_RADIO,
  631. radio_nr);
  632. if (retval) {
  633. dev_warn(&intf->dev, "Could not register video device\n");
  634. goto err_all;
  635. }
  636. usb_set_intfdata(intf, radio);
  637. return 0;
  638. err_all:
  639. kfree(radio->buffer);
  640. err_video:
  641. video_device_release(radio->videodev);
  642. err_urb:
  643. usb_free_urb(radio->int_in_urb);
  644. err_intbuffer:
  645. kfree(radio->int_in_buffer);
  646. err_radio:
  647. kfree(radio);
  648. err_initial:
  649. return retval;
  650. }
  651. /*
  652. * si470x_usb_driver_suspend - suspend the device
  653. */
  654. static int si470x_usb_driver_suspend(struct usb_interface *intf,
  655. pm_message_t message)
  656. {
  657. dev_info(&intf->dev, "suspending now...\n");
  658. return 0;
  659. }
  660. /*
  661. * si470x_usb_driver_resume - resume the device
  662. */
  663. static int si470x_usb_driver_resume(struct usb_interface *intf)
  664. {
  665. dev_info(&intf->dev, "resuming now...\n");
  666. return 0;
  667. }
  668. /*
  669. * si470x_usb_driver_disconnect - disconnect the device
  670. */
  671. static void si470x_usb_driver_disconnect(struct usb_interface *intf)
  672. {
  673. struct si470x_device *radio = usb_get_intfdata(intf);
  674. mutex_lock(&radio->lock);
  675. radio->disconnected = 1;
  676. usb_set_intfdata(intf, NULL);
  677. if (radio->users == 0) {
  678. /* set led to disconnect state */
  679. si470x_set_led_state(radio, BLINK_ORANGE_LED);
  680. /* Free data structures. */
  681. usb_free_urb(radio->int_in_urb);
  682. kfree(radio->int_in_buffer);
  683. video_unregister_device(radio->videodev);
  684. kfree(radio->buffer);
  685. mutex_unlock(&radio->lock);
  686. kfree(radio);
  687. } else {
  688. mutex_unlock(&radio->lock);
  689. }
  690. }
  691. /*
  692. * si470x_usb_driver - usb driver interface
  693. */
  694. static struct usb_driver si470x_usb_driver = {
  695. .name = DRIVER_NAME,
  696. .probe = si470x_usb_driver_probe,
  697. .disconnect = si470x_usb_driver_disconnect,
  698. .suspend = si470x_usb_driver_suspend,
  699. .resume = si470x_usb_driver_resume,
  700. .id_table = si470x_usb_driver_id_table,
  701. .supports_autosuspend = 1,
  702. };
  703. module_usb_driver(si470x_usb_driver);
  704. MODULE_LICENSE("GPL");
  705. MODULE_AUTHOR(DRIVER_AUTHOR);
  706. MODULE_DESCRIPTION(DRIVER_DESC);
  707. MODULE_VERSION(DRIVER_VERSION);