dvbsky.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864
  1. /*
  2. * Driver for DVBSky USB2.0 receiver
  3. *
  4. * Copyright (C) 2013 Max nibble <nibble.max@gmail.com>
  5. *
  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.
  10. *
  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.
  15. *
  16. * You should have received a copy of the GNU General Public License
  17. * along with this program; if not, write to the Free Software
  18. * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  19. */
  20. #include "dvb_usb.h"
  21. #include "m88ds3103.h"
  22. #include "ts2020.h"
  23. #include "sp2.h"
  24. #include "si2168.h"
  25. #include "si2157.h"
  26. #define DVBSKY_MSG_DELAY 0/*2000*/
  27. #define DVBSKY_BUF_LEN 64
  28. static int dvb_usb_dvbsky_disable_rc;
  29. module_param_named(disable_rc, dvb_usb_dvbsky_disable_rc, int, 0644);
  30. MODULE_PARM_DESC(disable_rc, "Disable inbuilt IR receiver.");
  31. DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
  32. struct dvbsky_state {
  33. struct mutex stream_mutex;
  34. u8 ibuf[DVBSKY_BUF_LEN];
  35. u8 obuf[DVBSKY_BUF_LEN];
  36. u8 last_lock;
  37. struct i2c_client *i2c_client_demod;
  38. struct i2c_client *i2c_client_tuner;
  39. struct i2c_client *i2c_client_ci;
  40. /* fe hook functions*/
  41. int (*fe_set_voltage)(struct dvb_frontend *fe,
  42. fe_sec_voltage_t voltage);
  43. int (*fe_read_status)(struct dvb_frontend *fe,
  44. fe_status_t *status);
  45. };
  46. static int dvbsky_usb_generic_rw(struct dvb_usb_device *d,
  47. u8 *wbuf, u16 wlen, u8 *rbuf, u16 rlen)
  48. {
  49. int ret;
  50. struct dvbsky_state *state = d_to_priv(d);
  51. mutex_lock(&d->usb_mutex);
  52. if (wlen != 0)
  53. memcpy(state->obuf, wbuf, wlen);
  54. ret = dvb_usbv2_generic_rw_locked(d, state->obuf, wlen,
  55. state->ibuf, rlen);
  56. if (!ret && (rlen != 0))
  57. memcpy(rbuf, state->ibuf, rlen);
  58. mutex_unlock(&d->usb_mutex);
  59. return ret;
  60. }
  61. static int dvbsky_stream_ctrl(struct dvb_usb_device *d, u8 onoff)
  62. {
  63. struct dvbsky_state *state = d_to_priv(d);
  64. int ret;
  65. u8 obuf_pre[3] = { 0x37, 0, 0 };
  66. u8 obuf_post[3] = { 0x36, 3, 0 };
  67. mutex_lock(&state->stream_mutex);
  68. ret = dvbsky_usb_generic_rw(d, obuf_pre, 3, NULL, 0);
  69. if (!ret && onoff) {
  70. msleep(20);
  71. ret = dvbsky_usb_generic_rw(d, obuf_post, 3, NULL, 0);
  72. }
  73. mutex_unlock(&state->stream_mutex);
  74. return ret;
  75. }
  76. static int dvbsky_streaming_ctrl(struct dvb_frontend *fe, int onoff)
  77. {
  78. struct dvb_usb_device *d = fe_to_d(fe);
  79. return dvbsky_stream_ctrl(d, (onoff == 0) ? 0 : 1);
  80. }
  81. /* GPIO */
  82. static int dvbsky_gpio_ctrl(struct dvb_usb_device *d, u8 gport, u8 value)
  83. {
  84. int ret;
  85. u8 obuf[3], ibuf[2];
  86. obuf[0] = 0x0e;
  87. obuf[1] = gport;
  88. obuf[2] = value;
  89. ret = dvbsky_usb_generic_rw(d, obuf, 3, ibuf, 1);
  90. if (ret)
  91. dev_err(&d->udev->dev, "failed=%d\n", ret);
  92. return ret;
  93. }
  94. /* I2C */
  95. static int dvbsky_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg msg[],
  96. int num)
  97. {
  98. struct dvb_usb_device *d = i2c_get_adapdata(adap);
  99. int ret = 0;
  100. u8 ibuf[64], obuf[64];
  101. if (mutex_lock_interruptible(&d->i2c_mutex) < 0)
  102. return -EAGAIN;
  103. if (num > 2) {
  104. dev_err(&d->udev->dev,
  105. "too many i2c messages[%d], max 2.", num);
  106. ret = -EOPNOTSUPP;
  107. goto i2c_error;
  108. }
  109. if (num == 1) {
  110. if (msg[0].len > 60) {
  111. dev_err(&d->udev->dev,
  112. "too many i2c bytes[%d], max 60.",
  113. msg[0].len);
  114. ret = -EOPNOTSUPP;
  115. goto i2c_error;
  116. }
  117. if (msg[0].flags & I2C_M_RD) {
  118. /* single read */
  119. obuf[0] = 0x09;
  120. obuf[1] = 0;
  121. obuf[2] = msg[0].len;
  122. obuf[3] = msg[0].addr;
  123. ret = dvbsky_usb_generic_rw(d, obuf, 4,
  124. ibuf, msg[0].len + 1);
  125. if (ret)
  126. dev_err(&d->udev->dev, "failed=%d\n", ret);
  127. if (!ret)
  128. memcpy(msg[0].buf, &ibuf[1], msg[0].len);
  129. } else {
  130. /* write */
  131. obuf[0] = 0x08;
  132. obuf[1] = msg[0].addr;
  133. obuf[2] = msg[0].len;
  134. memcpy(&obuf[3], msg[0].buf, msg[0].len);
  135. ret = dvbsky_usb_generic_rw(d, obuf,
  136. msg[0].len + 3, ibuf, 1);
  137. if (ret)
  138. dev_err(&d->udev->dev, "failed=%d\n", ret);
  139. }
  140. } else {
  141. if ((msg[0].len > 60) || (msg[1].len > 60)) {
  142. dev_err(&d->udev->dev,
  143. "too many i2c bytes[w-%d][r-%d], max 60.",
  144. msg[0].len, msg[1].len);
  145. ret = -EOPNOTSUPP;
  146. goto i2c_error;
  147. }
  148. /* write then read */
  149. obuf[0] = 0x09;
  150. obuf[1] = msg[0].len;
  151. obuf[2] = msg[1].len;
  152. obuf[3] = msg[0].addr;
  153. memcpy(&obuf[4], msg[0].buf, msg[0].len);
  154. ret = dvbsky_usb_generic_rw(d, obuf,
  155. msg[0].len + 4, ibuf, msg[1].len + 1);
  156. if (ret)
  157. dev_err(&d->udev->dev, "failed=%d\n", ret);
  158. if (!ret)
  159. memcpy(msg[1].buf, &ibuf[1], msg[1].len);
  160. }
  161. i2c_error:
  162. mutex_unlock(&d->i2c_mutex);
  163. return (ret) ? ret : num;
  164. }
  165. static u32 dvbsky_i2c_func(struct i2c_adapter *adapter)
  166. {
  167. return I2C_FUNC_I2C;
  168. }
  169. static struct i2c_algorithm dvbsky_i2c_algo = {
  170. .master_xfer = dvbsky_i2c_xfer,
  171. .functionality = dvbsky_i2c_func,
  172. };
  173. #if IS_ENABLED(CONFIG_RC_CORE)
  174. static int dvbsky_rc_query(struct dvb_usb_device *d)
  175. {
  176. u32 code = 0xffff, scancode;
  177. u8 rc5_command, rc5_system;
  178. u8 obuf[2], ibuf[2], toggle;
  179. int ret;
  180. obuf[0] = 0x10;
  181. ret = dvbsky_usb_generic_rw(d, obuf, 1, ibuf, 2);
  182. if (ret)
  183. dev_err(&d->udev->dev, "failed=%d\n", ret);
  184. if (ret == 0)
  185. code = (ibuf[0] << 8) | ibuf[1];
  186. if (code != 0xffff) {
  187. dev_dbg(&d->udev->dev, "rc code: %x\n", code);
  188. rc5_command = code & 0x3F;
  189. rc5_system = (code & 0x7C0) >> 6;
  190. toggle = (code & 0x800) ? 1 : 0;
  191. scancode = rc5_system << 8 | rc5_command;
  192. rc_keydown(d->rc_dev, RC_TYPE_RC5, scancode, toggle);
  193. }
  194. return 0;
  195. }
  196. static int dvbsky_get_rc_config(struct dvb_usb_device *d, struct dvb_usb_rc *rc)
  197. {
  198. if (dvb_usb_dvbsky_disable_rc) {
  199. rc->map_name = NULL;
  200. return 0;
  201. }
  202. rc->allowed_protos = RC_BIT_RC5;
  203. rc->query = dvbsky_rc_query;
  204. rc->interval = 300;
  205. return 0;
  206. }
  207. #else
  208. #define dvbsky_get_rc_config NULL
  209. #endif
  210. static int dvbsky_usb_set_voltage(struct dvb_frontend *fe,
  211. fe_sec_voltage_t voltage)
  212. {
  213. struct dvb_usb_device *d = fe_to_d(fe);
  214. struct dvbsky_state *state = d_to_priv(d);
  215. u8 value;
  216. if (voltage == SEC_VOLTAGE_OFF)
  217. value = 0;
  218. else
  219. value = 1;
  220. dvbsky_gpio_ctrl(d, 0x80, value);
  221. return state->fe_set_voltage(fe, voltage);
  222. }
  223. static int dvbsky_read_mac_addr(struct dvb_usb_adapter *adap, u8 mac[6])
  224. {
  225. struct dvb_usb_device *d = adap_to_d(adap);
  226. u8 obuf[] = { 0x1e, 0x00 };
  227. u8 ibuf[6] = { 0 };
  228. struct i2c_msg msg[] = {
  229. {
  230. .addr = 0x51,
  231. .flags = 0,
  232. .buf = obuf,
  233. .len = 2,
  234. }, {
  235. .addr = 0x51,
  236. .flags = I2C_M_RD,
  237. .buf = ibuf,
  238. .len = 6,
  239. }
  240. };
  241. if (i2c_transfer(&d->i2c_adap, msg, 2) == 2)
  242. memcpy(mac, ibuf, 6);
  243. return 0;
  244. }
  245. static int dvbsky_usb_read_status(struct dvb_frontend *fe, fe_status_t *status)
  246. {
  247. struct dvb_usb_device *d = fe_to_d(fe);
  248. struct dvbsky_state *state = d_to_priv(d);
  249. int ret;
  250. ret = state->fe_read_status(fe, status);
  251. /* it need resync slave fifo when signal change from unlock to lock.*/
  252. if ((*status & FE_HAS_LOCK) && (!state->last_lock))
  253. dvbsky_stream_ctrl(d, 1);
  254. state->last_lock = (*status & FE_HAS_LOCK) ? 1 : 0;
  255. return ret;
  256. }
  257. static const struct m88ds3103_config dvbsky_s960_m88ds3103_config = {
  258. .i2c_addr = 0x68,
  259. .clock = 27000000,
  260. .i2c_wr_max = 33,
  261. .clock_out = 0,
  262. .ts_mode = M88DS3103_TS_CI,
  263. .ts_clk = 16000,
  264. .ts_clk_pol = 0,
  265. .agc = 0x99,
  266. .lnb_hv_pol = 1,
  267. .lnb_en_pol = 1,
  268. };
  269. static int dvbsky_s960_attach(struct dvb_usb_adapter *adap)
  270. {
  271. struct dvbsky_state *state = adap_to_priv(adap);
  272. struct dvb_usb_device *d = adap_to_d(adap);
  273. int ret = 0;
  274. /* demod I2C adapter */
  275. struct i2c_adapter *i2c_adapter;
  276. struct i2c_client *client;
  277. struct i2c_board_info info;
  278. struct ts2020_config ts2020_config = {};
  279. memset(&info, 0, sizeof(struct i2c_board_info));
  280. /* attach demod */
  281. adap->fe[0] = dvb_attach(m88ds3103_attach,
  282. &dvbsky_s960_m88ds3103_config,
  283. &d->i2c_adap,
  284. &i2c_adapter);
  285. if (!adap->fe[0]) {
  286. dev_err(&d->udev->dev, "dvbsky_s960_attach fail.\n");
  287. ret = -ENODEV;
  288. goto fail_attach;
  289. }
  290. /* attach tuner */
  291. ts2020_config.fe = adap->fe[0];
  292. strlcpy(info.type, "ts2020", I2C_NAME_SIZE);
  293. info.addr = 0x60;
  294. info.platform_data = &ts2020_config;
  295. request_module("ts2020");
  296. client = i2c_new_device(i2c_adapter, &info);
  297. if (client == NULL || client->dev.driver == NULL) {
  298. dvb_frontend_detach(adap->fe[0]);
  299. ret = -ENODEV;
  300. goto fail_attach;
  301. }
  302. if (!try_module_get(client->dev.driver->owner)) {
  303. i2c_unregister_device(client);
  304. dvb_frontend_detach(adap->fe[0]);
  305. ret = -ENODEV;
  306. goto fail_attach;
  307. }
  308. /* delegate signal strength measurement to tuner */
  309. adap->fe[0]->ops.read_signal_strength =
  310. adap->fe[0]->ops.tuner_ops.get_rf_strength;
  311. /* hook fe: need to resync the slave fifo when signal locks. */
  312. state->fe_read_status = adap->fe[0]->ops.read_status;
  313. adap->fe[0]->ops.read_status = dvbsky_usb_read_status;
  314. /* hook fe: LNB off/on is control by Cypress usb chip. */
  315. state->fe_set_voltage = adap->fe[0]->ops.set_voltage;
  316. adap->fe[0]->ops.set_voltage = dvbsky_usb_set_voltage;
  317. state->i2c_client_tuner = client;
  318. fail_attach:
  319. return ret;
  320. }
  321. static int dvbsky_usb_ci_set_voltage(struct dvb_frontend *fe,
  322. fe_sec_voltage_t voltage)
  323. {
  324. struct dvb_usb_device *d = fe_to_d(fe);
  325. struct dvbsky_state *state = d_to_priv(d);
  326. u8 value;
  327. if (voltage == SEC_VOLTAGE_OFF)
  328. value = 0;
  329. else
  330. value = 1;
  331. dvbsky_gpio_ctrl(d, 0x00, value);
  332. return state->fe_set_voltage(fe, voltage);
  333. }
  334. static int dvbsky_ci_ctrl(void *priv, u8 read, int addr,
  335. u8 data, int *mem)
  336. {
  337. struct dvb_usb_device *d = priv;
  338. int ret = 0;
  339. u8 command[4], respond[2], command_size, respond_size;
  340. command[1] = (u8)((addr >> 8) & 0xff); /*high part of address*/
  341. command[2] = (u8)(addr & 0xff); /*low part of address*/
  342. if (read) {
  343. command[0] = 0x71;
  344. command_size = 3;
  345. respond_size = 2;
  346. } else {
  347. command[0] = 0x70;
  348. command[3] = data;
  349. command_size = 4;
  350. respond_size = 1;
  351. }
  352. ret = dvbsky_usb_generic_rw(d, command, command_size,
  353. respond, respond_size);
  354. if (ret)
  355. goto err;
  356. if (read)
  357. *mem = respond[1];
  358. return ret;
  359. err:
  360. dev_err(&d->udev->dev, "ci control failed=%d\n", ret);
  361. return ret;
  362. }
  363. static const struct m88ds3103_config dvbsky_s960c_m88ds3103_config = {
  364. .i2c_addr = 0x68,
  365. .clock = 27000000,
  366. .i2c_wr_max = 33,
  367. .clock_out = 0,
  368. .ts_mode = M88DS3103_TS_CI,
  369. .ts_clk = 10000,
  370. .ts_clk_pol = 1,
  371. .agc = 0x99,
  372. .lnb_hv_pol = 0,
  373. .lnb_en_pol = 1,
  374. };
  375. static int dvbsky_s960c_attach(struct dvb_usb_adapter *adap)
  376. {
  377. struct dvbsky_state *state = adap_to_priv(adap);
  378. struct dvb_usb_device *d = adap_to_d(adap);
  379. int ret = 0;
  380. /* demod I2C adapter */
  381. struct i2c_adapter *i2c_adapter;
  382. struct i2c_client *client_tuner, *client_ci;
  383. struct i2c_board_info info;
  384. struct sp2_config sp2_config;
  385. struct ts2020_config ts2020_config = {};
  386. memset(&info, 0, sizeof(struct i2c_board_info));
  387. /* attach demod */
  388. adap->fe[0] = dvb_attach(m88ds3103_attach,
  389. &dvbsky_s960c_m88ds3103_config,
  390. &d->i2c_adap,
  391. &i2c_adapter);
  392. if (!adap->fe[0]) {
  393. dev_err(&d->udev->dev, "dvbsky_s960ci_attach fail.\n");
  394. ret = -ENODEV;
  395. goto fail_attach;
  396. }
  397. /* attach tuner */
  398. ts2020_config.fe = adap->fe[0];
  399. strlcpy(info.type, "ts2020", I2C_NAME_SIZE);
  400. info.addr = 0x60;
  401. info.platform_data = &ts2020_config;
  402. request_module("ts2020");
  403. client_tuner = i2c_new_device(i2c_adapter, &info);
  404. if (client_tuner == NULL || client_tuner->dev.driver == NULL) {
  405. ret = -ENODEV;
  406. goto fail_tuner_device;
  407. }
  408. if (!try_module_get(client_tuner->dev.driver->owner)) {
  409. ret = -ENODEV;
  410. goto fail_tuner_module;
  411. }
  412. /* attach ci controller */
  413. memset(&sp2_config, 0, sizeof(sp2_config));
  414. sp2_config.dvb_adap = &adap->dvb_adap;
  415. sp2_config.priv = d;
  416. sp2_config.ci_control = dvbsky_ci_ctrl;
  417. memset(&info, 0, sizeof(struct i2c_board_info));
  418. strlcpy(info.type, "sp2", I2C_NAME_SIZE);
  419. info.addr = 0x40;
  420. info.platform_data = &sp2_config;
  421. request_module("sp2");
  422. client_ci = i2c_new_device(&d->i2c_adap, &info);
  423. if (client_ci == NULL || client_ci->dev.driver == NULL) {
  424. ret = -ENODEV;
  425. goto fail_ci_device;
  426. }
  427. if (!try_module_get(client_ci->dev.driver->owner)) {
  428. ret = -ENODEV;
  429. goto fail_ci_module;
  430. }
  431. /* delegate signal strength measurement to tuner */
  432. adap->fe[0]->ops.read_signal_strength =
  433. adap->fe[0]->ops.tuner_ops.get_rf_strength;
  434. /* hook fe: need to resync the slave fifo when signal locks. */
  435. state->fe_read_status = adap->fe[0]->ops.read_status;
  436. adap->fe[0]->ops.read_status = dvbsky_usb_read_status;
  437. /* hook fe: LNB off/on is control by Cypress usb chip. */
  438. state->fe_set_voltage = adap->fe[0]->ops.set_voltage;
  439. adap->fe[0]->ops.set_voltage = dvbsky_usb_ci_set_voltage;
  440. state->i2c_client_tuner = client_tuner;
  441. state->i2c_client_ci = client_ci;
  442. return ret;
  443. fail_ci_module:
  444. i2c_unregister_device(client_ci);
  445. fail_ci_device:
  446. module_put(client_tuner->dev.driver->owner);
  447. fail_tuner_module:
  448. i2c_unregister_device(client_tuner);
  449. fail_tuner_device:
  450. dvb_frontend_detach(adap->fe[0]);
  451. fail_attach:
  452. return ret;
  453. }
  454. static int dvbsky_t680c_attach(struct dvb_usb_adapter *adap)
  455. {
  456. struct dvbsky_state *state = adap_to_priv(adap);
  457. struct dvb_usb_device *d = adap_to_d(adap);
  458. int ret = 0;
  459. struct i2c_adapter *i2c_adapter;
  460. struct i2c_client *client_demod, *client_tuner, *client_ci;
  461. struct i2c_board_info info;
  462. struct si2168_config si2168_config;
  463. struct si2157_config si2157_config;
  464. struct sp2_config sp2_config;
  465. /* attach demod */
  466. memset(&si2168_config, 0, sizeof(si2168_config));
  467. si2168_config.i2c_adapter = &i2c_adapter;
  468. si2168_config.fe = &adap->fe[0];
  469. si2168_config.ts_mode = SI2168_TS_PARALLEL;
  470. memset(&info, 0, sizeof(struct i2c_board_info));
  471. strlcpy(info.type, "si2168", I2C_NAME_SIZE);
  472. info.addr = 0x64;
  473. info.platform_data = &si2168_config;
  474. request_module(info.type);
  475. client_demod = i2c_new_device(&d->i2c_adap, &info);
  476. if (client_demod == NULL ||
  477. client_demod->dev.driver == NULL)
  478. goto fail_demod_device;
  479. if (!try_module_get(client_demod->dev.driver->owner))
  480. goto fail_demod_module;
  481. /* attach tuner */
  482. memset(&si2157_config, 0, sizeof(si2157_config));
  483. si2157_config.fe = adap->fe[0];
  484. memset(&info, 0, sizeof(struct i2c_board_info));
  485. strlcpy(info.type, "si2157", I2C_NAME_SIZE);
  486. info.addr = 0x60;
  487. info.platform_data = &si2157_config;
  488. request_module(info.type);
  489. client_tuner = i2c_new_device(i2c_adapter, &info);
  490. if (client_tuner == NULL ||
  491. client_tuner->dev.driver == NULL)
  492. goto fail_tuner_device;
  493. if (!try_module_get(client_tuner->dev.driver->owner))
  494. goto fail_tuner_module;
  495. /* attach ci controller */
  496. memset(&sp2_config, 0, sizeof(sp2_config));
  497. sp2_config.dvb_adap = &adap->dvb_adap;
  498. sp2_config.priv = d;
  499. sp2_config.ci_control = dvbsky_ci_ctrl;
  500. memset(&info, 0, sizeof(struct i2c_board_info));
  501. strlcpy(info.type, "sp2", I2C_NAME_SIZE);
  502. info.addr = 0x40;
  503. info.platform_data = &sp2_config;
  504. request_module(info.type);
  505. client_ci = i2c_new_device(&d->i2c_adap, &info);
  506. if (client_ci == NULL || client_ci->dev.driver == NULL)
  507. goto fail_ci_device;
  508. if (!try_module_get(client_ci->dev.driver->owner))
  509. goto fail_ci_module;
  510. state->i2c_client_demod = client_demod;
  511. state->i2c_client_tuner = client_tuner;
  512. state->i2c_client_ci = client_ci;
  513. return ret;
  514. fail_ci_module:
  515. i2c_unregister_device(client_ci);
  516. fail_ci_device:
  517. module_put(client_tuner->dev.driver->owner);
  518. fail_tuner_module:
  519. i2c_unregister_device(client_tuner);
  520. fail_tuner_device:
  521. module_put(client_demod->dev.driver->owner);
  522. fail_demod_module:
  523. i2c_unregister_device(client_demod);
  524. fail_demod_device:
  525. ret = -ENODEV;
  526. return ret;
  527. }
  528. static int dvbsky_t330_attach(struct dvb_usb_adapter *adap)
  529. {
  530. struct dvbsky_state *state = adap_to_priv(adap);
  531. struct dvb_usb_device *d = adap_to_d(adap);
  532. int ret = 0;
  533. struct i2c_adapter *i2c_adapter;
  534. struct i2c_client *client_demod, *client_tuner;
  535. struct i2c_board_info info;
  536. struct si2168_config si2168_config;
  537. struct si2157_config si2157_config;
  538. /* attach demod */
  539. memset(&si2168_config, 0, sizeof(si2168_config));
  540. si2168_config.i2c_adapter = &i2c_adapter;
  541. si2168_config.fe = &adap->fe[0];
  542. si2168_config.ts_mode = SI2168_TS_PARALLEL | 0x40;
  543. memset(&info, 0, sizeof(struct i2c_board_info));
  544. strlcpy(info.type, "si2168", I2C_NAME_SIZE);
  545. info.addr = 0x64;
  546. info.platform_data = &si2168_config;
  547. request_module(info.type);
  548. client_demod = i2c_new_device(&d->i2c_adap, &info);
  549. if (client_demod == NULL ||
  550. client_demod->dev.driver == NULL)
  551. goto fail_demod_device;
  552. if (!try_module_get(client_demod->dev.driver->owner))
  553. goto fail_demod_module;
  554. /* attach tuner */
  555. memset(&si2157_config, 0, sizeof(si2157_config));
  556. si2157_config.fe = adap->fe[0];
  557. memset(&info, 0, sizeof(struct i2c_board_info));
  558. strlcpy(info.type, "si2157", I2C_NAME_SIZE);
  559. info.addr = 0x60;
  560. info.platform_data = &si2157_config;
  561. request_module(info.type);
  562. client_tuner = i2c_new_device(i2c_adapter, &info);
  563. if (client_tuner == NULL ||
  564. client_tuner->dev.driver == NULL)
  565. goto fail_tuner_device;
  566. if (!try_module_get(client_tuner->dev.driver->owner))
  567. goto fail_tuner_module;
  568. state->i2c_client_demod = client_demod;
  569. state->i2c_client_tuner = client_tuner;
  570. return ret;
  571. fail_tuner_module:
  572. i2c_unregister_device(client_tuner);
  573. fail_tuner_device:
  574. module_put(client_demod->dev.driver->owner);
  575. fail_demod_module:
  576. i2c_unregister_device(client_demod);
  577. fail_demod_device:
  578. ret = -ENODEV;
  579. return ret;
  580. }
  581. static int dvbsky_identify_state(struct dvb_usb_device *d, const char **name)
  582. {
  583. dvbsky_gpio_ctrl(d, 0x04, 1);
  584. msleep(20);
  585. dvbsky_gpio_ctrl(d, 0x83, 0);
  586. dvbsky_gpio_ctrl(d, 0xc0, 1);
  587. msleep(100);
  588. dvbsky_gpio_ctrl(d, 0x83, 1);
  589. dvbsky_gpio_ctrl(d, 0xc0, 0);
  590. msleep(50);
  591. return WARM;
  592. }
  593. static int dvbsky_init(struct dvb_usb_device *d)
  594. {
  595. struct dvbsky_state *state = d_to_priv(d);
  596. /* use default interface */
  597. /*
  598. ret = usb_set_interface(d->udev, 0, 0);
  599. if (ret)
  600. return ret;
  601. */
  602. mutex_init(&state->stream_mutex);
  603. state->last_lock = 0;
  604. return 0;
  605. }
  606. static void dvbsky_exit(struct dvb_usb_device *d)
  607. {
  608. struct dvbsky_state *state = d_to_priv(d);
  609. struct i2c_client *client;
  610. client = state->i2c_client_tuner;
  611. /* remove I2C tuner */
  612. if (client) {
  613. module_put(client->dev.driver->owner);
  614. i2c_unregister_device(client);
  615. }
  616. client = state->i2c_client_demod;
  617. /* remove I2C demod */
  618. if (client) {
  619. module_put(client->dev.driver->owner);
  620. i2c_unregister_device(client);
  621. }
  622. client = state->i2c_client_ci;
  623. /* remove I2C ci */
  624. if (client) {
  625. module_put(client->dev.driver->owner);
  626. i2c_unregister_device(client);
  627. }
  628. }
  629. /* DVB USB Driver stuff */
  630. static struct dvb_usb_device_properties dvbsky_s960_props = {
  631. .driver_name = KBUILD_MODNAME,
  632. .owner = THIS_MODULE,
  633. .adapter_nr = adapter_nr,
  634. .size_of_priv = sizeof(struct dvbsky_state),
  635. .generic_bulk_ctrl_endpoint = 0x01,
  636. .generic_bulk_ctrl_endpoint_response = 0x81,
  637. .generic_bulk_ctrl_delay = DVBSKY_MSG_DELAY,
  638. .i2c_algo = &dvbsky_i2c_algo,
  639. .frontend_attach = dvbsky_s960_attach,
  640. .init = dvbsky_init,
  641. .get_rc_config = dvbsky_get_rc_config,
  642. .streaming_ctrl = dvbsky_streaming_ctrl,
  643. .identify_state = dvbsky_identify_state,
  644. .exit = dvbsky_exit,
  645. .read_mac_address = dvbsky_read_mac_addr,
  646. .num_adapters = 1,
  647. .adapter = {
  648. {
  649. .stream = DVB_USB_STREAM_BULK(0x82, 8, 4096),
  650. }
  651. }
  652. };
  653. static struct dvb_usb_device_properties dvbsky_s960c_props = {
  654. .driver_name = KBUILD_MODNAME,
  655. .owner = THIS_MODULE,
  656. .adapter_nr = adapter_nr,
  657. .size_of_priv = sizeof(struct dvbsky_state),
  658. .generic_bulk_ctrl_endpoint = 0x01,
  659. .generic_bulk_ctrl_endpoint_response = 0x81,
  660. .generic_bulk_ctrl_delay = DVBSKY_MSG_DELAY,
  661. .i2c_algo = &dvbsky_i2c_algo,
  662. .frontend_attach = dvbsky_s960c_attach,
  663. .init = dvbsky_init,
  664. .get_rc_config = dvbsky_get_rc_config,
  665. .streaming_ctrl = dvbsky_streaming_ctrl,
  666. .identify_state = dvbsky_identify_state,
  667. .exit = dvbsky_exit,
  668. .read_mac_address = dvbsky_read_mac_addr,
  669. .num_adapters = 1,
  670. .adapter = {
  671. {
  672. .stream = DVB_USB_STREAM_BULK(0x82, 8, 4096),
  673. }
  674. }
  675. };
  676. static struct dvb_usb_device_properties dvbsky_t680c_props = {
  677. .driver_name = KBUILD_MODNAME,
  678. .owner = THIS_MODULE,
  679. .adapter_nr = adapter_nr,
  680. .size_of_priv = sizeof(struct dvbsky_state),
  681. .generic_bulk_ctrl_endpoint = 0x01,
  682. .generic_bulk_ctrl_endpoint_response = 0x81,
  683. .generic_bulk_ctrl_delay = DVBSKY_MSG_DELAY,
  684. .i2c_algo = &dvbsky_i2c_algo,
  685. .frontend_attach = dvbsky_t680c_attach,
  686. .init = dvbsky_init,
  687. .get_rc_config = dvbsky_get_rc_config,
  688. .streaming_ctrl = dvbsky_streaming_ctrl,
  689. .identify_state = dvbsky_identify_state,
  690. .exit = dvbsky_exit,
  691. .read_mac_address = dvbsky_read_mac_addr,
  692. .num_adapters = 1,
  693. .adapter = {
  694. {
  695. .stream = DVB_USB_STREAM_BULK(0x82, 8, 4096),
  696. }
  697. }
  698. };
  699. static struct dvb_usb_device_properties dvbsky_t330_props = {
  700. .driver_name = KBUILD_MODNAME,
  701. .owner = THIS_MODULE,
  702. .adapter_nr = adapter_nr,
  703. .size_of_priv = sizeof(struct dvbsky_state),
  704. .generic_bulk_ctrl_endpoint = 0x01,
  705. .generic_bulk_ctrl_endpoint_response = 0x81,
  706. .generic_bulk_ctrl_delay = DVBSKY_MSG_DELAY,
  707. .i2c_algo = &dvbsky_i2c_algo,
  708. .frontend_attach = dvbsky_t330_attach,
  709. .init = dvbsky_init,
  710. .get_rc_config = dvbsky_get_rc_config,
  711. .streaming_ctrl = dvbsky_streaming_ctrl,
  712. .identify_state = dvbsky_identify_state,
  713. .exit = dvbsky_exit,
  714. .read_mac_address = dvbsky_read_mac_addr,
  715. .num_adapters = 1,
  716. .adapter = {
  717. {
  718. .stream = DVB_USB_STREAM_BULK(0x82, 8, 4096),
  719. }
  720. }
  721. };
  722. static const struct usb_device_id dvbsky_id_table[] = {
  723. { DVB_USB_DEVICE(0x0572, 0x6831,
  724. &dvbsky_s960_props, "DVBSky S960/S860", RC_MAP_DVBSKY) },
  725. { DVB_USB_DEVICE(0x0572, 0x960c,
  726. &dvbsky_s960c_props, "DVBSky S960CI", RC_MAP_DVBSKY) },
  727. { DVB_USB_DEVICE(0x0572, 0x680c,
  728. &dvbsky_t680c_props, "DVBSky T680CI", RC_MAP_DVBSKY) },
  729. { DVB_USB_DEVICE(0x0572, 0x0320,
  730. &dvbsky_t330_props, "DVBSky T330", RC_MAP_DVBSKY) },
  731. { DVB_USB_DEVICE(USB_VID_TECHNOTREND,
  732. USB_PID_TECHNOTREND_TVSTICK_CT2_4400,
  733. &dvbsky_t330_props, "TechnoTrend TVStick CT2-4400",
  734. RC_MAP_TT_1500) },
  735. { DVB_USB_DEVICE(USB_VID_TECHNOTREND,
  736. USB_PID_TECHNOTREND_CONNECT_CT2_4650_CI,
  737. &dvbsky_t680c_props, "TechnoTrend TT-connect CT2-4650 CI",
  738. RC_MAP_TT_1500) },
  739. { }
  740. };
  741. MODULE_DEVICE_TABLE(usb, dvbsky_id_table);
  742. static struct usb_driver dvbsky_usb_driver = {
  743. .name = KBUILD_MODNAME,
  744. .id_table = dvbsky_id_table,
  745. .probe = dvb_usbv2_probe,
  746. .disconnect = dvb_usbv2_disconnect,
  747. .suspend = dvb_usbv2_suspend,
  748. .resume = dvb_usbv2_resume,
  749. .reset_resume = dvb_usbv2_reset_resume,
  750. .no_dynamic_id = 1,
  751. .soft_unbind = 1,
  752. };
  753. module_usb_driver(dvbsky_usb_driver);
  754. MODULE_AUTHOR("Max nibble <nibble.max@gmail.com>");
  755. MODULE_DESCRIPTION("Driver for DVBSky USB");
  756. MODULE_LICENSE("GPL");