dvbsky.c 23 KB

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