cx231xx-core.c 44 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735
  1. /*
  2. cx231xx-core.c - driver for Conexant Cx23100/101/102
  3. USB video capture devices
  4. Copyright (C) 2008 <srinivasa.deevi at conexant dot com>
  5. Based on em28xx driver
  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. This program is distributed in the hope that it will be useful,
  11. but WITHOUT ANY WARRANTY; without even the implied warranty of
  12. MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  13. GNU General Public License for more details.
  14. You should have received a copy of the GNU General Public License
  15. along with this program; if not, write to the Free Software
  16. Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  17. */
  18. #include <linux/init.h>
  19. #include <linux/list.h>
  20. #include <linux/module.h>
  21. #include <linux/slab.h>
  22. #include <linux/usb.h>
  23. #include <linux/vmalloc.h>
  24. #include <media/v4l2-common.h>
  25. #include <media/tuner.h>
  26. #include "cx231xx.h"
  27. #include "cx231xx-reg.h"
  28. /* #define ENABLE_DEBUG_ISOC_FRAMES */
  29. static unsigned int core_debug;
  30. module_param(core_debug, int, 0644);
  31. MODULE_PARM_DESC(core_debug, "enable debug messages [core]");
  32. #define cx231xx_coredbg(fmt, arg...) do {\
  33. if (core_debug) \
  34. printk(KERN_INFO "%s %s :"fmt, \
  35. dev->name, __func__ , ##arg); } while (0)
  36. static unsigned int reg_debug;
  37. module_param(reg_debug, int, 0644);
  38. MODULE_PARM_DESC(reg_debug, "enable debug messages [URB reg]");
  39. static int alt = CX231XX_PINOUT;
  40. module_param(alt, int, 0644);
  41. MODULE_PARM_DESC(alt, "alternate setting to use for video endpoint");
  42. #define cx231xx_isocdbg(fmt, arg...) do {\
  43. if (core_debug) \
  44. printk(KERN_INFO "%s %s :"fmt, \
  45. dev->name, __func__ , ##arg); } while (0)
  46. /*****************************************************************
  47. * Device control list functions *
  48. ******************************************************************/
  49. LIST_HEAD(cx231xx_devlist);
  50. static DEFINE_MUTEX(cx231xx_devlist_mutex);
  51. /*
  52. * cx231xx_realease_resources()
  53. * unregisters the v4l2,i2c and usb devices
  54. * called when the device gets disconected or at module unload
  55. */
  56. void cx231xx_remove_from_devlist(struct cx231xx *dev)
  57. {
  58. if (dev == NULL)
  59. return;
  60. if (dev->udev == NULL)
  61. return;
  62. if (atomic_read(&dev->devlist_count) > 0) {
  63. mutex_lock(&cx231xx_devlist_mutex);
  64. list_del(&dev->devlist);
  65. atomic_dec(&dev->devlist_count);
  66. mutex_unlock(&cx231xx_devlist_mutex);
  67. }
  68. };
  69. void cx231xx_add_into_devlist(struct cx231xx *dev)
  70. {
  71. mutex_lock(&cx231xx_devlist_mutex);
  72. list_add_tail(&dev->devlist, &cx231xx_devlist);
  73. atomic_inc(&dev->devlist_count);
  74. mutex_unlock(&cx231xx_devlist_mutex);
  75. };
  76. static LIST_HEAD(cx231xx_extension_devlist);
  77. int cx231xx_register_extension(struct cx231xx_ops *ops)
  78. {
  79. struct cx231xx *dev = NULL;
  80. mutex_lock(&cx231xx_devlist_mutex);
  81. list_add_tail(&ops->next, &cx231xx_extension_devlist);
  82. list_for_each_entry(dev, &cx231xx_devlist, devlist)
  83. ops->init(dev);
  84. printk(KERN_INFO DRIVER_NAME ": %s initialized\n", ops->name);
  85. mutex_unlock(&cx231xx_devlist_mutex);
  86. return 0;
  87. }
  88. EXPORT_SYMBOL(cx231xx_register_extension);
  89. void cx231xx_unregister_extension(struct cx231xx_ops *ops)
  90. {
  91. struct cx231xx *dev = NULL;
  92. mutex_lock(&cx231xx_devlist_mutex);
  93. list_for_each_entry(dev, &cx231xx_devlist, devlist)
  94. ops->fini(dev);
  95. printk(KERN_INFO DRIVER_NAME ": %s removed\n", ops->name);
  96. list_del(&ops->next);
  97. mutex_unlock(&cx231xx_devlist_mutex);
  98. }
  99. EXPORT_SYMBOL(cx231xx_unregister_extension);
  100. void cx231xx_init_extension(struct cx231xx *dev)
  101. {
  102. struct cx231xx_ops *ops = NULL;
  103. mutex_lock(&cx231xx_devlist_mutex);
  104. if (!list_empty(&cx231xx_extension_devlist)) {
  105. list_for_each_entry(ops, &cx231xx_extension_devlist, next) {
  106. if (ops->init)
  107. ops->init(dev);
  108. }
  109. }
  110. mutex_unlock(&cx231xx_devlist_mutex);
  111. }
  112. void cx231xx_close_extension(struct cx231xx *dev)
  113. {
  114. struct cx231xx_ops *ops = NULL;
  115. mutex_lock(&cx231xx_devlist_mutex);
  116. if (!list_empty(&cx231xx_extension_devlist)) {
  117. list_for_each_entry(ops, &cx231xx_extension_devlist, next) {
  118. if (ops->fini)
  119. ops->fini(dev);
  120. }
  121. }
  122. mutex_unlock(&cx231xx_devlist_mutex);
  123. }
  124. /****************************************************************
  125. * U S B related functions *
  126. *****************************************************************/
  127. int cx231xx_send_usb_command(struct cx231xx_i2c *i2c_bus,
  128. struct cx231xx_i2c_xfer_data *req_data)
  129. {
  130. int status = 0;
  131. struct cx231xx *dev = i2c_bus->dev;
  132. struct VENDOR_REQUEST_IN ven_req;
  133. u8 saddr_len = 0;
  134. u8 _i2c_period = 0;
  135. u8 _i2c_nostop = 0;
  136. u8 _i2c_reserve = 0;
  137. /* Get the I2C period, nostop and reserve parameters */
  138. _i2c_period = i2c_bus->i2c_period;
  139. _i2c_nostop = i2c_bus->i2c_nostop;
  140. _i2c_reserve = i2c_bus->i2c_reserve;
  141. saddr_len = req_data->saddr_len;
  142. /* Set wValue */
  143. if (saddr_len == 1) /* need check saddr_len == 0 */
  144. ven_req.wValue =
  145. req_data->
  146. dev_addr << 9 | _i2c_period << 4 | saddr_len << 2 |
  147. _i2c_nostop << 1 | I2C_SYNC | _i2c_reserve << 6;
  148. else
  149. ven_req.wValue =
  150. req_data->
  151. dev_addr << 9 | _i2c_period << 4 | saddr_len << 2 |
  152. _i2c_nostop << 1 | I2C_SYNC | _i2c_reserve << 6;
  153. /* set channel number */
  154. if (req_data->direction & I2C_M_RD) {
  155. /* channel number, for read,spec required channel_num +4 */
  156. ven_req.bRequest = i2c_bus->nr + 4;
  157. } else
  158. ven_req.bRequest = i2c_bus->nr; /* channel number, */
  159. /* set index value */
  160. switch (saddr_len) {
  161. case 0:
  162. ven_req.wIndex = 0; /* need check */
  163. break;
  164. case 1:
  165. ven_req.wIndex = (req_data->saddr_dat & 0xff);
  166. break;
  167. case 2:
  168. ven_req.wIndex = req_data->saddr_dat;
  169. break;
  170. }
  171. /* set wLength value */
  172. ven_req.wLength = req_data->buf_size;
  173. /* set bData value */
  174. ven_req.bData = 0;
  175. /* set the direction */
  176. if (req_data->direction) {
  177. ven_req.direction = USB_DIR_IN;
  178. memset(req_data->p_buffer, 0x00, ven_req.wLength);
  179. } else
  180. ven_req.direction = USB_DIR_OUT;
  181. /* set the buffer for read / write */
  182. ven_req.pBuff = req_data->p_buffer;
  183. /* call common vendor command request */
  184. status = cx231xx_send_vendor_cmd(dev, &ven_req);
  185. if (status < 0) {
  186. cx231xx_info
  187. ("UsbInterface::sendCommand, failed with status -%d\n",
  188. status);
  189. }
  190. return status;
  191. }
  192. EXPORT_SYMBOL_GPL(cx231xx_send_usb_command);
  193. /*
  194. * Sends/Receives URB control messages, assuring to use a kalloced buffer
  195. * for all operations (dev->urb_buf), to avoid using stacked buffers, as
  196. * they aren't safe for usage with USB, due to DMA restrictions.
  197. * Also implements the debug code for control URB's.
  198. */
  199. static int __usb_control_msg(struct cx231xx *dev, unsigned int pipe,
  200. __u8 request, __u8 requesttype, __u16 value, __u16 index,
  201. void *data, __u16 size, int timeout)
  202. {
  203. int rc, i;
  204. if (reg_debug) {
  205. printk(KERN_DEBUG "%s: (pipe 0x%08x): "
  206. "%s: %02x %02x %02x %02x %02x %02x %02x %02x ",
  207. dev->name,
  208. pipe,
  209. (requesttype & USB_DIR_IN) ? "IN" : "OUT",
  210. requesttype,
  211. request,
  212. value & 0xff, value >> 8,
  213. index & 0xff, index >> 8,
  214. size & 0xff, size >> 8);
  215. if (!(requesttype & USB_DIR_IN)) {
  216. printk(KERN_CONT ">>>");
  217. for (i = 0; i < size; i++)
  218. printk(KERN_CONT " %02x",
  219. ((unsigned char *)data)[i]);
  220. }
  221. }
  222. /* Do the real call to usb_control_msg */
  223. mutex_lock(&dev->ctrl_urb_lock);
  224. if (!(requesttype & USB_DIR_IN) && size)
  225. memcpy(dev->urb_buf, data, size);
  226. rc = usb_control_msg(dev->udev, pipe, request, requesttype, value,
  227. index, dev->urb_buf, size, timeout);
  228. if ((requesttype & USB_DIR_IN) && size)
  229. memcpy(data, dev->urb_buf, size);
  230. mutex_unlock(&dev->ctrl_urb_lock);
  231. if (reg_debug) {
  232. if (unlikely(rc < 0)) {
  233. printk(KERN_CONT "FAILED!\n");
  234. return rc;
  235. }
  236. if ((requesttype & USB_DIR_IN)) {
  237. printk(KERN_CONT "<<<");
  238. for (i = 0; i < size; i++)
  239. printk(KERN_CONT " %02x",
  240. ((unsigned char *)data)[i]);
  241. }
  242. printk(KERN_CONT "\n");
  243. }
  244. return rc;
  245. }
  246. /*
  247. * cx231xx_read_ctrl_reg()
  248. * reads data from the usb device specifying bRequest and wValue
  249. */
  250. int cx231xx_read_ctrl_reg(struct cx231xx *dev, u8 req, u16 reg,
  251. char *buf, int len)
  252. {
  253. u8 val = 0;
  254. int ret;
  255. int pipe = usb_rcvctrlpipe(dev->udev, 0);
  256. if (dev->state & DEV_DISCONNECTED)
  257. return -ENODEV;
  258. if (len > URB_MAX_CTRL_SIZE)
  259. return -EINVAL;
  260. switch (len) {
  261. case 1:
  262. val = ENABLE_ONE_BYTE;
  263. break;
  264. case 2:
  265. val = ENABLE_TWE_BYTE;
  266. break;
  267. case 3:
  268. val = ENABLE_THREE_BYTE;
  269. break;
  270. case 4:
  271. val = ENABLE_FOUR_BYTE;
  272. break;
  273. default:
  274. val = 0xFF; /* invalid option */
  275. }
  276. if (val == 0xFF)
  277. return -EINVAL;
  278. ret = __usb_control_msg(dev, pipe, req,
  279. USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
  280. val, reg, buf, len, HZ);
  281. return ret;
  282. }
  283. int cx231xx_send_vendor_cmd(struct cx231xx *dev,
  284. struct VENDOR_REQUEST_IN *ven_req)
  285. {
  286. int ret;
  287. int pipe = 0;
  288. int unsend_size = 0;
  289. u8 *pdata;
  290. if (dev->state & DEV_DISCONNECTED)
  291. return -ENODEV;
  292. if ((ven_req->wLength > URB_MAX_CTRL_SIZE))
  293. return -EINVAL;
  294. if (ven_req->direction)
  295. pipe = usb_rcvctrlpipe(dev->udev, 0);
  296. else
  297. pipe = usb_sndctrlpipe(dev->udev, 0);
  298. /*
  299. * If the cx23102 read more than 4 bytes with i2c bus,
  300. * need chop to 4 byte per request
  301. */
  302. if ((ven_req->wLength > 4) && ((ven_req->bRequest == 0x4) ||
  303. (ven_req->bRequest == 0x5) ||
  304. (ven_req->bRequest == 0x6))) {
  305. unsend_size = 0;
  306. pdata = ven_req->pBuff;
  307. unsend_size = ven_req->wLength;
  308. /* the first package */
  309. ven_req->wValue = ven_req->wValue & 0xFFFB;
  310. ven_req->wValue = (ven_req->wValue & 0xFFBD) | 0x2;
  311. ret = __usb_control_msg(dev, pipe, ven_req->bRequest,
  312. ven_req->direction | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
  313. ven_req->wValue, ven_req->wIndex, pdata,
  314. 0x0004, HZ);
  315. unsend_size = unsend_size - 4;
  316. /* the middle package */
  317. ven_req->wValue = (ven_req->wValue & 0xFFBD) | 0x42;
  318. while (unsend_size - 4 > 0) {
  319. pdata = pdata + 4;
  320. ret = __usb_control_msg(dev, pipe,
  321. ven_req->bRequest,
  322. ven_req->direction | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
  323. ven_req->wValue, ven_req->wIndex, pdata,
  324. 0x0004, HZ);
  325. unsend_size = unsend_size - 4;
  326. }
  327. /* the last package */
  328. ven_req->wValue = (ven_req->wValue & 0xFFBD) | 0x40;
  329. pdata = pdata + 4;
  330. ret = __usb_control_msg(dev, pipe, ven_req->bRequest,
  331. ven_req->direction | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
  332. ven_req->wValue, ven_req->wIndex, pdata,
  333. unsend_size, HZ);
  334. } else {
  335. ret = __usb_control_msg(dev, pipe, ven_req->bRequest,
  336. ven_req->direction | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
  337. ven_req->wValue, ven_req->wIndex,
  338. ven_req->pBuff, ven_req->wLength, HZ);
  339. }
  340. return ret;
  341. }
  342. /*
  343. * cx231xx_write_ctrl_reg()
  344. * sends data to the usb device, specifying bRequest
  345. */
  346. int cx231xx_write_ctrl_reg(struct cx231xx *dev, u8 req, u16 reg, char *buf,
  347. int len)
  348. {
  349. u8 val = 0;
  350. int ret;
  351. int pipe = usb_sndctrlpipe(dev->udev, 0);
  352. if (dev->state & DEV_DISCONNECTED)
  353. return -ENODEV;
  354. if ((len < 1) || (len > URB_MAX_CTRL_SIZE))
  355. return -EINVAL;
  356. switch (len) {
  357. case 1:
  358. val = ENABLE_ONE_BYTE;
  359. break;
  360. case 2:
  361. val = ENABLE_TWE_BYTE;
  362. break;
  363. case 3:
  364. val = ENABLE_THREE_BYTE;
  365. break;
  366. case 4:
  367. val = ENABLE_FOUR_BYTE;
  368. break;
  369. default:
  370. val = 0xFF; /* invalid option */
  371. }
  372. if (val == 0xFF)
  373. return -EINVAL;
  374. if (reg_debug) {
  375. int byte;
  376. cx231xx_isocdbg("(pipe 0x%08x): "
  377. "OUT: %02x %02x %02x %02x %02x %02x %02x %02x >>>",
  378. pipe,
  379. USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
  380. req, 0, val, reg & 0xff,
  381. reg >> 8, len & 0xff, len >> 8);
  382. for (byte = 0; byte < len; byte++)
  383. cx231xx_isocdbg(" %02x", (unsigned char)buf[byte]);
  384. cx231xx_isocdbg("\n");
  385. }
  386. ret = __usb_control_msg(dev, pipe, req,
  387. USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
  388. val, reg, buf, len, HZ);
  389. return ret;
  390. }
  391. /****************************************************************
  392. * USB Alternate Setting functions *
  393. *****************************************************************/
  394. int cx231xx_set_video_alternate(struct cx231xx *dev)
  395. {
  396. int errCode, prev_alt = dev->video_mode.alt;
  397. unsigned int min_pkt_size = dev->width * 2 + 4;
  398. u32 usb_interface_index = 0;
  399. /* When image size is bigger than a certain value,
  400. the frame size should be increased, otherwise, only
  401. green screen will be received.
  402. */
  403. if (dev->width * 2 * dev->height > 720 * 240 * 2)
  404. min_pkt_size *= 2;
  405. if (dev->width > 360) {
  406. /* resolutions: 720,704,640 */
  407. dev->video_mode.alt = 3;
  408. } else if (dev->width > 180) {
  409. /* resolutions: 360,352,320,240 */
  410. dev->video_mode.alt = 2;
  411. } else if (dev->width > 0) {
  412. /* resolutions: 180,176,160,128,88 */
  413. dev->video_mode.alt = 1;
  414. } else {
  415. /* Change to alt0 BULK to release USB bandwidth */
  416. dev->video_mode.alt = 0;
  417. }
  418. if (dev->USE_ISO == 0)
  419. dev->video_mode.alt = 0;
  420. cx231xx_coredbg("dev->video_mode.alt= %d\n", dev->video_mode.alt);
  421. /* Get the correct video interface Index */
  422. usb_interface_index =
  423. dev->current_pcb_config.hs_config_info[0].interface_info.
  424. video_index + 1;
  425. if (dev->video_mode.alt != prev_alt) {
  426. cx231xx_coredbg("minimum isoc packet size: %u (alt=%d)\n",
  427. min_pkt_size, dev->video_mode.alt);
  428. if (dev->video_mode.alt_max_pkt_size != NULL)
  429. dev->video_mode.max_pkt_size =
  430. dev->video_mode.alt_max_pkt_size[dev->video_mode.alt];
  431. cx231xx_coredbg("setting alternate %d with wMaxPacketSize=%u\n",
  432. dev->video_mode.alt,
  433. dev->video_mode.max_pkt_size);
  434. errCode =
  435. usb_set_interface(dev->udev, usb_interface_index,
  436. dev->video_mode.alt);
  437. if (errCode < 0) {
  438. cx231xx_errdev
  439. ("cannot change alt number to %d (error=%i)\n",
  440. dev->video_mode.alt, errCode);
  441. return errCode;
  442. }
  443. }
  444. return 0;
  445. }
  446. int cx231xx_set_alt_setting(struct cx231xx *dev, u8 index, u8 alt)
  447. {
  448. int status = 0;
  449. u32 usb_interface_index = 0;
  450. u32 max_pkt_size = 0;
  451. switch (index) {
  452. case INDEX_TS1:
  453. usb_interface_index =
  454. dev->current_pcb_config.hs_config_info[0].interface_info.
  455. ts1_index + 1;
  456. dev->ts1_mode.alt = alt;
  457. if (dev->ts1_mode.alt_max_pkt_size != NULL)
  458. max_pkt_size = dev->ts1_mode.max_pkt_size =
  459. dev->ts1_mode.alt_max_pkt_size[dev->ts1_mode.alt];
  460. break;
  461. case INDEX_TS2:
  462. usb_interface_index =
  463. dev->current_pcb_config.hs_config_info[0].interface_info.
  464. ts2_index + 1;
  465. break;
  466. case INDEX_AUDIO:
  467. usb_interface_index =
  468. dev->current_pcb_config.hs_config_info[0].interface_info.
  469. audio_index + 1;
  470. dev->adev.alt = alt;
  471. if (dev->adev.alt_max_pkt_size != NULL)
  472. max_pkt_size = dev->adev.max_pkt_size =
  473. dev->adev.alt_max_pkt_size[dev->adev.alt];
  474. break;
  475. case INDEX_VIDEO:
  476. usb_interface_index =
  477. dev->current_pcb_config.hs_config_info[0].interface_info.
  478. video_index + 1;
  479. dev->video_mode.alt = alt;
  480. if (dev->video_mode.alt_max_pkt_size != NULL)
  481. max_pkt_size = dev->video_mode.max_pkt_size =
  482. dev->video_mode.alt_max_pkt_size[dev->video_mode.
  483. alt];
  484. break;
  485. case INDEX_VANC:
  486. if (dev->board.no_alt_vanc)
  487. return 0;
  488. usb_interface_index =
  489. dev->current_pcb_config.hs_config_info[0].interface_info.
  490. vanc_index + 1;
  491. dev->vbi_mode.alt = alt;
  492. if (dev->vbi_mode.alt_max_pkt_size != NULL)
  493. max_pkt_size = dev->vbi_mode.max_pkt_size =
  494. dev->vbi_mode.alt_max_pkt_size[dev->vbi_mode.alt];
  495. break;
  496. case INDEX_HANC:
  497. usb_interface_index =
  498. dev->current_pcb_config.hs_config_info[0].interface_info.
  499. hanc_index + 1;
  500. dev->sliced_cc_mode.alt = alt;
  501. if (dev->sliced_cc_mode.alt_max_pkt_size != NULL)
  502. max_pkt_size = dev->sliced_cc_mode.max_pkt_size =
  503. dev->sliced_cc_mode.alt_max_pkt_size[dev->
  504. sliced_cc_mode.
  505. alt];
  506. break;
  507. default:
  508. break;
  509. }
  510. if (alt > 0 && max_pkt_size == 0) {
  511. cx231xx_errdev
  512. ("can't change interface %d alt no. to %d: Max. Pkt size = 0\n",
  513. usb_interface_index, alt);
  514. /*To workaround error number=-71 on EP0 for videograbber,
  515. need add following codes.*/
  516. if (dev->board.no_alt_vanc)
  517. return -1;
  518. }
  519. cx231xx_coredbg("setting alternate %d with wMaxPacketSize=%u,"
  520. "Interface = %d\n", alt, max_pkt_size,
  521. usb_interface_index);
  522. if (usb_interface_index > 0) {
  523. status = usb_set_interface(dev->udev, usb_interface_index, alt);
  524. if (status < 0) {
  525. cx231xx_errdev
  526. ("can't change interface %d alt no. to %d (err=%i)\n",
  527. usb_interface_index, alt, status);
  528. return status;
  529. }
  530. }
  531. return status;
  532. }
  533. EXPORT_SYMBOL_GPL(cx231xx_set_alt_setting);
  534. int cx231xx_gpio_set(struct cx231xx *dev, struct cx231xx_reg_seq *gpio)
  535. {
  536. int rc = 0;
  537. if (!gpio)
  538. return rc;
  539. /* Send GPIO reset sequences specified at board entry */
  540. while (gpio->sleep >= 0) {
  541. rc = cx231xx_set_gpio_value(dev, gpio->bit, gpio->val);
  542. if (rc < 0)
  543. return rc;
  544. if (gpio->sleep > 0)
  545. msleep(gpio->sleep);
  546. gpio++;
  547. }
  548. return rc;
  549. }
  550. int cx231xx_demod_reset(struct cx231xx *dev)
  551. {
  552. u8 status = 0;
  553. u8 value[4] = { 0, 0, 0, 0 };
  554. status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, PWR_CTL_EN,
  555. value, 4);
  556. cx231xx_coredbg("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", PWR_CTL_EN,
  557. value[0], value[1], value[2], value[3]);
  558. cx231xx_coredbg("Enter cx231xx_demod_reset()\n");
  559. value[1] = (u8) 0x3;
  560. status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
  561. PWR_CTL_EN, value, 4);
  562. msleep(10);
  563. value[1] = (u8) 0x0;
  564. status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
  565. PWR_CTL_EN, value, 4);
  566. msleep(10);
  567. value[1] = (u8) 0x3;
  568. status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
  569. PWR_CTL_EN, value, 4);
  570. msleep(10);
  571. status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, PWR_CTL_EN,
  572. value, 4);
  573. cx231xx_coredbg("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", PWR_CTL_EN,
  574. value[0], value[1], value[2], value[3]);
  575. return status;
  576. }
  577. EXPORT_SYMBOL_GPL(cx231xx_demod_reset);
  578. int is_fw_load(struct cx231xx *dev)
  579. {
  580. return cx231xx_check_fw(dev);
  581. }
  582. EXPORT_SYMBOL_GPL(is_fw_load);
  583. int cx231xx_set_mode(struct cx231xx *dev, enum cx231xx_mode set_mode)
  584. {
  585. int errCode = 0;
  586. if (dev->mode == set_mode)
  587. return 0;
  588. if (set_mode == CX231XX_SUSPEND) {
  589. /* Set the chip in power saving mode */
  590. dev->mode = set_mode;
  591. }
  592. /* Resource is locked */
  593. if (dev->mode != CX231XX_SUSPEND)
  594. return -EINVAL;
  595. dev->mode = set_mode;
  596. if (dev->mode == CX231XX_DIGITAL_MODE)/* Set Digital power mode */ {
  597. /* set AGC mode to Digital */
  598. switch (dev->model) {
  599. case CX231XX_BOARD_CNXT_CARRAERA:
  600. case CX231XX_BOARD_CNXT_RDE_250:
  601. case CX231XX_BOARD_CNXT_SHELBY:
  602. case CX231XX_BOARD_CNXT_RDU_250:
  603. errCode = cx231xx_set_agc_analog_digital_mux_select(dev, 0);
  604. break;
  605. case CX231XX_BOARD_CNXT_RDE_253S:
  606. case CX231XX_BOARD_CNXT_RDU_253S:
  607. errCode = cx231xx_set_agc_analog_digital_mux_select(dev, 1);
  608. break;
  609. case CX231XX_BOARD_HAUPPAUGE_EXETER:
  610. errCode = cx231xx_set_power_mode(dev,
  611. POLARIS_AVMODE_DIGITAL);
  612. break;
  613. default:
  614. break;
  615. }
  616. } else/* Set Analog Power mode */ {
  617. /* set AGC mode to Analog */
  618. switch (dev->model) {
  619. case CX231XX_BOARD_CNXT_CARRAERA:
  620. case CX231XX_BOARD_CNXT_RDE_250:
  621. case CX231XX_BOARD_CNXT_SHELBY:
  622. case CX231XX_BOARD_CNXT_RDU_250:
  623. errCode = cx231xx_set_agc_analog_digital_mux_select(dev, 1);
  624. break;
  625. case CX231XX_BOARD_CNXT_RDE_253S:
  626. case CX231XX_BOARD_CNXT_RDU_253S:
  627. case CX231XX_BOARD_HAUPPAUGE_EXETER:
  628. case CX231XX_BOARD_PV_PLAYTV_USB_HYBRID:
  629. errCode = cx231xx_set_agc_analog_digital_mux_select(dev, 0);
  630. break;
  631. default:
  632. break;
  633. }
  634. }
  635. return 0;
  636. }
  637. EXPORT_SYMBOL_GPL(cx231xx_set_mode);
  638. int cx231xx_ep5_bulkout(struct cx231xx *dev, u8 *firmware, u16 size)
  639. {
  640. int errCode = 0;
  641. int actlen, ret = -ENOMEM;
  642. u32 *buffer;
  643. buffer = kzalloc(4096, GFP_KERNEL);
  644. if (buffer == NULL) {
  645. cx231xx_info("out of mem\n");
  646. return -ENOMEM;
  647. }
  648. memcpy(&buffer[0], firmware, 4096);
  649. ret = usb_bulk_msg(dev->udev, usb_sndbulkpipe(dev->udev, 5),
  650. buffer, 4096, &actlen, 2000);
  651. if (ret)
  652. cx231xx_info("bulk message failed: %d (%d/%d)", ret,
  653. size, actlen);
  654. else {
  655. errCode = actlen != size ? -1 : 0;
  656. }
  657. kfree(buffer);
  658. return 0;
  659. }
  660. /*****************************************************************
  661. * URB Streaming functions *
  662. ******************************************************************/
  663. /*
  664. * IRQ callback, called by URB callback
  665. */
  666. static void cx231xx_isoc_irq_callback(struct urb *urb)
  667. {
  668. struct cx231xx_dmaqueue *dma_q = urb->context;
  669. struct cx231xx_video_mode *vmode =
  670. container_of(dma_q, struct cx231xx_video_mode, vidq);
  671. struct cx231xx *dev = container_of(vmode, struct cx231xx, video_mode);
  672. int rc, i;
  673. switch (urb->status) {
  674. case 0: /* success */
  675. case -ETIMEDOUT: /* NAK */
  676. break;
  677. case -ECONNRESET: /* kill */
  678. case -ENOENT:
  679. case -ESHUTDOWN:
  680. return;
  681. default: /* error */
  682. cx231xx_isocdbg("urb completition error %d.\n", urb->status);
  683. break;
  684. }
  685. /* Copy data from URB */
  686. spin_lock(&dev->video_mode.slock);
  687. rc = dev->video_mode.isoc_ctl.isoc_copy(dev, urb);
  688. spin_unlock(&dev->video_mode.slock);
  689. /* Reset urb buffers */
  690. for (i = 0; i < urb->number_of_packets; i++) {
  691. urb->iso_frame_desc[i].status = 0;
  692. urb->iso_frame_desc[i].actual_length = 0;
  693. }
  694. urb->status = 0;
  695. urb->status = usb_submit_urb(urb, GFP_ATOMIC);
  696. if (urb->status) {
  697. cx231xx_isocdbg("urb resubmit failed (error=%i)\n",
  698. urb->status);
  699. }
  700. }
  701. /*****************************************************************
  702. * URB Streaming functions *
  703. ******************************************************************/
  704. /*
  705. * IRQ callback, called by URB callback
  706. */
  707. static void cx231xx_bulk_irq_callback(struct urb *urb)
  708. {
  709. struct cx231xx_dmaqueue *dma_q = urb->context;
  710. struct cx231xx_video_mode *vmode =
  711. container_of(dma_q, struct cx231xx_video_mode, vidq);
  712. struct cx231xx *dev = container_of(vmode, struct cx231xx, video_mode);
  713. int rc;
  714. switch (urb->status) {
  715. case 0: /* success */
  716. case -ETIMEDOUT: /* NAK */
  717. break;
  718. case -ECONNRESET: /* kill */
  719. case -ENOENT:
  720. case -ESHUTDOWN:
  721. return;
  722. default: /* error */
  723. cx231xx_isocdbg("urb completition error %d.\n", urb->status);
  724. break;
  725. }
  726. /* Copy data from URB */
  727. spin_lock(&dev->video_mode.slock);
  728. rc = dev->video_mode.bulk_ctl.bulk_copy(dev, urb);
  729. spin_unlock(&dev->video_mode.slock);
  730. /* Reset urb buffers */
  731. urb->status = 0;
  732. urb->status = usb_submit_urb(urb, GFP_ATOMIC);
  733. if (urb->status) {
  734. cx231xx_isocdbg("urb resubmit failed (error=%i)\n",
  735. urb->status);
  736. }
  737. }
  738. /*
  739. * Stop and Deallocate URBs
  740. */
  741. void cx231xx_uninit_isoc(struct cx231xx *dev)
  742. {
  743. struct cx231xx_dmaqueue *dma_q = &dev->video_mode.vidq;
  744. struct urb *urb;
  745. int i;
  746. cx231xx_isocdbg("cx231xx: called cx231xx_uninit_isoc\n");
  747. dev->video_mode.isoc_ctl.nfields = -1;
  748. for (i = 0; i < dev->video_mode.isoc_ctl.num_bufs; i++) {
  749. urb = dev->video_mode.isoc_ctl.urb[i];
  750. if (urb) {
  751. if (!irqs_disabled())
  752. usb_kill_urb(urb);
  753. else
  754. usb_unlink_urb(urb);
  755. if (dev->video_mode.isoc_ctl.transfer_buffer[i]) {
  756. usb_free_coherent(dev->udev,
  757. urb->transfer_buffer_length,
  758. dev->video_mode.isoc_ctl.
  759. transfer_buffer[i],
  760. urb->transfer_dma);
  761. }
  762. usb_free_urb(urb);
  763. dev->video_mode.isoc_ctl.urb[i] = NULL;
  764. }
  765. dev->video_mode.isoc_ctl.transfer_buffer[i] = NULL;
  766. }
  767. kfree(dev->video_mode.isoc_ctl.urb);
  768. kfree(dev->video_mode.isoc_ctl.transfer_buffer);
  769. kfree(dma_q->p_left_data);
  770. dev->video_mode.isoc_ctl.urb = NULL;
  771. dev->video_mode.isoc_ctl.transfer_buffer = NULL;
  772. dev->video_mode.isoc_ctl.num_bufs = 0;
  773. dma_q->p_left_data = NULL;
  774. if (dev->mode_tv == 0)
  775. cx231xx_capture_start(dev, 0, Raw_Video);
  776. else
  777. cx231xx_capture_start(dev, 0, TS1_serial_mode);
  778. }
  779. EXPORT_SYMBOL_GPL(cx231xx_uninit_isoc);
  780. /*
  781. * Stop and Deallocate URBs
  782. */
  783. void cx231xx_uninit_bulk(struct cx231xx *dev)
  784. {
  785. struct urb *urb;
  786. int i;
  787. cx231xx_isocdbg("cx231xx: called cx231xx_uninit_bulk\n");
  788. dev->video_mode.bulk_ctl.nfields = -1;
  789. for (i = 0; i < dev->video_mode.bulk_ctl.num_bufs; i++) {
  790. urb = dev->video_mode.bulk_ctl.urb[i];
  791. if (urb) {
  792. if (!irqs_disabled())
  793. usb_kill_urb(urb);
  794. else
  795. usb_unlink_urb(urb);
  796. if (dev->video_mode.bulk_ctl.transfer_buffer[i]) {
  797. usb_free_coherent(dev->udev,
  798. urb->transfer_buffer_length,
  799. dev->video_mode.isoc_ctl.
  800. transfer_buffer[i],
  801. urb->transfer_dma);
  802. }
  803. usb_free_urb(urb);
  804. dev->video_mode.bulk_ctl.urb[i] = NULL;
  805. }
  806. dev->video_mode.bulk_ctl.transfer_buffer[i] = NULL;
  807. }
  808. kfree(dev->video_mode.bulk_ctl.urb);
  809. kfree(dev->video_mode.bulk_ctl.transfer_buffer);
  810. dev->video_mode.bulk_ctl.urb = NULL;
  811. dev->video_mode.bulk_ctl.transfer_buffer = NULL;
  812. dev->video_mode.bulk_ctl.num_bufs = 0;
  813. if (dev->mode_tv == 0)
  814. cx231xx_capture_start(dev, 0, Raw_Video);
  815. else
  816. cx231xx_capture_start(dev, 0, TS1_serial_mode);
  817. }
  818. EXPORT_SYMBOL_GPL(cx231xx_uninit_bulk);
  819. /*
  820. * Allocate URBs and start IRQ
  821. */
  822. int cx231xx_init_isoc(struct cx231xx *dev, int max_packets,
  823. int num_bufs, int max_pkt_size,
  824. int (*isoc_copy) (struct cx231xx *dev, struct urb *urb))
  825. {
  826. struct cx231xx_dmaqueue *dma_q = &dev->video_mode.vidq;
  827. int i;
  828. int sb_size, pipe;
  829. struct urb *urb;
  830. int j, k;
  831. int rc;
  832. /* De-allocates all pending stuff */
  833. cx231xx_uninit_isoc(dev);
  834. dma_q->p_left_data = kzalloc(4096, GFP_KERNEL);
  835. if (dma_q->p_left_data == NULL) {
  836. cx231xx_info("out of mem\n");
  837. return -ENOMEM;
  838. }
  839. dev->video_mode.isoc_ctl.isoc_copy = isoc_copy;
  840. dev->video_mode.isoc_ctl.num_bufs = num_bufs;
  841. dma_q->pos = 0;
  842. dma_q->is_partial_line = 0;
  843. dma_q->last_sav = 0;
  844. dma_q->current_field = -1;
  845. dma_q->field1_done = 0;
  846. dma_q->lines_per_field = dev->height / 2;
  847. dma_q->bytes_left_in_line = dev->width << 1;
  848. dma_q->lines_completed = 0;
  849. dma_q->mpeg_buffer_done = 0;
  850. dma_q->left_data_count = 0;
  851. dma_q->mpeg_buffer_completed = 0;
  852. dma_q->add_ps_package_head = CX231XX_NEED_ADD_PS_PACKAGE_HEAD;
  853. dma_q->ps_head[0] = 0x00;
  854. dma_q->ps_head[1] = 0x00;
  855. dma_q->ps_head[2] = 0x01;
  856. dma_q->ps_head[3] = 0xBA;
  857. for (i = 0; i < 8; i++)
  858. dma_q->partial_buf[i] = 0;
  859. dev->video_mode.isoc_ctl.urb =
  860. kzalloc(sizeof(void *) * num_bufs, GFP_KERNEL);
  861. if (!dev->video_mode.isoc_ctl.urb) {
  862. cx231xx_errdev("cannot alloc memory for usb buffers\n");
  863. return -ENOMEM;
  864. }
  865. dev->video_mode.isoc_ctl.transfer_buffer =
  866. kzalloc(sizeof(void *) * num_bufs, GFP_KERNEL);
  867. if (!dev->video_mode.isoc_ctl.transfer_buffer) {
  868. cx231xx_errdev("cannot allocate memory for usbtransfer\n");
  869. kfree(dev->video_mode.isoc_ctl.urb);
  870. return -ENOMEM;
  871. }
  872. dev->video_mode.isoc_ctl.max_pkt_size = max_pkt_size;
  873. dev->video_mode.isoc_ctl.buf = NULL;
  874. sb_size = max_packets * dev->video_mode.isoc_ctl.max_pkt_size;
  875. if (dev->mode_tv == 1)
  876. dev->video_mode.end_point_addr = 0x81;
  877. else
  878. dev->video_mode.end_point_addr = 0x84;
  879. /* allocate urbs and transfer buffers */
  880. for (i = 0; i < dev->video_mode.isoc_ctl.num_bufs; i++) {
  881. urb = usb_alloc_urb(max_packets, GFP_KERNEL);
  882. if (!urb) {
  883. cx231xx_err("cannot alloc isoc_ctl.urb %i\n", i);
  884. cx231xx_uninit_isoc(dev);
  885. return -ENOMEM;
  886. }
  887. dev->video_mode.isoc_ctl.urb[i] = urb;
  888. dev->video_mode.isoc_ctl.transfer_buffer[i] =
  889. usb_alloc_coherent(dev->udev, sb_size, GFP_KERNEL,
  890. &urb->transfer_dma);
  891. if (!dev->video_mode.isoc_ctl.transfer_buffer[i]) {
  892. cx231xx_err("unable to allocate %i bytes for transfer"
  893. " buffer %i%s\n",
  894. sb_size, i,
  895. in_interrupt() ? " while in int" : "");
  896. cx231xx_uninit_isoc(dev);
  897. return -ENOMEM;
  898. }
  899. memset(dev->video_mode.isoc_ctl.transfer_buffer[i], 0, sb_size);
  900. pipe =
  901. usb_rcvisocpipe(dev->udev, dev->video_mode.end_point_addr);
  902. usb_fill_int_urb(urb, dev->udev, pipe,
  903. dev->video_mode.isoc_ctl.transfer_buffer[i],
  904. sb_size, cx231xx_isoc_irq_callback, dma_q, 1);
  905. urb->number_of_packets = max_packets;
  906. urb->transfer_flags = URB_ISO_ASAP;
  907. k = 0;
  908. for (j = 0; j < max_packets; j++) {
  909. urb->iso_frame_desc[j].offset = k;
  910. urb->iso_frame_desc[j].length =
  911. dev->video_mode.isoc_ctl.max_pkt_size;
  912. k += dev->video_mode.isoc_ctl.max_pkt_size;
  913. }
  914. }
  915. init_waitqueue_head(&dma_q->wq);
  916. /* submit urbs and enables IRQ */
  917. for (i = 0; i < dev->video_mode.isoc_ctl.num_bufs; i++) {
  918. rc = usb_submit_urb(dev->video_mode.isoc_ctl.urb[i],
  919. GFP_ATOMIC);
  920. if (rc) {
  921. cx231xx_err("submit of urb %i failed (error=%i)\n", i,
  922. rc);
  923. cx231xx_uninit_isoc(dev);
  924. return rc;
  925. }
  926. }
  927. if (dev->mode_tv == 0)
  928. cx231xx_capture_start(dev, 1, Raw_Video);
  929. else
  930. cx231xx_capture_start(dev, 1, TS1_serial_mode);
  931. return 0;
  932. }
  933. EXPORT_SYMBOL_GPL(cx231xx_init_isoc);
  934. /*
  935. * Allocate URBs and start IRQ
  936. */
  937. int cx231xx_init_bulk(struct cx231xx *dev, int max_packets,
  938. int num_bufs, int max_pkt_size,
  939. int (*bulk_copy) (struct cx231xx *dev, struct urb *urb))
  940. {
  941. struct cx231xx_dmaqueue *dma_q = &dev->video_mode.vidq;
  942. int i;
  943. int sb_size, pipe;
  944. struct urb *urb;
  945. int rc;
  946. dev->video_input = dev->video_input > 2 ? 2 : dev->video_input;
  947. cx231xx_coredbg("Setting Video mux to %d\n", dev->video_input);
  948. video_mux(dev, dev->video_input);
  949. /* De-allocates all pending stuff */
  950. cx231xx_uninit_bulk(dev);
  951. dev->video_mode.bulk_ctl.bulk_copy = bulk_copy;
  952. dev->video_mode.bulk_ctl.num_bufs = num_bufs;
  953. dma_q->pos = 0;
  954. dma_q->is_partial_line = 0;
  955. dma_q->last_sav = 0;
  956. dma_q->current_field = -1;
  957. dma_q->field1_done = 0;
  958. dma_q->lines_per_field = dev->height / 2;
  959. dma_q->bytes_left_in_line = dev->width << 1;
  960. dma_q->lines_completed = 0;
  961. dma_q->mpeg_buffer_done = 0;
  962. dma_q->left_data_count = 0;
  963. dma_q->mpeg_buffer_completed = 0;
  964. dma_q->ps_head[0] = 0x00;
  965. dma_q->ps_head[1] = 0x00;
  966. dma_q->ps_head[2] = 0x01;
  967. dma_q->ps_head[3] = 0xBA;
  968. for (i = 0; i < 8; i++)
  969. dma_q->partial_buf[i] = 0;
  970. dev->video_mode.bulk_ctl.urb =
  971. kzalloc(sizeof(void *) * num_bufs, GFP_KERNEL);
  972. if (!dev->video_mode.bulk_ctl.urb) {
  973. cx231xx_errdev("cannot alloc memory for usb buffers\n");
  974. return -ENOMEM;
  975. }
  976. dev->video_mode.bulk_ctl.transfer_buffer =
  977. kzalloc(sizeof(void *) * num_bufs, GFP_KERNEL);
  978. if (!dev->video_mode.bulk_ctl.transfer_buffer) {
  979. cx231xx_errdev("cannot allocate memory for usbtransfer\n");
  980. kfree(dev->video_mode.bulk_ctl.urb);
  981. return -ENOMEM;
  982. }
  983. dev->video_mode.bulk_ctl.max_pkt_size = max_pkt_size;
  984. dev->video_mode.bulk_ctl.buf = NULL;
  985. sb_size = max_packets * dev->video_mode.bulk_ctl.max_pkt_size;
  986. if (dev->mode_tv == 1)
  987. dev->video_mode.end_point_addr = 0x81;
  988. else
  989. dev->video_mode.end_point_addr = 0x84;
  990. /* allocate urbs and transfer buffers */
  991. for (i = 0; i < dev->video_mode.bulk_ctl.num_bufs; i++) {
  992. urb = usb_alloc_urb(0, GFP_KERNEL);
  993. if (!urb) {
  994. cx231xx_err("cannot alloc bulk_ctl.urb %i\n", i);
  995. cx231xx_uninit_bulk(dev);
  996. return -ENOMEM;
  997. }
  998. dev->video_mode.bulk_ctl.urb[i] = urb;
  999. urb->transfer_flags = 0;
  1000. dev->video_mode.bulk_ctl.transfer_buffer[i] =
  1001. usb_alloc_coherent(dev->udev, sb_size, GFP_KERNEL,
  1002. &urb->transfer_dma);
  1003. if (!dev->video_mode.bulk_ctl.transfer_buffer[i]) {
  1004. cx231xx_err("unable to allocate %i bytes for transfer"
  1005. " buffer %i%s\n",
  1006. sb_size, i,
  1007. in_interrupt() ? " while in int" : "");
  1008. cx231xx_uninit_bulk(dev);
  1009. return -ENOMEM;
  1010. }
  1011. memset(dev->video_mode.bulk_ctl.transfer_buffer[i], 0, sb_size);
  1012. pipe = usb_rcvbulkpipe(dev->udev,
  1013. dev->video_mode.end_point_addr);
  1014. usb_fill_bulk_urb(urb, dev->udev, pipe,
  1015. dev->video_mode.bulk_ctl.transfer_buffer[i],
  1016. sb_size, cx231xx_bulk_irq_callback, dma_q);
  1017. }
  1018. init_waitqueue_head(&dma_q->wq);
  1019. /* submit urbs and enables IRQ */
  1020. for (i = 0; i < dev->video_mode.bulk_ctl.num_bufs; i++) {
  1021. rc = usb_submit_urb(dev->video_mode.bulk_ctl.urb[i],
  1022. GFP_ATOMIC);
  1023. if (rc) {
  1024. cx231xx_err("submit of urb %i failed (error=%i)\n", i,
  1025. rc);
  1026. cx231xx_uninit_bulk(dev);
  1027. return rc;
  1028. }
  1029. }
  1030. if (dev->mode_tv == 0)
  1031. cx231xx_capture_start(dev, 1, Raw_Video);
  1032. else
  1033. cx231xx_capture_start(dev, 1, TS1_serial_mode);
  1034. return 0;
  1035. }
  1036. EXPORT_SYMBOL_GPL(cx231xx_init_bulk);
  1037. void cx231xx_stop_TS1(struct cx231xx *dev)
  1038. {
  1039. int status = 0;
  1040. u8 val[4] = { 0, 0, 0, 0 };
  1041. val[0] = 0x00;
  1042. val[1] = 0x03;
  1043. val[2] = 0x00;
  1044. val[3] = 0x00;
  1045. status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
  1046. TS_MODE_REG, val, 4);
  1047. val[0] = 0x00;
  1048. val[1] = 0x70;
  1049. val[2] = 0x04;
  1050. val[3] = 0x00;
  1051. status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
  1052. TS1_CFG_REG, val, 4);
  1053. }
  1054. /* EXPORT_SYMBOL_GPL(cx231xx_stop_TS1); */
  1055. void cx231xx_start_TS1(struct cx231xx *dev)
  1056. {
  1057. int status = 0;
  1058. u8 val[4] = { 0, 0, 0, 0 };
  1059. val[0] = 0x03;
  1060. val[1] = 0x03;
  1061. val[2] = 0x00;
  1062. val[3] = 0x00;
  1063. status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
  1064. TS_MODE_REG, val, 4);
  1065. val[0] = 0x04;
  1066. val[1] = 0xA3;
  1067. val[2] = 0x3B;
  1068. val[3] = 0x00;
  1069. status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
  1070. TS1_CFG_REG, val, 4);
  1071. }
  1072. /* EXPORT_SYMBOL_GPL(cx231xx_start_TS1); */
  1073. /*****************************************************************
  1074. * Device Init/UnInit functions *
  1075. ******************************************************************/
  1076. int cx231xx_dev_init(struct cx231xx *dev)
  1077. {
  1078. int errCode = 0;
  1079. /* Initialize I2C bus */
  1080. /* External Master 1 Bus */
  1081. dev->i2c_bus[0].nr = 0;
  1082. dev->i2c_bus[0].dev = dev;
  1083. dev->i2c_bus[0].i2c_period = I2C_SPEED_100K; /* 100 KHz */
  1084. dev->i2c_bus[0].i2c_nostop = 0;
  1085. dev->i2c_bus[0].i2c_reserve = 0;
  1086. /* External Master 2 Bus */
  1087. dev->i2c_bus[1].nr = 1;
  1088. dev->i2c_bus[1].dev = dev;
  1089. dev->i2c_bus[1].i2c_period = I2C_SPEED_100K; /* 100 KHz */
  1090. dev->i2c_bus[1].i2c_nostop = 0;
  1091. dev->i2c_bus[1].i2c_reserve = 0;
  1092. /* Internal Master 3 Bus */
  1093. dev->i2c_bus[2].nr = 2;
  1094. dev->i2c_bus[2].dev = dev;
  1095. dev->i2c_bus[2].i2c_period = I2C_SPEED_100K; /* 100kHz */
  1096. dev->i2c_bus[2].i2c_nostop = 0;
  1097. dev->i2c_bus[2].i2c_reserve = 0;
  1098. /* register I2C buses */
  1099. cx231xx_i2c_register(&dev->i2c_bus[0]);
  1100. cx231xx_i2c_register(&dev->i2c_bus[1]);
  1101. cx231xx_i2c_register(&dev->i2c_bus[2]);
  1102. /* init hardware */
  1103. /* Note : with out calling set power mode function,
  1104. afe can not be set up correctly */
  1105. if (dev->board.external_av) {
  1106. errCode = cx231xx_set_power_mode(dev,
  1107. POLARIS_AVMODE_ENXTERNAL_AV);
  1108. if (errCode < 0) {
  1109. cx231xx_errdev
  1110. ("%s: Failed to set Power - errCode [%d]!\n",
  1111. __func__, errCode);
  1112. return errCode;
  1113. }
  1114. } else {
  1115. errCode = cx231xx_set_power_mode(dev,
  1116. POLARIS_AVMODE_ANALOGT_TV);
  1117. if (errCode < 0) {
  1118. cx231xx_errdev
  1119. ("%s: Failed to set Power - errCode [%d]!\n",
  1120. __func__, errCode);
  1121. return errCode;
  1122. }
  1123. }
  1124. /* reset the Tuner, if it is a Xceive tuner */
  1125. if ((dev->board.tuner_type == TUNER_XC5000) ||
  1126. (dev->board.tuner_type == TUNER_XC2028))
  1127. cx231xx_gpio_set(dev, dev->board.tuner_gpio);
  1128. /* initialize Colibri block */
  1129. errCode = cx231xx_afe_init_super_block(dev, 0x23c);
  1130. if (errCode < 0) {
  1131. cx231xx_errdev
  1132. ("%s: cx231xx_afe init super block - errCode [%d]!\n",
  1133. __func__, errCode);
  1134. return errCode;
  1135. }
  1136. errCode = cx231xx_afe_init_channels(dev);
  1137. if (errCode < 0) {
  1138. cx231xx_errdev
  1139. ("%s: cx231xx_afe init channels - errCode [%d]!\n",
  1140. __func__, errCode);
  1141. return errCode;
  1142. }
  1143. /* Set DIF in By pass mode */
  1144. errCode = cx231xx_dif_set_standard(dev, DIF_USE_BASEBAND);
  1145. if (errCode < 0) {
  1146. cx231xx_errdev
  1147. ("%s: cx231xx_dif set to By pass mode - errCode [%d]!\n",
  1148. __func__, errCode);
  1149. return errCode;
  1150. }
  1151. /* I2S block related functions */
  1152. errCode = cx231xx_i2s_blk_initialize(dev);
  1153. if (errCode < 0) {
  1154. cx231xx_errdev
  1155. ("%s: cx231xx_i2s block initialize - errCode [%d]!\n",
  1156. __func__, errCode);
  1157. return errCode;
  1158. }
  1159. /* init control pins */
  1160. errCode = cx231xx_init_ctrl_pin_status(dev);
  1161. if (errCode < 0) {
  1162. cx231xx_errdev("%s: cx231xx_init ctrl pins - errCode [%d]!\n",
  1163. __func__, errCode);
  1164. return errCode;
  1165. }
  1166. /* set AGC mode to Analog */
  1167. switch (dev->model) {
  1168. case CX231XX_BOARD_CNXT_CARRAERA:
  1169. case CX231XX_BOARD_CNXT_RDE_250:
  1170. case CX231XX_BOARD_CNXT_SHELBY:
  1171. case CX231XX_BOARD_CNXT_RDU_250:
  1172. errCode = cx231xx_set_agc_analog_digital_mux_select(dev, 1);
  1173. break;
  1174. case CX231XX_BOARD_CNXT_RDE_253S:
  1175. case CX231XX_BOARD_CNXT_RDU_253S:
  1176. case CX231XX_BOARD_HAUPPAUGE_EXETER:
  1177. case CX231XX_BOARD_PV_PLAYTV_USB_HYBRID:
  1178. errCode = cx231xx_set_agc_analog_digital_mux_select(dev, 0);
  1179. break;
  1180. default:
  1181. break;
  1182. }
  1183. if (errCode < 0) {
  1184. cx231xx_errdev
  1185. ("%s: cx231xx_AGC mode to Analog - errCode [%d]!\n",
  1186. __func__, errCode);
  1187. return errCode;
  1188. }
  1189. /* set all alternate settings to zero initially */
  1190. cx231xx_set_alt_setting(dev, INDEX_VIDEO, 0);
  1191. cx231xx_set_alt_setting(dev, INDEX_VANC, 0);
  1192. cx231xx_set_alt_setting(dev, INDEX_HANC, 0);
  1193. if (dev->board.has_dvb)
  1194. cx231xx_set_alt_setting(dev, INDEX_TS1, 0);
  1195. /* set the I2C master port to 3 on channel 1 */
  1196. errCode = cx231xx_enable_i2c_port_3(dev, true);
  1197. return errCode;
  1198. }
  1199. EXPORT_SYMBOL_GPL(cx231xx_dev_init);
  1200. void cx231xx_dev_uninit(struct cx231xx *dev)
  1201. {
  1202. /* Un Initialize I2C bus */
  1203. cx231xx_i2c_unregister(&dev->i2c_bus[2]);
  1204. cx231xx_i2c_unregister(&dev->i2c_bus[1]);
  1205. cx231xx_i2c_unregister(&dev->i2c_bus[0]);
  1206. }
  1207. EXPORT_SYMBOL_GPL(cx231xx_dev_uninit);
  1208. /*****************************************************************
  1209. * G P I O related functions *
  1210. ******************************************************************/
  1211. int cx231xx_send_gpio_cmd(struct cx231xx *dev, u32 gpio_bit, u8 *gpio_val,
  1212. u8 len, u8 request, u8 direction)
  1213. {
  1214. int status = 0;
  1215. struct VENDOR_REQUEST_IN ven_req;
  1216. /* Set wValue */
  1217. ven_req.wValue = (u16) (gpio_bit >> 16 & 0xffff);
  1218. /* set request */
  1219. if (!request) {
  1220. if (direction)
  1221. ven_req.bRequest = VRT_GET_GPIO; /* 0x8 gpio */
  1222. else
  1223. ven_req.bRequest = VRT_SET_GPIO; /* 0x9 gpio */
  1224. } else {
  1225. if (direction)
  1226. ven_req.bRequest = VRT_GET_GPIE; /* 0xa gpie */
  1227. else
  1228. ven_req.bRequest = VRT_SET_GPIE; /* 0xb gpie */
  1229. }
  1230. /* set index value */
  1231. ven_req.wIndex = (u16) (gpio_bit & 0xffff);
  1232. /* set wLength value */
  1233. ven_req.wLength = len;
  1234. /* set bData value */
  1235. ven_req.bData = 0;
  1236. /* set the buffer for read / write */
  1237. ven_req.pBuff = gpio_val;
  1238. /* set the direction */
  1239. if (direction) {
  1240. ven_req.direction = USB_DIR_IN;
  1241. memset(ven_req.pBuff, 0x00, ven_req.wLength);
  1242. } else
  1243. ven_req.direction = USB_DIR_OUT;
  1244. /* call common vendor command request */
  1245. status = cx231xx_send_vendor_cmd(dev, &ven_req);
  1246. if (status < 0) {
  1247. cx231xx_info
  1248. ("UsbInterface::sendCommand, failed with status -%d\n",
  1249. status);
  1250. }
  1251. return status;
  1252. }
  1253. EXPORT_SYMBOL_GPL(cx231xx_send_gpio_cmd);
  1254. /*****************************************************************
  1255. * C O N T R O L - Register R E A D / W R I T E functions *
  1256. *****************************************************************/
  1257. int cx231xx_mode_register(struct cx231xx *dev, u16 address, u32 mode)
  1258. {
  1259. u8 value[4] = { 0x0, 0x0, 0x0, 0x0 };
  1260. u32 tmp = 0;
  1261. int status = 0;
  1262. status =
  1263. cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, address, value, 4);
  1264. if (status < 0)
  1265. return status;
  1266. tmp = *((u32 *) value);
  1267. tmp |= mode;
  1268. value[0] = (u8) tmp;
  1269. value[1] = (u8) (tmp >> 8);
  1270. value[2] = (u8) (tmp >> 16);
  1271. value[3] = (u8) (tmp >> 24);
  1272. status =
  1273. cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER, address, value, 4);
  1274. return status;
  1275. }
  1276. /*****************************************************************
  1277. * I 2 C Internal C O N T R O L functions *
  1278. *****************************************************************/
  1279. int cx231xx_read_i2c_master(struct cx231xx *dev, u8 dev_addr, u16 saddr,
  1280. u8 saddr_len, u32 *data, u8 data_len, int master)
  1281. {
  1282. int status = 0;
  1283. struct cx231xx_i2c_xfer_data req_data;
  1284. u8 value[64] = "0";
  1285. if (saddr_len == 0)
  1286. saddr = 0;
  1287. else if (saddr_len == 1)
  1288. saddr &= 0xff;
  1289. /* prepare xfer_data struct */
  1290. req_data.dev_addr = dev_addr >> 1;
  1291. req_data.direction = I2C_M_RD;
  1292. req_data.saddr_len = saddr_len;
  1293. req_data.saddr_dat = saddr;
  1294. req_data.buf_size = data_len;
  1295. req_data.p_buffer = (u8 *) value;
  1296. /* usb send command */
  1297. if (master == 0)
  1298. status = dev->cx231xx_send_usb_command(&dev->i2c_bus[0],
  1299. &req_data);
  1300. else if (master == 1)
  1301. status = dev->cx231xx_send_usb_command(&dev->i2c_bus[1],
  1302. &req_data);
  1303. else if (master == 2)
  1304. status = dev->cx231xx_send_usb_command(&dev->i2c_bus[2],
  1305. &req_data);
  1306. if (status >= 0) {
  1307. /* Copy the data read back to main buffer */
  1308. if (data_len == 1)
  1309. *data = value[0];
  1310. else if (data_len == 4)
  1311. *data =
  1312. value[0] | value[1] << 8 | value[2] << 16 | value[3]
  1313. << 24;
  1314. else if (data_len > 4)
  1315. *data = value[saddr];
  1316. }
  1317. return status;
  1318. }
  1319. int cx231xx_write_i2c_master(struct cx231xx *dev, u8 dev_addr, u16 saddr,
  1320. u8 saddr_len, u32 data, u8 data_len, int master)
  1321. {
  1322. int status = 0;
  1323. u8 value[4] = { 0, 0, 0, 0 };
  1324. struct cx231xx_i2c_xfer_data req_data;
  1325. value[0] = (u8) data;
  1326. value[1] = (u8) (data >> 8);
  1327. value[2] = (u8) (data >> 16);
  1328. value[3] = (u8) (data >> 24);
  1329. if (saddr_len == 0)
  1330. saddr = 0;
  1331. else if (saddr_len == 1)
  1332. saddr &= 0xff;
  1333. /* prepare xfer_data struct */
  1334. req_data.dev_addr = dev_addr >> 1;
  1335. req_data.direction = 0;
  1336. req_data.saddr_len = saddr_len;
  1337. req_data.saddr_dat = saddr;
  1338. req_data.buf_size = data_len;
  1339. req_data.p_buffer = value;
  1340. /* usb send command */
  1341. if (master == 0)
  1342. status = dev->cx231xx_send_usb_command(&dev->i2c_bus[0],
  1343. &req_data);
  1344. else if (master == 1)
  1345. status = dev->cx231xx_send_usb_command(&dev->i2c_bus[1],
  1346. &req_data);
  1347. else if (master == 2)
  1348. status = dev->cx231xx_send_usb_command(&dev->i2c_bus[2],
  1349. &req_data);
  1350. return status;
  1351. }
  1352. int cx231xx_read_i2c_data(struct cx231xx *dev, u8 dev_addr, u16 saddr,
  1353. u8 saddr_len, u32 *data, u8 data_len)
  1354. {
  1355. int status = 0;
  1356. struct cx231xx_i2c_xfer_data req_data;
  1357. u8 value[4] = { 0, 0, 0, 0 };
  1358. if (saddr_len == 0)
  1359. saddr = 0;
  1360. else if (saddr_len == 1)
  1361. saddr &= 0xff;
  1362. /* prepare xfer_data struct */
  1363. req_data.dev_addr = dev_addr >> 1;
  1364. req_data.direction = I2C_M_RD;
  1365. req_data.saddr_len = saddr_len;
  1366. req_data.saddr_dat = saddr;
  1367. req_data.buf_size = data_len;
  1368. req_data.p_buffer = (u8 *) value;
  1369. /* usb send command */
  1370. status = dev->cx231xx_send_usb_command(&dev->i2c_bus[0], &req_data);
  1371. if (status >= 0) {
  1372. /* Copy the data read back to main buffer */
  1373. if (data_len == 1)
  1374. *data = value[0];
  1375. else
  1376. *data =
  1377. value[0] | value[1] << 8 | value[2] << 16 | value[3]
  1378. << 24;
  1379. }
  1380. return status;
  1381. }
  1382. int cx231xx_write_i2c_data(struct cx231xx *dev, u8 dev_addr, u16 saddr,
  1383. u8 saddr_len, u32 data, u8 data_len)
  1384. {
  1385. int status = 0;
  1386. u8 value[4] = { 0, 0, 0, 0 };
  1387. struct cx231xx_i2c_xfer_data req_data;
  1388. value[0] = (u8) data;
  1389. value[1] = (u8) (data >> 8);
  1390. value[2] = (u8) (data >> 16);
  1391. value[3] = (u8) (data >> 24);
  1392. if (saddr_len == 0)
  1393. saddr = 0;
  1394. else if (saddr_len == 1)
  1395. saddr &= 0xff;
  1396. /* prepare xfer_data struct */
  1397. req_data.dev_addr = dev_addr >> 1;
  1398. req_data.direction = 0;
  1399. req_data.saddr_len = saddr_len;
  1400. req_data.saddr_dat = saddr;
  1401. req_data.buf_size = data_len;
  1402. req_data.p_buffer = value;
  1403. /* usb send command */
  1404. status = dev->cx231xx_send_usb_command(&dev->i2c_bus[0], &req_data);
  1405. return status;
  1406. }
  1407. int cx231xx_reg_mask_write(struct cx231xx *dev, u8 dev_addr, u8 size,
  1408. u16 register_address, u8 bit_start, u8 bit_end,
  1409. u32 value)
  1410. {
  1411. int status = 0;
  1412. u32 tmp;
  1413. u32 mask = 0;
  1414. int i;
  1415. if (bit_start > (size - 1) || bit_end > (size - 1))
  1416. return -1;
  1417. if (size == 8) {
  1418. status =
  1419. cx231xx_read_i2c_data(dev, dev_addr, register_address, 2,
  1420. &tmp, 1);
  1421. } else {
  1422. status =
  1423. cx231xx_read_i2c_data(dev, dev_addr, register_address, 2,
  1424. &tmp, 4);
  1425. }
  1426. if (status < 0)
  1427. return status;
  1428. mask = 1 << bit_end;
  1429. for (i = bit_end; i > bit_start && i > 0; i--)
  1430. mask = mask + (1 << (i - 1));
  1431. value <<= bit_start;
  1432. if (size == 8) {
  1433. tmp &= ~mask;
  1434. tmp |= value;
  1435. tmp &= 0xff;
  1436. status =
  1437. cx231xx_write_i2c_data(dev, dev_addr, register_address, 2,
  1438. tmp, 1);
  1439. } else {
  1440. tmp &= ~mask;
  1441. tmp |= value;
  1442. status =
  1443. cx231xx_write_i2c_data(dev, dev_addr, register_address, 2,
  1444. tmp, 4);
  1445. }
  1446. return status;
  1447. }
  1448. int cx231xx_read_modify_write_i2c_dword(struct cx231xx *dev, u8 dev_addr,
  1449. u16 saddr, u32 mask, u32 value)
  1450. {
  1451. u32 temp;
  1452. int status = 0;
  1453. status = cx231xx_read_i2c_data(dev, dev_addr, saddr, 2, &temp, 4);
  1454. if (status < 0)
  1455. return status;
  1456. temp &= ~mask;
  1457. temp |= value;
  1458. status = cx231xx_write_i2c_data(dev, dev_addr, saddr, 2, temp, 4);
  1459. return status;
  1460. }
  1461. u32 cx231xx_set_field(u32 field_mask, u32 data)
  1462. {
  1463. u32 temp;
  1464. for (temp = field_mask; (temp & 1) == 0; temp >>= 1)
  1465. data <<= 1;
  1466. return data;
  1467. }