az6007.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919
  1. /*
  2. * Driver for AzureWave 6007 DVB-C/T USB2.0 and clones
  3. *
  4. * Copyright (c) Henry Wang <Henry.wang@AzureWave.com>
  5. *
  6. * This driver was made publicly available by Terratec, at:
  7. * http://linux.terratec.de/files/TERRATEC_H7/20110323_TERRATEC_H7_Linux.tar.gz
  8. * The original driver's license is GPL, as declared with MODULE_LICENSE()
  9. *
  10. * Copyright (c) 2010-2012 Mauro Carvalho Chehab <mchehab@redhat.com>
  11. * Driver modified by in order to work with upstream drxk driver, and
  12. * tons of bugs got fixed, and converted to use dvb-usb-v2.
  13. *
  14. * This program is free software; you can redistribute it and/or modify
  15. * it under the terms of the GNU General Public License as published by
  16. * the Free Software Foundation under version 2 of the License.
  17. *
  18. * This program is distributed in the hope that it will be useful,
  19. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  20. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  21. * GNU General Public License for more details.
  22. */
  23. #include "drxk.h"
  24. #include "mt2063.h"
  25. #include "dvb_ca_en50221.h"
  26. #include "dvb_usb.h"
  27. #include "cypress_firmware.h"
  28. #define AZ6007_FIRMWARE "dvb-usb-terratec-h7-az6007.fw"
  29. static int az6007_xfer_debug;
  30. module_param_named(xfer_debug, az6007_xfer_debug, int, 0644);
  31. MODULE_PARM_DESC(xfer_debug, "Enable xfer debug");
  32. DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
  33. /* Known requests (Cypress FX2 firmware + az6007 "private" ones*/
  34. #define FX2_OED 0xb5
  35. #define AZ6007_READ_DATA 0xb7
  36. #define AZ6007_I2C_RD 0xb9
  37. #define AZ6007_POWER 0xbc
  38. #define AZ6007_I2C_WR 0xbd
  39. #define FX2_SCON1 0xc0
  40. #define AZ6007_TS_THROUGH 0xc7
  41. #define AZ6007_READ_IR 0xb4
  42. struct az6007_device_state {
  43. struct mutex mutex;
  44. struct mutex ca_mutex;
  45. struct dvb_ca_en50221 ca;
  46. unsigned warm:1;
  47. int (*gate_ctrl) (struct dvb_frontend *, int);
  48. unsigned char data[4096];
  49. };
  50. static struct drxk_config terratec_h7_drxk = {
  51. .adr = 0x29,
  52. .parallel_ts = true,
  53. .dynamic_clk = true,
  54. .single_master = true,
  55. .enable_merr_cfg = true,
  56. .no_i2c_bridge = false,
  57. .chunk_size = 64,
  58. .mpeg_out_clk_strength = 0x02,
  59. .qam_demod_parameter_count = 2,
  60. .microcode_name = "dvb-usb-terratec-h7-drxk.fw",
  61. };
  62. static int drxk_gate_ctrl(struct dvb_frontend *fe, int enable)
  63. {
  64. struct az6007_device_state *st = fe_to_priv(fe);
  65. struct dvb_usb_adapter *adap = fe->sec_priv;
  66. int status = 0;
  67. pr_debug("%s: %s\n", __func__, enable ? "enable" : "disable");
  68. if (!adap || !st)
  69. return -EINVAL;
  70. if (enable)
  71. status = st->gate_ctrl(fe, 1);
  72. else
  73. status = st->gate_ctrl(fe, 0);
  74. return status;
  75. }
  76. static struct mt2063_config az6007_mt2063_config = {
  77. .tuner_address = 0x60,
  78. .refclock = 36125000,
  79. };
  80. static int __az6007_read(struct usb_device *udev, u8 req, u16 value,
  81. u16 index, u8 *b, int blen)
  82. {
  83. int ret;
  84. ret = usb_control_msg(udev,
  85. usb_rcvctrlpipe(udev, 0),
  86. req,
  87. USB_TYPE_VENDOR | USB_DIR_IN,
  88. value, index, b, blen, 5000);
  89. if (ret < 0) {
  90. pr_warn("usb read operation failed. (%d)\n", ret);
  91. return -EIO;
  92. }
  93. if (az6007_xfer_debug) {
  94. printk(KERN_DEBUG "az6007: IN req: %02x, value: %04x, index: %04x\n",
  95. req, value, index);
  96. print_hex_dump_bytes("az6007: payload: ",
  97. DUMP_PREFIX_NONE, b, blen);
  98. }
  99. return ret;
  100. }
  101. static int az6007_read(struct dvb_usb_device *d, u8 req, u16 value,
  102. u16 index, u8 *b, int blen)
  103. {
  104. struct az6007_device_state *st = d->priv;
  105. int ret;
  106. if (mutex_lock_interruptible(&st->mutex) < 0)
  107. return -EAGAIN;
  108. ret = __az6007_read(d->udev, req, value, index, b, blen);
  109. mutex_unlock(&st->mutex);
  110. return ret;
  111. }
  112. static int __az6007_write(struct usb_device *udev, u8 req, u16 value,
  113. u16 index, u8 *b, int blen)
  114. {
  115. int ret;
  116. if (az6007_xfer_debug) {
  117. printk(KERN_DEBUG "az6007: OUT req: %02x, value: %04x, index: %04x\n",
  118. req, value, index);
  119. print_hex_dump_bytes("az6007: payload: ",
  120. DUMP_PREFIX_NONE, b, blen);
  121. }
  122. if (blen > 64) {
  123. pr_err("az6007: tried to write %d bytes, but I2C max size is 64 bytes\n",
  124. blen);
  125. return -EOPNOTSUPP;
  126. }
  127. ret = usb_control_msg(udev,
  128. usb_sndctrlpipe(udev, 0),
  129. req,
  130. USB_TYPE_VENDOR | USB_DIR_OUT,
  131. value, index, b, blen, 5000);
  132. if (ret != blen) {
  133. pr_err("usb write operation failed. (%d)\n", ret);
  134. return -EIO;
  135. }
  136. return 0;
  137. }
  138. static int az6007_write(struct dvb_usb_device *d, u8 req, u16 value,
  139. u16 index, u8 *b, int blen)
  140. {
  141. struct az6007_device_state *st = d->priv;
  142. int ret;
  143. if (mutex_lock_interruptible(&st->mutex) < 0)
  144. return -EAGAIN;
  145. ret = __az6007_write(d->udev, req, value, index, b, blen);
  146. mutex_unlock(&st->mutex);
  147. return ret;
  148. }
  149. static int az6007_streaming_ctrl(struct dvb_frontend *fe, int onoff)
  150. {
  151. struct dvb_usb_device *d = fe_to_d(fe);
  152. pr_debug("%s: %s\n", __func__, onoff ? "enable" : "disable");
  153. return az6007_write(d, 0xbc, onoff, 0, NULL, 0);
  154. }
  155. /* remote control stuff (does not work with my box) */
  156. static int az6007_rc_query(struct dvb_usb_device *d)
  157. {
  158. struct az6007_device_state *st = d_to_priv(d);
  159. unsigned code = 0;
  160. az6007_read(d, AZ6007_READ_IR, 0, 0, st->data, 10);
  161. if (st->data[1] == 0x44)
  162. return 0;
  163. if ((st->data[1] ^ st->data[2]) == 0xff)
  164. code = st->data[1];
  165. else
  166. code = st->data[1] << 8 | st->data[2];
  167. if ((st->data[3] ^ st->data[4]) == 0xff)
  168. code = code << 8 | st->data[3];
  169. else
  170. code = code << 16 | st->data[3] << 8 | st->data[4];
  171. rc_keydown(d->rc_dev, code, st->data[5]);
  172. return 0;
  173. }
  174. static int az6007_ci_read_attribute_mem(struct dvb_ca_en50221 *ca,
  175. int slot,
  176. int address)
  177. {
  178. struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
  179. struct az6007_device_state *state = d_to_priv(d);
  180. int ret;
  181. u8 req;
  182. u16 value;
  183. u16 index;
  184. int blen;
  185. u8 *b;
  186. if (slot != 0)
  187. return -EINVAL;
  188. b = kmalloc(12, GFP_KERNEL);
  189. if (!b)
  190. return -ENOMEM;
  191. mutex_lock(&state->ca_mutex);
  192. req = 0xC1;
  193. value = address;
  194. index = 0;
  195. blen = 1;
  196. ret = az6007_read(d, req, value, index, b, blen);
  197. if (ret < 0) {
  198. pr_warn("usb in operation failed. (%d)\n", ret);
  199. ret = -EINVAL;
  200. } else {
  201. ret = b[0];
  202. }
  203. mutex_unlock(&state->ca_mutex);
  204. kfree(b);
  205. return ret;
  206. }
  207. static int az6007_ci_write_attribute_mem(struct dvb_ca_en50221 *ca,
  208. int slot,
  209. int address,
  210. u8 value)
  211. {
  212. struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
  213. struct az6007_device_state *state = d_to_priv(d);
  214. int ret;
  215. u8 req;
  216. u16 value1;
  217. u16 index;
  218. int blen;
  219. pr_debug("%s(), slot %d\n", __func__, slot);
  220. if (slot != 0)
  221. return -EINVAL;
  222. mutex_lock(&state->ca_mutex);
  223. req = 0xC2;
  224. value1 = address;
  225. index = value;
  226. blen = 0;
  227. ret = az6007_write(d, req, value1, index, NULL, blen);
  228. if (ret != 0)
  229. pr_warn("usb out operation failed. (%d)\n", ret);
  230. mutex_unlock(&state->ca_mutex);
  231. return ret;
  232. }
  233. static int az6007_ci_read_cam_control(struct dvb_ca_en50221 *ca,
  234. int slot,
  235. u8 address)
  236. {
  237. struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
  238. struct az6007_device_state *state = d_to_priv(d);
  239. int ret;
  240. u8 req;
  241. u16 value;
  242. u16 index;
  243. int blen;
  244. u8 *b;
  245. if (slot != 0)
  246. return -EINVAL;
  247. b = kmalloc(12, GFP_KERNEL);
  248. if (!b)
  249. return -ENOMEM;
  250. mutex_lock(&state->ca_mutex);
  251. req = 0xC3;
  252. value = address;
  253. index = 0;
  254. blen = 2;
  255. ret = az6007_read(d, req, value, index, b, blen);
  256. if (ret < 0) {
  257. pr_warn("usb in operation failed. (%d)\n", ret);
  258. ret = -EINVAL;
  259. } else {
  260. if (b[0] == 0)
  261. pr_warn("Read CI IO error\n");
  262. ret = b[1];
  263. pr_debug("read cam data = %x from 0x%x\n", b[1], value);
  264. }
  265. mutex_unlock(&state->ca_mutex);
  266. kfree(b);
  267. return ret;
  268. }
  269. static int az6007_ci_write_cam_control(struct dvb_ca_en50221 *ca,
  270. int slot,
  271. u8 address,
  272. u8 value)
  273. {
  274. struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
  275. struct az6007_device_state *state = d_to_priv(d);
  276. int ret;
  277. u8 req;
  278. u16 value1;
  279. u16 index;
  280. int blen;
  281. if (slot != 0)
  282. return -EINVAL;
  283. mutex_lock(&state->ca_mutex);
  284. req = 0xC4;
  285. value1 = address;
  286. index = value;
  287. blen = 0;
  288. ret = az6007_write(d, req, value1, index, NULL, blen);
  289. if (ret != 0) {
  290. pr_warn("usb out operation failed. (%d)\n", ret);
  291. goto failed;
  292. }
  293. failed:
  294. mutex_unlock(&state->ca_mutex);
  295. return ret;
  296. }
  297. static int CI_CamReady(struct dvb_ca_en50221 *ca, int slot)
  298. {
  299. struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
  300. int ret;
  301. u8 req;
  302. u16 value;
  303. u16 index;
  304. int blen;
  305. u8 *b;
  306. b = kmalloc(12, GFP_KERNEL);
  307. if (!b)
  308. return -ENOMEM;
  309. req = 0xC8;
  310. value = 0;
  311. index = 0;
  312. blen = 1;
  313. ret = az6007_read(d, req, value, index, b, blen);
  314. if (ret < 0) {
  315. pr_warn("usb in operation failed. (%d)\n", ret);
  316. ret = -EIO;
  317. } else{
  318. ret = b[0];
  319. }
  320. kfree(b);
  321. return ret;
  322. }
  323. static int az6007_ci_slot_reset(struct dvb_ca_en50221 *ca, int slot)
  324. {
  325. struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
  326. struct az6007_device_state *state = d_to_priv(d);
  327. int ret, i;
  328. u8 req;
  329. u16 value;
  330. u16 index;
  331. int blen;
  332. mutex_lock(&state->ca_mutex);
  333. req = 0xC6;
  334. value = 1;
  335. index = 0;
  336. blen = 0;
  337. ret = az6007_write(d, req, value, index, NULL, blen);
  338. if (ret != 0) {
  339. pr_warn("usb out operation failed. (%d)\n", ret);
  340. goto failed;
  341. }
  342. msleep(500);
  343. req = 0xC6;
  344. value = 0;
  345. index = 0;
  346. blen = 0;
  347. ret = az6007_write(d, req, value, index, NULL, blen);
  348. if (ret != 0) {
  349. pr_warn("usb out operation failed. (%d)\n", ret);
  350. goto failed;
  351. }
  352. for (i = 0; i < 15; i++) {
  353. msleep(100);
  354. if (CI_CamReady(ca, slot)) {
  355. pr_debug("CAM Ready\n");
  356. break;
  357. }
  358. }
  359. msleep(5000);
  360. failed:
  361. mutex_unlock(&state->ca_mutex);
  362. return ret;
  363. }
  364. static int az6007_ci_slot_shutdown(struct dvb_ca_en50221 *ca, int slot)
  365. {
  366. return 0;
  367. }
  368. static int az6007_ci_slot_ts_enable(struct dvb_ca_en50221 *ca, int slot)
  369. {
  370. struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
  371. struct az6007_device_state *state = d_to_priv(d);
  372. int ret;
  373. u8 req;
  374. u16 value;
  375. u16 index;
  376. int blen;
  377. pr_debug("%s()\n", __func__);
  378. mutex_lock(&state->ca_mutex);
  379. req = 0xC7;
  380. value = 1;
  381. index = 0;
  382. blen = 0;
  383. ret = az6007_write(d, req, value, index, NULL, blen);
  384. if (ret != 0) {
  385. pr_warn("usb out operation failed. (%d)\n", ret);
  386. goto failed;
  387. }
  388. failed:
  389. mutex_unlock(&state->ca_mutex);
  390. return ret;
  391. }
  392. static int az6007_ci_poll_slot_status(struct dvb_ca_en50221 *ca, int slot, int open)
  393. {
  394. struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
  395. struct az6007_device_state *state = d_to_priv(d);
  396. int ret;
  397. u8 req;
  398. u16 value;
  399. u16 index;
  400. int blen;
  401. u8 *b;
  402. b = kmalloc(12, GFP_KERNEL);
  403. if (!b)
  404. return -ENOMEM;
  405. mutex_lock(&state->ca_mutex);
  406. req = 0xC5;
  407. value = 0;
  408. index = 0;
  409. blen = 1;
  410. ret = az6007_read(d, req, value, index, b, blen);
  411. if (ret < 0) {
  412. pr_warn("usb in operation failed. (%d)\n", ret);
  413. ret = -EIO;
  414. } else
  415. ret = 0;
  416. if (!ret && b[0] == 1) {
  417. ret = DVB_CA_EN50221_POLL_CAM_PRESENT |
  418. DVB_CA_EN50221_POLL_CAM_READY;
  419. }
  420. mutex_unlock(&state->ca_mutex);
  421. kfree(b);
  422. return ret;
  423. }
  424. static void az6007_ci_uninit(struct dvb_usb_device *d)
  425. {
  426. struct az6007_device_state *state;
  427. pr_debug("%s()\n", __func__);
  428. if (NULL == d)
  429. return;
  430. state = d_to_priv(d);
  431. if (NULL == state)
  432. return;
  433. if (NULL == state->ca.data)
  434. return;
  435. dvb_ca_en50221_release(&state->ca);
  436. memset(&state->ca, 0, sizeof(state->ca));
  437. }
  438. static int az6007_ci_init(struct dvb_usb_adapter *adap)
  439. {
  440. struct dvb_usb_device *d = adap_to_d(adap);
  441. struct az6007_device_state *state = adap_to_priv(adap);
  442. int ret;
  443. pr_debug("%s()\n", __func__);
  444. mutex_init(&state->ca_mutex);
  445. state->ca.owner = THIS_MODULE;
  446. state->ca.read_attribute_mem = az6007_ci_read_attribute_mem;
  447. state->ca.write_attribute_mem = az6007_ci_write_attribute_mem;
  448. state->ca.read_cam_control = az6007_ci_read_cam_control;
  449. state->ca.write_cam_control = az6007_ci_write_cam_control;
  450. state->ca.slot_reset = az6007_ci_slot_reset;
  451. state->ca.slot_shutdown = az6007_ci_slot_shutdown;
  452. state->ca.slot_ts_enable = az6007_ci_slot_ts_enable;
  453. state->ca.poll_slot_status = az6007_ci_poll_slot_status;
  454. state->ca.data = d;
  455. ret = dvb_ca_en50221_init(&adap->dvb_adap,
  456. &state->ca,
  457. 0, /* flags */
  458. 1);/* n_slots */
  459. if (ret != 0) {
  460. pr_err("Cannot initialize CI: Error %d.\n", ret);
  461. memset(&state->ca, 0, sizeof(state->ca));
  462. return ret;
  463. }
  464. pr_debug("CI initialized.\n");
  465. return 0;
  466. }
  467. static int az6007_read_mac_addr(struct dvb_usb_adapter *adap, u8 mac[6])
  468. {
  469. struct dvb_usb_device *d = adap_to_d(adap);
  470. struct az6007_device_state *st = adap_to_priv(adap);
  471. int ret;
  472. ret = az6007_read(d, AZ6007_READ_DATA, 6, 0, st->data, 6);
  473. memcpy(mac, st->data, 6);
  474. if (ret > 0)
  475. pr_debug("%s: mac is %pM\n", __func__, mac);
  476. return ret;
  477. }
  478. static int az6007_frontend_attach(struct dvb_usb_adapter *adap)
  479. {
  480. struct az6007_device_state *st = adap_to_priv(adap);
  481. struct dvb_usb_device *d = adap_to_d(adap);
  482. pr_debug("attaching demod drxk\n");
  483. adap->fe[0] = dvb_attach(drxk_attach, &terratec_h7_drxk,
  484. &d->i2c_adap);
  485. if (!adap->fe[0])
  486. return -EINVAL;
  487. adap->fe[0]->sec_priv = adap;
  488. st->gate_ctrl = adap->fe[0]->ops.i2c_gate_ctrl;
  489. adap->fe[0]->ops.i2c_gate_ctrl = drxk_gate_ctrl;
  490. az6007_ci_init(adap);
  491. return 0;
  492. }
  493. static int az6007_tuner_attach(struct dvb_usb_adapter *adap)
  494. {
  495. struct dvb_usb_device *d = adap_to_d(adap);
  496. pr_debug("attaching tuner mt2063\n");
  497. /* Attach mt2063 to DVB-C frontend */
  498. if (adap->fe[0]->ops.i2c_gate_ctrl)
  499. adap->fe[0]->ops.i2c_gate_ctrl(adap->fe[0], 1);
  500. if (!dvb_attach(mt2063_attach, adap->fe[0],
  501. &az6007_mt2063_config,
  502. &d->i2c_adap))
  503. return -EINVAL;
  504. if (adap->fe[0]->ops.i2c_gate_ctrl)
  505. adap->fe[0]->ops.i2c_gate_ctrl(adap->fe[0], 0);
  506. return 0;
  507. }
  508. static int az6007_power_ctrl(struct dvb_usb_device *d, int onoff)
  509. {
  510. struct az6007_device_state *state = d_to_priv(d);
  511. int ret;
  512. pr_debug("%s()\n", __func__);
  513. if (!state->warm) {
  514. mutex_init(&state->mutex);
  515. ret = az6007_write(d, AZ6007_POWER, 0, 2, NULL, 0);
  516. if (ret < 0)
  517. return ret;
  518. msleep(60);
  519. ret = az6007_write(d, AZ6007_POWER, 1, 4, NULL, 0);
  520. if (ret < 0)
  521. return ret;
  522. msleep(100);
  523. ret = az6007_write(d, AZ6007_POWER, 1, 3, NULL, 0);
  524. if (ret < 0)
  525. return ret;
  526. msleep(20);
  527. ret = az6007_write(d, AZ6007_POWER, 1, 4, NULL, 0);
  528. if (ret < 0)
  529. return ret;
  530. msleep(400);
  531. ret = az6007_write(d, FX2_SCON1, 0, 3, NULL, 0);
  532. if (ret < 0)
  533. return ret;
  534. msleep(150);
  535. ret = az6007_write(d, FX2_SCON1, 1, 3, NULL, 0);
  536. if (ret < 0)
  537. return ret;
  538. msleep(430);
  539. ret = az6007_write(d, AZ6007_POWER, 0, 0, NULL, 0);
  540. if (ret < 0)
  541. return ret;
  542. state->warm = true;
  543. return 0;
  544. }
  545. if (!onoff)
  546. return 0;
  547. az6007_write(d, AZ6007_POWER, 0, 0, NULL, 0);
  548. az6007_write(d, AZ6007_TS_THROUGH, 0, 0, NULL, 0);
  549. return 0;
  550. }
  551. /* I2C */
  552. static int az6007_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg msgs[],
  553. int num)
  554. {
  555. struct dvb_usb_device *d = i2c_get_adapdata(adap);
  556. struct az6007_device_state *st = d_to_priv(d);
  557. int i, j, len;
  558. int ret = 0;
  559. u16 index;
  560. u16 value;
  561. int length;
  562. u8 req, addr;
  563. if (mutex_lock_interruptible(&st->mutex) < 0)
  564. return -EAGAIN;
  565. for (i = 0; i < num; i++) {
  566. addr = msgs[i].addr << 1;
  567. if (((i + 1) < num)
  568. && (msgs[i].len == 1)
  569. && ((msgs[i].flags & I2C_M_RD) != I2C_M_RD)
  570. && (msgs[i + 1].flags & I2C_M_RD)
  571. && (msgs[i].addr == msgs[i + 1].addr)) {
  572. /*
  573. * A write + read xfer for the same address, where
  574. * the first xfer has just 1 byte length.
  575. * Need to join both into one operation
  576. */
  577. if (az6007_xfer_debug)
  578. printk(KERN_DEBUG "az6007: I2C W/R addr=0x%x len=%d/%d\n",
  579. addr, msgs[i].len, msgs[i + 1].len);
  580. req = AZ6007_I2C_RD;
  581. index = msgs[i].buf[0];
  582. value = addr | (1 << 8);
  583. length = 6 + msgs[i + 1].len;
  584. len = msgs[i + 1].len;
  585. ret = __az6007_read(d->udev, req, value, index,
  586. st->data, length);
  587. if (ret >= len) {
  588. for (j = 0; j < len; j++)
  589. msgs[i + 1].buf[j] = st->data[j + 5];
  590. } else
  591. ret = -EIO;
  592. i++;
  593. } else if (!(msgs[i].flags & I2C_M_RD)) {
  594. /* write bytes */
  595. if (az6007_xfer_debug)
  596. printk(KERN_DEBUG "az6007: I2C W addr=0x%x len=%d\n",
  597. addr, msgs[i].len);
  598. req = AZ6007_I2C_WR;
  599. index = msgs[i].buf[0];
  600. value = addr | (1 << 8);
  601. length = msgs[i].len - 1;
  602. len = msgs[i].len - 1;
  603. for (j = 0; j < len; j++)
  604. st->data[j] = msgs[i].buf[j + 1];
  605. ret = __az6007_write(d->udev, req, value, index,
  606. st->data, length);
  607. } else {
  608. /* read bytes */
  609. if (az6007_xfer_debug)
  610. printk(KERN_DEBUG "az6007: I2C R addr=0x%x len=%d\n",
  611. addr, msgs[i].len);
  612. req = AZ6007_I2C_RD;
  613. index = msgs[i].buf[0];
  614. value = addr;
  615. length = msgs[i].len + 6;
  616. len = msgs[i].len;
  617. ret = __az6007_read(d->udev, req, value, index,
  618. st->data, length);
  619. for (j = 0; j < len; j++)
  620. msgs[i].buf[j] = st->data[j + 5];
  621. }
  622. if (ret < 0)
  623. goto err;
  624. }
  625. err:
  626. mutex_unlock(&st->mutex);
  627. if (ret < 0) {
  628. pr_info("%s ERROR: %i\n", __func__, ret);
  629. return ret;
  630. }
  631. return num;
  632. }
  633. static u32 az6007_i2c_func(struct i2c_adapter *adapter)
  634. {
  635. return I2C_FUNC_I2C;
  636. }
  637. static struct i2c_algorithm az6007_i2c_algo = {
  638. .master_xfer = az6007_i2c_xfer,
  639. .functionality = az6007_i2c_func,
  640. };
  641. static int az6007_identify_state(struct dvb_usb_device *d, const char **name)
  642. {
  643. int ret;
  644. u8 *mac;
  645. pr_debug("Identifying az6007 state\n");
  646. mac = kmalloc(6, GFP_ATOMIC);
  647. if (!mac)
  648. return -ENOMEM;
  649. /* Try to read the mac address */
  650. ret = __az6007_read(d->udev, AZ6007_READ_DATA, 6, 0, mac, 6);
  651. if (ret == 6)
  652. ret = WARM;
  653. else
  654. ret = COLD;
  655. kfree(mac);
  656. if (ret == COLD) {
  657. __az6007_write(d->udev, 0x09, 1, 0, NULL, 0);
  658. __az6007_write(d->udev, 0x00, 0, 0, NULL, 0);
  659. __az6007_write(d->udev, 0x00, 0, 0, NULL, 0);
  660. }
  661. pr_debug("Device is on %s state\n",
  662. ret == WARM ? "warm" : "cold");
  663. return ret;
  664. }
  665. static void az6007_usb_disconnect(struct usb_interface *intf)
  666. {
  667. struct dvb_usb_device *d = usb_get_intfdata(intf);
  668. az6007_ci_uninit(d);
  669. dvb_usbv2_disconnect(intf);
  670. }
  671. static int az6007_get_rc_config(struct dvb_usb_device *d, struct dvb_usb_rc *rc)
  672. {
  673. pr_debug("Getting az6007 Remote Control properties\n");
  674. rc->allowed_protos = RC_BIT_NEC;
  675. rc->query = az6007_rc_query;
  676. rc->interval = 400;
  677. return 0;
  678. }
  679. static int az6007_download_firmware(struct dvb_usb_device *d,
  680. const struct firmware *fw)
  681. {
  682. pr_debug("Loading az6007 firmware\n");
  683. return usbv2_cypress_load_firmware(d->udev, fw, CYPRESS_FX2);
  684. }
  685. /* DVB USB Driver stuff */
  686. static struct dvb_usb_device_properties az6007_props = {
  687. .driver_name = KBUILD_MODNAME,
  688. .owner = THIS_MODULE,
  689. .firmware = AZ6007_FIRMWARE,
  690. .adapter_nr = adapter_nr,
  691. .size_of_priv = sizeof(struct az6007_device_state),
  692. .i2c_algo = &az6007_i2c_algo,
  693. .tuner_attach = az6007_tuner_attach,
  694. .frontend_attach = az6007_frontend_attach,
  695. .streaming_ctrl = az6007_streaming_ctrl,
  696. .get_rc_config = az6007_get_rc_config,
  697. .read_mac_address = az6007_read_mac_addr,
  698. .download_firmware = az6007_download_firmware,
  699. .identify_state = az6007_identify_state,
  700. .power_ctrl = az6007_power_ctrl,
  701. .num_adapters = 1,
  702. .adapter = {
  703. { .stream = DVB_USB_STREAM_BULK(0x02, 10, 4096), }
  704. }
  705. };
  706. static struct usb_device_id az6007_usb_table[] = {
  707. {DVB_USB_DEVICE(USB_VID_AZUREWAVE, USB_PID_AZUREWAVE_6007,
  708. &az6007_props, "Azurewave 6007", RC_MAP_EMPTY)},
  709. {DVB_USB_DEVICE(USB_VID_TERRATEC, USB_PID_TERRATEC_H7,
  710. &az6007_props, "Terratec H7", RC_MAP_NEC_TERRATEC_CINERGY_XS)},
  711. {DVB_USB_DEVICE(USB_VID_TERRATEC, USB_PID_TERRATEC_H7_2,
  712. &az6007_props, "Terratec H7", RC_MAP_NEC_TERRATEC_CINERGY_XS)},
  713. {0},
  714. };
  715. MODULE_DEVICE_TABLE(usb, az6007_usb_table);
  716. static int az6007_suspend(struct usb_interface *intf, pm_message_t msg)
  717. {
  718. struct dvb_usb_device *d = usb_get_intfdata(intf);
  719. az6007_ci_uninit(d);
  720. return dvb_usbv2_suspend(intf, msg);
  721. }
  722. static int az6007_resume(struct usb_interface *intf)
  723. {
  724. struct dvb_usb_device *d = usb_get_intfdata(intf);
  725. struct dvb_usb_adapter *adap = &d->adapter[0];
  726. az6007_ci_init(adap);
  727. return dvb_usbv2_resume(intf);
  728. }
  729. /* usb specific object needed to register this driver with the usb subsystem */
  730. static struct usb_driver az6007_usb_driver = {
  731. .name = KBUILD_MODNAME,
  732. .id_table = az6007_usb_table,
  733. .probe = dvb_usbv2_probe,
  734. .disconnect = az6007_usb_disconnect,
  735. .no_dynamic_id = 1,
  736. .soft_unbind = 1,
  737. /*
  738. * FIXME: need to implement reset_resume, likely with
  739. * dvb-usb-v2 core support
  740. */
  741. .suspend = az6007_suspend,
  742. .resume = az6007_resume,
  743. };
  744. module_usb_driver(az6007_usb_driver);
  745. MODULE_AUTHOR("Henry Wang <Henry.wang@AzureWave.com>");
  746. MODULE_AUTHOR("Mauro Carvalho Chehab <mchehab@redhat.com>");
  747. MODULE_DESCRIPTION("Driver for AzureWave 6007 DVB-C/T USB2.0 and clones");
  748. MODULE_VERSION("2.0");
  749. MODULE_LICENSE("GPL");
  750. MODULE_FIRMWARE(AZ6007_FIRMWARE);