cx231xx-core.c 45 KB

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