cx231xx-core.c 45 KB

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