cx23885-417.c 48 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793
  1. /*
  2. *
  3. * Support for a cx23417 mpeg encoder via cx23885 host port.
  4. *
  5. * (c) 2004 Jelle Foks <jelle@foks.us>
  6. * (c) 2004 Gerd Knorr <kraxel@bytesex.org>
  7. * (c) 2008 Steven Toth <stoth@linuxtv.org>
  8. * - CX23885/7/8 support
  9. *
  10. * Includes parts from the ivtv driver( http://ivtv.sourceforge.net/),
  11. *
  12. * This program is free software; you can redistribute it and/or modify
  13. * it under the terms of the GNU General Public License as published by
  14. * the Free Software Foundation; either version 2 of the License, or
  15. * (at your option) any later version.
  16. *
  17. * This program is distributed in the hope that it will be useful,
  18. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  19. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  20. * GNU General Public License for more details.
  21. *
  22. * You should have received a copy of the GNU General Public License
  23. * along with this program; if not, write to the Free Software
  24. * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  25. */
  26. #include <linux/module.h>
  27. #include <linux/moduleparam.h>
  28. #include <linux/init.h>
  29. #include <linux/fs.h>
  30. #include <linux/delay.h>
  31. #include <linux/device.h>
  32. #include <linux/firmware.h>
  33. #include <media/v4l2-common.h>
  34. #include <media/v4l2-ioctl.h>
  35. #include <media/cx2341x.h>
  36. #include "cx23885.h"
  37. #define CX23885_FIRM_IMAGE_SIZE 376836
  38. #define CX23885_FIRM_IMAGE_NAME "v4l-cx23885-enc.fw"
  39. static unsigned int mpegbufs = 32;
  40. module_param(mpegbufs, int, 0644);
  41. MODULE_PARM_DESC(mpegbufs, "number of mpeg buffers, range 2-32");
  42. static unsigned int mpeglines = 32;
  43. module_param(mpeglines, int, 0644);
  44. MODULE_PARM_DESC(mpeglines, "number of lines in an MPEG buffer, range 2-32");
  45. static unsigned int mpeglinesize = 512;
  46. module_param(mpeglinesize, int, 0644);
  47. MODULE_PARM_DESC(mpeglinesize,
  48. "number of bytes in each line of an MPEG buffer, range 512-1024");
  49. static unsigned int v4l_debug;
  50. module_param(v4l_debug, int, 0644);
  51. MODULE_PARM_DESC(v4l_debug, "enable V4L debug messages");
  52. #define dprintk(level, fmt, arg...)\
  53. do { if (v4l_debug >= level) \
  54. printk(KERN_DEBUG "%s: " fmt, dev->name , ## arg);\
  55. } while (0)
  56. static struct cx23885_tvnorm cx23885_tvnorms[] = {
  57. {
  58. .name = "NTSC-M",
  59. .id = V4L2_STD_NTSC_M,
  60. }, {
  61. .name = "NTSC-JP",
  62. .id = V4L2_STD_NTSC_M_JP,
  63. }, {
  64. .name = "PAL-BG",
  65. .id = V4L2_STD_PAL_BG,
  66. }, {
  67. .name = "PAL-DK",
  68. .id = V4L2_STD_PAL_DK,
  69. }, {
  70. .name = "PAL-I",
  71. .id = V4L2_STD_PAL_I,
  72. }, {
  73. .name = "PAL-M",
  74. .id = V4L2_STD_PAL_M,
  75. }, {
  76. .name = "PAL-N",
  77. .id = V4L2_STD_PAL_N,
  78. }, {
  79. .name = "PAL-Nc",
  80. .id = V4L2_STD_PAL_Nc,
  81. }, {
  82. .name = "PAL-60",
  83. .id = V4L2_STD_PAL_60,
  84. }, {
  85. .name = "SECAM-L",
  86. .id = V4L2_STD_SECAM_L,
  87. }, {
  88. .name = "SECAM-DK",
  89. .id = V4L2_STD_SECAM_DK,
  90. }
  91. };
  92. /* ------------------------------------------------------------------ */
  93. enum cx23885_capture_type {
  94. CX23885_MPEG_CAPTURE,
  95. CX23885_RAW_CAPTURE,
  96. CX23885_RAW_PASSTHRU_CAPTURE
  97. };
  98. enum cx23885_capture_bits {
  99. CX23885_RAW_BITS_NONE = 0x00,
  100. CX23885_RAW_BITS_YUV_CAPTURE = 0x01,
  101. CX23885_RAW_BITS_PCM_CAPTURE = 0x02,
  102. CX23885_RAW_BITS_VBI_CAPTURE = 0x04,
  103. CX23885_RAW_BITS_PASSTHRU_CAPTURE = 0x08,
  104. CX23885_RAW_BITS_TO_HOST_CAPTURE = 0x10
  105. };
  106. enum cx23885_capture_end {
  107. CX23885_END_AT_GOP, /* stop at the end of gop, generate irq */
  108. CX23885_END_NOW, /* stop immediately, no irq */
  109. };
  110. enum cx23885_framerate {
  111. CX23885_FRAMERATE_NTSC_30, /* NTSC: 30fps */
  112. CX23885_FRAMERATE_PAL_25 /* PAL: 25fps */
  113. };
  114. enum cx23885_stream_port {
  115. CX23885_OUTPUT_PORT_MEMORY,
  116. CX23885_OUTPUT_PORT_STREAMING,
  117. CX23885_OUTPUT_PORT_SERIAL
  118. };
  119. enum cx23885_data_xfer_status {
  120. CX23885_MORE_BUFFERS_FOLLOW,
  121. CX23885_LAST_BUFFER,
  122. };
  123. enum cx23885_picture_mask {
  124. CX23885_PICTURE_MASK_NONE,
  125. CX23885_PICTURE_MASK_I_FRAMES,
  126. CX23885_PICTURE_MASK_I_P_FRAMES = 0x3,
  127. CX23885_PICTURE_MASK_ALL_FRAMES = 0x7,
  128. };
  129. enum cx23885_vbi_mode_bits {
  130. CX23885_VBI_BITS_SLICED,
  131. CX23885_VBI_BITS_RAW,
  132. };
  133. enum cx23885_vbi_insertion_bits {
  134. CX23885_VBI_BITS_INSERT_IN_XTENSION_USR_DATA,
  135. CX23885_VBI_BITS_INSERT_IN_PRIVATE_PACKETS = 0x1 << 1,
  136. CX23885_VBI_BITS_SEPARATE_STREAM = 0x2 << 1,
  137. CX23885_VBI_BITS_SEPARATE_STREAM_USR_DATA = 0x4 << 1,
  138. CX23885_VBI_BITS_SEPARATE_STREAM_PRV_DATA = 0x5 << 1,
  139. };
  140. enum cx23885_dma_unit {
  141. CX23885_DMA_BYTES,
  142. CX23885_DMA_FRAMES,
  143. };
  144. enum cx23885_dma_transfer_status_bits {
  145. CX23885_DMA_TRANSFER_BITS_DONE = 0x01,
  146. CX23885_DMA_TRANSFER_BITS_ERROR = 0x04,
  147. CX23885_DMA_TRANSFER_BITS_LL_ERROR = 0x10,
  148. };
  149. enum cx23885_pause {
  150. CX23885_PAUSE_ENCODING,
  151. CX23885_RESUME_ENCODING,
  152. };
  153. enum cx23885_copyright {
  154. CX23885_COPYRIGHT_OFF,
  155. CX23885_COPYRIGHT_ON,
  156. };
  157. enum cx23885_notification_type {
  158. CX23885_NOTIFICATION_REFRESH,
  159. };
  160. enum cx23885_notification_status {
  161. CX23885_NOTIFICATION_OFF,
  162. CX23885_NOTIFICATION_ON,
  163. };
  164. enum cx23885_notification_mailbox {
  165. CX23885_NOTIFICATION_NO_MAILBOX = -1,
  166. };
  167. enum cx23885_field1_lines {
  168. CX23885_FIELD1_SAA7114 = 0x00EF, /* 239 */
  169. CX23885_FIELD1_SAA7115 = 0x00F0, /* 240 */
  170. CX23885_FIELD1_MICRONAS = 0x0105, /* 261 */
  171. };
  172. enum cx23885_field2_lines {
  173. CX23885_FIELD2_SAA7114 = 0x00EF, /* 239 */
  174. CX23885_FIELD2_SAA7115 = 0x00F0, /* 240 */
  175. CX23885_FIELD2_MICRONAS = 0x0106, /* 262 */
  176. };
  177. enum cx23885_custom_data_type {
  178. CX23885_CUSTOM_EXTENSION_USR_DATA,
  179. CX23885_CUSTOM_PRIVATE_PACKET,
  180. };
  181. enum cx23885_mute {
  182. CX23885_UNMUTE,
  183. CX23885_MUTE,
  184. };
  185. enum cx23885_mute_video_mask {
  186. CX23885_MUTE_VIDEO_V_MASK = 0x0000FF00,
  187. CX23885_MUTE_VIDEO_U_MASK = 0x00FF0000,
  188. CX23885_MUTE_VIDEO_Y_MASK = 0xFF000000,
  189. };
  190. enum cx23885_mute_video_shift {
  191. CX23885_MUTE_VIDEO_V_SHIFT = 8,
  192. CX23885_MUTE_VIDEO_U_SHIFT = 16,
  193. CX23885_MUTE_VIDEO_Y_SHIFT = 24,
  194. };
  195. /* defines below are from ivtv-driver.h */
  196. #define IVTV_CMD_HW_BLOCKS_RST 0xFFFFFFFF
  197. /* Firmware API commands */
  198. #define IVTV_API_STD_TIMEOUT 500
  199. /* Registers */
  200. /* IVTV_REG_OFFSET */
  201. #define IVTV_REG_ENC_SDRAM_REFRESH (0x07F8)
  202. #define IVTV_REG_ENC_SDRAM_PRECHARGE (0x07FC)
  203. #define IVTV_REG_SPU (0x9050)
  204. #define IVTV_REG_HW_BLOCKS (0x9054)
  205. #define IVTV_REG_VPU (0x9058)
  206. #define IVTV_REG_APU (0xA064)
  207. /**** Bit definitions for MC417_RWD and MC417_OEN registers ***
  208. bits 31-16
  209. +-----------+
  210. | Reserved |
  211. +-----------+
  212. bit 15 bit 14 bit 13 bit 12 bit 11 bit 10 bit 9 bit 8
  213. +-------+-------+-------+-------+-------+-------+-------+-------+
  214. | MIWR# | MIRD# | MICS# |MIRDY# |MIADDR3|MIADDR2|MIADDR1|MIADDR0|
  215. +-------+-------+-------+-------+-------+-------+-------+-------+
  216. bit 7 bit 6 bit 5 bit 4 bit 3 bit 2 bit 1 bit 0
  217. +-------+-------+-------+-------+-------+-------+-------+-------+
  218. |MIDATA7|MIDATA6|MIDATA5|MIDATA4|MIDATA3|MIDATA2|MIDATA1|MIDATA0|
  219. +-------+-------+-------+-------+-------+-------+-------+-------+
  220. ***/
  221. #define MC417_MIWR 0x8000
  222. #define MC417_MIRD 0x4000
  223. #define MC417_MICS 0x2000
  224. #define MC417_MIRDY 0x1000
  225. #define MC417_MIADDR 0x0F00
  226. #define MC417_MIDATA 0x00FF
  227. /* MIADDR* nibble definitions */
  228. #define MCI_MEMORY_DATA_BYTE0 0x000
  229. #define MCI_MEMORY_DATA_BYTE1 0x100
  230. #define MCI_MEMORY_DATA_BYTE2 0x200
  231. #define MCI_MEMORY_DATA_BYTE3 0x300
  232. #define MCI_MEMORY_ADDRESS_BYTE2 0x400
  233. #define MCI_MEMORY_ADDRESS_BYTE1 0x500
  234. #define MCI_MEMORY_ADDRESS_BYTE0 0x600
  235. #define MCI_REGISTER_DATA_BYTE0 0x800
  236. #define MCI_REGISTER_DATA_BYTE1 0x900
  237. #define MCI_REGISTER_DATA_BYTE2 0xA00
  238. #define MCI_REGISTER_DATA_BYTE3 0xB00
  239. #define MCI_REGISTER_ADDRESS_BYTE0 0xC00
  240. #define MCI_REGISTER_ADDRESS_BYTE1 0xD00
  241. #define MCI_REGISTER_MODE 0xE00
  242. /* Read and write modes */
  243. #define MCI_MODE_REGISTER_READ 0
  244. #define MCI_MODE_REGISTER_WRITE 1
  245. #define MCI_MODE_MEMORY_READ 0
  246. #define MCI_MODE_MEMORY_WRITE 0x40
  247. /*** Bit definitions for MC417_CTL register ****
  248. bits 31-6 bits 5-4 bit 3 bits 2-1 Bit 0
  249. +--------+-------------+--------+--------------+------------+
  250. |Reserved|MC417_SPD_CTL|Reserved|MC417_GPIO_SEL|UART_GPIO_EN|
  251. +--------+-------------+--------+--------------+------------+
  252. ***/
  253. #define MC417_SPD_CTL(x) (((x) << 4) & 0x00000030)
  254. #define MC417_GPIO_SEL(x) (((x) << 1) & 0x00000006)
  255. #define MC417_UART_GPIO_EN 0x00000001
  256. /* Values for speed control */
  257. #define MC417_SPD_CTL_SLOW 0x1
  258. #define MC417_SPD_CTL_MEDIUM 0x0
  259. #define MC417_SPD_CTL_FAST 0x3 /* b'1x, but we use b'11 */
  260. /* Values for GPIO select */
  261. #define MC417_GPIO_SEL_GPIO3 0x3
  262. #define MC417_GPIO_SEL_GPIO2 0x2
  263. #define MC417_GPIO_SEL_GPIO1 0x1
  264. #define MC417_GPIO_SEL_GPIO0 0x0
  265. void cx23885_mc417_init(struct cx23885_dev *dev)
  266. {
  267. u32 regval;
  268. dprintk(2, "%s()\n", __func__);
  269. /* Configure MC417_CTL register to defaults. */
  270. regval = MC417_SPD_CTL(MC417_SPD_CTL_FAST) |
  271. MC417_GPIO_SEL(MC417_GPIO_SEL_GPIO3) |
  272. MC417_UART_GPIO_EN;
  273. cx_write(MC417_CTL, regval);
  274. /* Configure MC417_OEN to defaults. */
  275. regval = MC417_MIRDY;
  276. cx_write(MC417_OEN, regval);
  277. /* Configure MC417_RWD to defaults. */
  278. regval = MC417_MIWR | MC417_MIRD | MC417_MICS;
  279. cx_write(MC417_RWD, regval);
  280. }
  281. static int mc417_wait_ready(struct cx23885_dev *dev)
  282. {
  283. u32 mi_ready;
  284. unsigned long timeout = jiffies + msecs_to_jiffies(1);
  285. for (;;) {
  286. mi_ready = cx_read(MC417_RWD) & MC417_MIRDY;
  287. if (mi_ready != 0)
  288. return 0;
  289. if (time_after(jiffies, timeout))
  290. return -1;
  291. udelay(1);
  292. }
  293. }
  294. static int mc417_register_write(struct cx23885_dev *dev, u16 address, u32 value)
  295. {
  296. u32 regval;
  297. /* Enable MC417 GPIO outputs except for MC417_MIRDY,
  298. * which is an input.
  299. */
  300. cx_write(MC417_OEN, MC417_MIRDY);
  301. /* Write data byte 0 */
  302. regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE0 |
  303. (value & 0x000000FF);
  304. cx_write(MC417_RWD, regval);
  305. /* Transition CS/WR to effect write transaction across bus. */
  306. regval |= MC417_MICS | MC417_MIWR;
  307. cx_write(MC417_RWD, regval);
  308. /* Write data byte 1 */
  309. regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE1 |
  310. ((value >> 8) & 0x000000FF);
  311. cx_write(MC417_RWD, regval);
  312. regval |= MC417_MICS | MC417_MIWR;
  313. cx_write(MC417_RWD, regval);
  314. /* Write data byte 2 */
  315. regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE2 |
  316. ((value >> 16) & 0x000000FF);
  317. cx_write(MC417_RWD, regval);
  318. regval |= MC417_MICS | MC417_MIWR;
  319. cx_write(MC417_RWD, regval);
  320. /* Write data byte 3 */
  321. regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE3 |
  322. ((value >> 24) & 0x000000FF);
  323. cx_write(MC417_RWD, regval);
  324. regval |= MC417_MICS | MC417_MIWR;
  325. cx_write(MC417_RWD, regval);
  326. /* Write address byte 0 */
  327. regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_ADDRESS_BYTE0 |
  328. (address & 0xFF);
  329. cx_write(MC417_RWD, regval);
  330. regval |= MC417_MICS | MC417_MIWR;
  331. cx_write(MC417_RWD, regval);
  332. /* Write address byte 1 */
  333. regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_ADDRESS_BYTE1 |
  334. ((address >> 8) & 0xFF);
  335. cx_write(MC417_RWD, regval);
  336. regval |= MC417_MICS | MC417_MIWR;
  337. cx_write(MC417_RWD, regval);
  338. /* Indicate that this is a write. */
  339. regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_MODE |
  340. MCI_MODE_REGISTER_WRITE;
  341. cx_write(MC417_RWD, regval);
  342. regval |= MC417_MICS | MC417_MIWR;
  343. cx_write(MC417_RWD, regval);
  344. /* Wait for the trans to complete (MC417_MIRDY asserted). */
  345. return mc417_wait_ready(dev);
  346. }
  347. static int mc417_register_read(struct cx23885_dev *dev, u16 address, u32 *value)
  348. {
  349. int retval;
  350. u32 regval;
  351. u32 tempval;
  352. u32 dataval;
  353. /* Enable MC417 GPIO outputs except for MC417_MIRDY,
  354. * which is an input.
  355. */
  356. cx_write(MC417_OEN, MC417_MIRDY);
  357. /* Write address byte 0 */
  358. regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_ADDRESS_BYTE0 |
  359. ((address & 0x00FF));
  360. cx_write(MC417_RWD, regval);
  361. regval |= MC417_MICS | MC417_MIWR;
  362. cx_write(MC417_RWD, regval);
  363. /* Write address byte 1 */
  364. regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_ADDRESS_BYTE1 |
  365. ((address >> 8) & 0xFF);
  366. cx_write(MC417_RWD, regval);
  367. regval |= MC417_MICS | MC417_MIWR;
  368. cx_write(MC417_RWD, regval);
  369. /* Indicate that this is a register read. */
  370. regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_MODE |
  371. MCI_MODE_REGISTER_READ;
  372. cx_write(MC417_RWD, regval);
  373. regval |= MC417_MICS | MC417_MIWR;
  374. cx_write(MC417_RWD, regval);
  375. /* Wait for the trans to complete (MC417_MIRDY asserted). */
  376. retval = mc417_wait_ready(dev);
  377. /* switch the DAT0-7 GPIO[10:3] to input mode */
  378. cx_write(MC417_OEN, MC417_MIRDY | MC417_MIDATA);
  379. /* Read data byte 0 */
  380. regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE0;
  381. cx_write(MC417_RWD, regval);
  382. /* Transition RD to effect read transaction across bus.
  383. * Transtion 0x5000 -> 0x9000 correct (RD/RDY -> WR/RDY)?
  384. * Should it be 0x9000 -> 0xF000 (also why is RDY being set, its
  385. * input only...)
  386. */
  387. regval = MC417_MIWR | MC417_MIRDY | MCI_REGISTER_DATA_BYTE0;
  388. cx_write(MC417_RWD, regval);
  389. /* Collect byte */
  390. tempval = cx_read(MC417_RWD);
  391. dataval = tempval & 0x000000FF;
  392. /* Bring CS and RD high. */
  393. regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY;
  394. cx_write(MC417_RWD, regval);
  395. /* Read data byte 1 */
  396. regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE1;
  397. cx_write(MC417_RWD, regval);
  398. regval = MC417_MIWR | MC417_MIRDY | MCI_REGISTER_DATA_BYTE1;
  399. cx_write(MC417_RWD, regval);
  400. tempval = cx_read(MC417_RWD);
  401. dataval |= ((tempval & 0x000000FF) << 8);
  402. regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY;
  403. cx_write(MC417_RWD, regval);
  404. /* Read data byte 2 */
  405. regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE2;
  406. cx_write(MC417_RWD, regval);
  407. regval = MC417_MIWR | MC417_MIRDY | MCI_REGISTER_DATA_BYTE2;
  408. cx_write(MC417_RWD, regval);
  409. tempval = cx_read(MC417_RWD);
  410. dataval |= ((tempval & 0x000000FF) << 16);
  411. regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY;
  412. cx_write(MC417_RWD, regval);
  413. /* Read data byte 3 */
  414. regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE3;
  415. cx_write(MC417_RWD, regval);
  416. regval = MC417_MIWR | MC417_MIRDY | MCI_REGISTER_DATA_BYTE3;
  417. cx_write(MC417_RWD, regval);
  418. tempval = cx_read(MC417_RWD);
  419. dataval |= ((tempval & 0x000000FF) << 24);
  420. regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY;
  421. cx_write(MC417_RWD, regval);
  422. *value = dataval;
  423. return retval;
  424. }
  425. int mc417_memory_write(struct cx23885_dev *dev, u32 address, u32 value)
  426. {
  427. u32 regval;
  428. /* Enable MC417 GPIO outputs except for MC417_MIRDY,
  429. * which is an input.
  430. */
  431. cx_write(MC417_OEN, MC417_MIRDY);
  432. /* Write data byte 0 */
  433. regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE0 |
  434. (value & 0x000000FF);
  435. cx_write(MC417_RWD, regval);
  436. /* Transition CS/WR to effect write transaction across bus. */
  437. regval |= MC417_MICS | MC417_MIWR;
  438. cx_write(MC417_RWD, regval);
  439. /* Write data byte 1 */
  440. regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE1 |
  441. ((value >> 8) & 0x000000FF);
  442. cx_write(MC417_RWD, regval);
  443. regval |= MC417_MICS | MC417_MIWR;
  444. cx_write(MC417_RWD, regval);
  445. /* Write data byte 2 */
  446. regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE2 |
  447. ((value >> 16) & 0x000000FF);
  448. cx_write(MC417_RWD, regval);
  449. regval |= MC417_MICS | MC417_MIWR;
  450. cx_write(MC417_RWD, regval);
  451. /* Write data byte 3 */
  452. regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE3 |
  453. ((value >> 24) & 0x000000FF);
  454. cx_write(MC417_RWD, regval);
  455. regval |= MC417_MICS | MC417_MIWR;
  456. cx_write(MC417_RWD, regval);
  457. /* Write address byte 2 */
  458. regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_ADDRESS_BYTE2 |
  459. MCI_MODE_MEMORY_WRITE | ((address >> 16) & 0x3F);
  460. cx_write(MC417_RWD, regval);
  461. regval |= MC417_MICS | MC417_MIWR;
  462. cx_write(MC417_RWD, regval);
  463. /* Write address byte 1 */
  464. regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_ADDRESS_BYTE1 |
  465. ((address >> 8) & 0xFF);
  466. cx_write(MC417_RWD, regval);
  467. regval |= MC417_MICS | MC417_MIWR;
  468. cx_write(MC417_RWD, regval);
  469. /* Write address byte 0 */
  470. regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_ADDRESS_BYTE0 |
  471. (address & 0xFF);
  472. cx_write(MC417_RWD, regval);
  473. regval |= MC417_MICS | MC417_MIWR;
  474. cx_write(MC417_RWD, regval);
  475. /* Wait for the trans to complete (MC417_MIRDY asserted). */
  476. return mc417_wait_ready(dev);
  477. }
  478. int mc417_memory_read(struct cx23885_dev *dev, u32 address, u32 *value)
  479. {
  480. int retval;
  481. u32 regval;
  482. u32 tempval;
  483. u32 dataval;
  484. /* Enable MC417 GPIO outputs except for MC417_MIRDY,
  485. * which is an input.
  486. */
  487. cx_write(MC417_OEN, MC417_MIRDY);
  488. /* Write address byte 2 */
  489. regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_ADDRESS_BYTE2 |
  490. MCI_MODE_MEMORY_READ | ((address >> 16) & 0x3F);
  491. cx_write(MC417_RWD, regval);
  492. regval |= MC417_MICS | MC417_MIWR;
  493. cx_write(MC417_RWD, regval);
  494. /* Write address byte 1 */
  495. regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_ADDRESS_BYTE1 |
  496. ((address >> 8) & 0xFF);
  497. cx_write(MC417_RWD, regval);
  498. regval |= MC417_MICS | MC417_MIWR;
  499. cx_write(MC417_RWD, regval);
  500. /* Write address byte 0 */
  501. regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_ADDRESS_BYTE0 |
  502. (address & 0xFF);
  503. cx_write(MC417_RWD, regval);
  504. regval |= MC417_MICS | MC417_MIWR;
  505. cx_write(MC417_RWD, regval);
  506. /* Wait for the trans to complete (MC417_MIRDY asserted). */
  507. retval = mc417_wait_ready(dev);
  508. /* switch the DAT0-7 GPIO[10:3] to input mode */
  509. cx_write(MC417_OEN, MC417_MIRDY | MC417_MIDATA);
  510. /* Read data byte 3 */
  511. regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE3;
  512. cx_write(MC417_RWD, regval);
  513. /* Transition RD to effect read transaction across bus. */
  514. regval = MC417_MIWR | MC417_MIRDY | MCI_MEMORY_DATA_BYTE3;
  515. cx_write(MC417_RWD, regval);
  516. /* Collect byte */
  517. tempval = cx_read(MC417_RWD);
  518. dataval = ((tempval & 0x000000FF) << 24);
  519. /* Bring CS and RD high. */
  520. regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY;
  521. cx_write(MC417_RWD, regval);
  522. /* Read data byte 2 */
  523. regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE2;
  524. cx_write(MC417_RWD, regval);
  525. regval = MC417_MIWR | MC417_MIRDY | MCI_MEMORY_DATA_BYTE2;
  526. cx_write(MC417_RWD, regval);
  527. tempval = cx_read(MC417_RWD);
  528. dataval |= ((tempval & 0x000000FF) << 16);
  529. regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY;
  530. cx_write(MC417_RWD, regval);
  531. /* Read data byte 1 */
  532. regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE1;
  533. cx_write(MC417_RWD, regval);
  534. regval = MC417_MIWR | MC417_MIRDY | MCI_MEMORY_DATA_BYTE1;
  535. cx_write(MC417_RWD, regval);
  536. tempval = cx_read(MC417_RWD);
  537. dataval |= ((tempval & 0x000000FF) << 8);
  538. regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY;
  539. cx_write(MC417_RWD, regval);
  540. /* Read data byte 0 */
  541. regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE0;
  542. cx_write(MC417_RWD, regval);
  543. regval = MC417_MIWR | MC417_MIRDY | MCI_MEMORY_DATA_BYTE0;
  544. cx_write(MC417_RWD, regval);
  545. tempval = cx_read(MC417_RWD);
  546. dataval |= (tempval & 0x000000FF);
  547. regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY;
  548. cx_write(MC417_RWD, regval);
  549. *value = dataval;
  550. return retval;
  551. }
  552. /* ------------------------------------------------------------------ */
  553. /* MPEG encoder API */
  554. static char *cmd_to_str(int cmd)
  555. {
  556. switch (cmd) {
  557. case CX2341X_ENC_PING_FW:
  558. return "PING_FW";
  559. case CX2341X_ENC_START_CAPTURE:
  560. return "START_CAPTURE";
  561. case CX2341X_ENC_STOP_CAPTURE:
  562. return "STOP_CAPTURE";
  563. case CX2341X_ENC_SET_AUDIO_ID:
  564. return "SET_AUDIO_ID";
  565. case CX2341X_ENC_SET_VIDEO_ID:
  566. return "SET_VIDEO_ID";
  567. case CX2341X_ENC_SET_PCR_ID:
  568. return "SET_PCR_PID";
  569. case CX2341X_ENC_SET_FRAME_RATE:
  570. return "SET_FRAME_RATE";
  571. case CX2341X_ENC_SET_FRAME_SIZE:
  572. return "SET_FRAME_SIZE";
  573. case CX2341X_ENC_SET_BIT_RATE:
  574. return "SET_BIT_RATE";
  575. case CX2341X_ENC_SET_GOP_PROPERTIES:
  576. return "SET_GOP_PROPERTIES";
  577. case CX2341X_ENC_SET_ASPECT_RATIO:
  578. return "SET_ASPECT_RATIO";
  579. case CX2341X_ENC_SET_DNR_FILTER_MODE:
  580. return "SET_DNR_FILTER_PROPS";
  581. case CX2341X_ENC_SET_DNR_FILTER_PROPS:
  582. return "SET_DNR_FILTER_PROPS";
  583. case CX2341X_ENC_SET_CORING_LEVELS:
  584. return "SET_CORING_LEVELS";
  585. case CX2341X_ENC_SET_SPATIAL_FILTER_TYPE:
  586. return "SET_SPATIAL_FILTER_TYPE";
  587. case CX2341X_ENC_SET_VBI_LINE:
  588. return "SET_VBI_LINE";
  589. case CX2341X_ENC_SET_STREAM_TYPE:
  590. return "SET_STREAM_TYPE";
  591. case CX2341X_ENC_SET_OUTPUT_PORT:
  592. return "SET_OUTPUT_PORT";
  593. case CX2341X_ENC_SET_AUDIO_PROPERTIES:
  594. return "SET_AUDIO_PROPERTIES";
  595. case CX2341X_ENC_HALT_FW:
  596. return "HALT_FW";
  597. case CX2341X_ENC_GET_VERSION:
  598. return "GET_VERSION";
  599. case CX2341X_ENC_SET_GOP_CLOSURE:
  600. return "SET_GOP_CLOSURE";
  601. case CX2341X_ENC_GET_SEQ_END:
  602. return "GET_SEQ_END";
  603. case CX2341X_ENC_SET_PGM_INDEX_INFO:
  604. return "SET_PGM_INDEX_INFO";
  605. case CX2341X_ENC_SET_VBI_CONFIG:
  606. return "SET_VBI_CONFIG";
  607. case CX2341X_ENC_SET_DMA_BLOCK_SIZE:
  608. return "SET_DMA_BLOCK_SIZE";
  609. case CX2341X_ENC_GET_PREV_DMA_INFO_MB_10:
  610. return "GET_PREV_DMA_INFO_MB_10";
  611. case CX2341X_ENC_GET_PREV_DMA_INFO_MB_9:
  612. return "GET_PREV_DMA_INFO_MB_9";
  613. case CX2341X_ENC_SCHED_DMA_TO_HOST:
  614. return "SCHED_DMA_TO_HOST";
  615. case CX2341X_ENC_INITIALIZE_INPUT:
  616. return "INITIALIZE_INPUT";
  617. case CX2341X_ENC_SET_FRAME_DROP_RATE:
  618. return "SET_FRAME_DROP_RATE";
  619. case CX2341X_ENC_PAUSE_ENCODER:
  620. return "PAUSE_ENCODER";
  621. case CX2341X_ENC_REFRESH_INPUT:
  622. return "REFRESH_INPUT";
  623. case CX2341X_ENC_SET_COPYRIGHT:
  624. return "SET_COPYRIGHT";
  625. case CX2341X_ENC_SET_EVENT_NOTIFICATION:
  626. return "SET_EVENT_NOTIFICATION";
  627. case CX2341X_ENC_SET_NUM_VSYNC_LINES:
  628. return "SET_NUM_VSYNC_LINES";
  629. case CX2341X_ENC_SET_PLACEHOLDER:
  630. return "SET_PLACEHOLDER";
  631. case CX2341X_ENC_MUTE_VIDEO:
  632. return "MUTE_VIDEO";
  633. case CX2341X_ENC_MUTE_AUDIO:
  634. return "MUTE_AUDIO";
  635. case CX2341X_ENC_MISC:
  636. return "MISC";
  637. default:
  638. return "UNKNOWN";
  639. }
  640. }
  641. static int cx23885_mbox_func(void *priv,
  642. u32 command,
  643. int in,
  644. int out,
  645. u32 data[CX2341X_MBOX_MAX_DATA])
  646. {
  647. struct cx23885_dev *dev = priv;
  648. unsigned long timeout;
  649. u32 value, flag, retval = 0;
  650. int i;
  651. dprintk(3, "%s: command(0x%X) = %s\n", __func__, command,
  652. cmd_to_str(command));
  653. /* this may not be 100% safe if we can't read any memory location
  654. without side effects */
  655. mc417_memory_read(dev, dev->cx23417_mailbox - 4, &value);
  656. if (value != 0x12345678) {
  657. printk(KERN_ERR
  658. "Firmware and/or mailbox pointer not initialized "
  659. "or corrupted, signature = 0x%x, cmd = %s\n", value,
  660. cmd_to_str(command));
  661. return -1;
  662. }
  663. /* This read looks at 32 bits, but flag is only 8 bits.
  664. * Seems we also bail if CMD or TIMEOUT bytes are set???
  665. */
  666. mc417_memory_read(dev, dev->cx23417_mailbox, &flag);
  667. if (flag) {
  668. printk(KERN_ERR "ERROR: Mailbox appears to be in use "
  669. "(%x), cmd = %s\n", flag, cmd_to_str(command));
  670. return -1;
  671. }
  672. flag |= 1; /* tell 'em we're working on it */
  673. mc417_memory_write(dev, dev->cx23417_mailbox, flag);
  674. /* write command + args + fill remaining with zeros */
  675. /* command code */
  676. mc417_memory_write(dev, dev->cx23417_mailbox + 1, command);
  677. mc417_memory_write(dev, dev->cx23417_mailbox + 3,
  678. IVTV_API_STD_TIMEOUT); /* timeout */
  679. for (i = 0; i < in; i++) {
  680. mc417_memory_write(dev, dev->cx23417_mailbox + 4 + i, data[i]);
  681. dprintk(3, "API Input %d = %d\n", i, data[i]);
  682. }
  683. for (; i < CX2341X_MBOX_MAX_DATA; i++)
  684. mc417_memory_write(dev, dev->cx23417_mailbox + 4 + i, 0);
  685. flag |= 3; /* tell 'em we're done writing */
  686. mc417_memory_write(dev, dev->cx23417_mailbox, flag);
  687. /* wait for firmware to handle the API command */
  688. timeout = jiffies + msecs_to_jiffies(10);
  689. for (;;) {
  690. mc417_memory_read(dev, dev->cx23417_mailbox, &flag);
  691. if (0 != (flag & 4))
  692. break;
  693. if (time_after(jiffies, timeout)) {
  694. printk(KERN_ERR "ERROR: API Mailbox timeout\n");
  695. return -1;
  696. }
  697. udelay(10);
  698. }
  699. /* read output values */
  700. for (i = 0; i < out; i++) {
  701. mc417_memory_read(dev, dev->cx23417_mailbox + 4 + i, data + i);
  702. dprintk(3, "API Output %d = %d\n", i, data[i]);
  703. }
  704. mc417_memory_read(dev, dev->cx23417_mailbox + 2, &retval);
  705. dprintk(3, "API result = %d\n", retval);
  706. flag = 0;
  707. mc417_memory_write(dev, dev->cx23417_mailbox, flag);
  708. return retval;
  709. }
  710. /* We don't need to call the API often, so using just one
  711. * mailbox will probably suffice
  712. */
  713. static int cx23885_api_cmd(struct cx23885_dev *dev,
  714. u32 command,
  715. u32 inputcnt,
  716. u32 outputcnt,
  717. ...)
  718. {
  719. u32 data[CX2341X_MBOX_MAX_DATA];
  720. va_list vargs;
  721. int i, err;
  722. dprintk(3, "%s() cmds = 0x%08x\n", __func__, command);
  723. va_start(vargs, outputcnt);
  724. for (i = 0; i < inputcnt; i++)
  725. data[i] = va_arg(vargs, int);
  726. err = cx23885_mbox_func(dev, command, inputcnt, outputcnt, data);
  727. for (i = 0; i < outputcnt; i++) {
  728. int *vptr = va_arg(vargs, int *);
  729. *vptr = data[i];
  730. }
  731. va_end(vargs);
  732. return err;
  733. }
  734. static int cx23885_find_mailbox(struct cx23885_dev *dev)
  735. {
  736. u32 signature[4] = {
  737. 0x12345678, 0x34567812, 0x56781234, 0x78123456
  738. };
  739. int signaturecnt = 0;
  740. u32 value;
  741. int i;
  742. dprintk(2, "%s()\n", __func__);
  743. for (i = 0; i < CX23885_FIRM_IMAGE_SIZE; i++) {
  744. mc417_memory_read(dev, i, &value);
  745. if (value == signature[signaturecnt])
  746. signaturecnt++;
  747. else
  748. signaturecnt = 0;
  749. if (4 == signaturecnt) {
  750. dprintk(1, "Mailbox signature found at 0x%x\n", i+1);
  751. return i+1;
  752. }
  753. }
  754. printk(KERN_ERR "Mailbox signature values not found!\n");
  755. return -1;
  756. }
  757. static int cx23885_load_firmware(struct cx23885_dev *dev)
  758. {
  759. static const unsigned char magic[8] = {
  760. 0xa7, 0x0d, 0x00, 0x00, 0x66, 0xbb, 0x55, 0xaa
  761. };
  762. const struct firmware *firmware;
  763. int i, retval = 0;
  764. u32 value = 0;
  765. u32 gpio_output = 0;
  766. u32 checksum = 0;
  767. u32 *dataptr;
  768. dprintk(2, "%s()\n", __func__);
  769. /* Save GPIO settings before reset of APU */
  770. retval |= mc417_memory_read(dev, 0x9020, &gpio_output);
  771. retval |= mc417_memory_read(dev, 0x900C, &value);
  772. retval = mc417_register_write(dev,
  773. IVTV_REG_VPU, 0xFFFFFFED);
  774. retval |= mc417_register_write(dev,
  775. IVTV_REG_HW_BLOCKS, IVTV_CMD_HW_BLOCKS_RST);
  776. retval |= mc417_register_write(dev,
  777. IVTV_REG_ENC_SDRAM_REFRESH, 0x80000800);
  778. retval |= mc417_register_write(dev,
  779. IVTV_REG_ENC_SDRAM_PRECHARGE, 0x1A);
  780. retval |= mc417_register_write(dev,
  781. IVTV_REG_APU, 0);
  782. if (retval != 0) {
  783. printk(KERN_ERR "%s: Error with mc417_register_write\n",
  784. __func__);
  785. return -1;
  786. }
  787. retval = request_firmware(&firmware, CX23885_FIRM_IMAGE_NAME,
  788. &dev->pci->dev);
  789. if (retval != 0) {
  790. printk(KERN_ERR
  791. "ERROR: Hotplug firmware request failed (%s).\n",
  792. CX23885_FIRM_IMAGE_NAME);
  793. printk(KERN_ERR "Please fix your hotplug setup, the board will "
  794. "not work without firmware loaded!\n");
  795. return -1;
  796. }
  797. if (firmware->size != CX23885_FIRM_IMAGE_SIZE) {
  798. printk(KERN_ERR "ERROR: Firmware size mismatch "
  799. "(have %zd, expected %d)\n",
  800. firmware->size, CX23885_FIRM_IMAGE_SIZE);
  801. release_firmware(firmware);
  802. return -1;
  803. }
  804. if (0 != memcmp(firmware->data, magic, 8)) {
  805. printk(KERN_ERR
  806. "ERROR: Firmware magic mismatch, wrong file?\n");
  807. release_firmware(firmware);
  808. return -1;
  809. }
  810. /* transfer to the chip */
  811. dprintk(2, "Loading firmware ...\n");
  812. dataptr = (u32 *)firmware->data;
  813. for (i = 0; i < (firmware->size >> 2); i++) {
  814. value = *dataptr;
  815. checksum += ~value;
  816. if (mc417_memory_write(dev, i, value) != 0) {
  817. printk(KERN_ERR "ERROR: Loading firmware failed!\n");
  818. release_firmware(firmware);
  819. return -1;
  820. }
  821. dataptr++;
  822. }
  823. /* read back to verify with the checksum */
  824. dprintk(1, "Verifying firmware ...\n");
  825. for (i--; i >= 0; i--) {
  826. if (mc417_memory_read(dev, i, &value) != 0) {
  827. printk(KERN_ERR "ERROR: Reading firmware failed!\n");
  828. release_firmware(firmware);
  829. return -1;
  830. }
  831. checksum -= ~value;
  832. }
  833. if (checksum) {
  834. printk(KERN_ERR
  835. "ERROR: Firmware load failed (checksum mismatch).\n");
  836. release_firmware(firmware);
  837. return -1;
  838. }
  839. release_firmware(firmware);
  840. dprintk(1, "Firmware upload successful.\n");
  841. retval |= mc417_register_write(dev, IVTV_REG_HW_BLOCKS,
  842. IVTV_CMD_HW_BLOCKS_RST);
  843. /* Restore GPIO settings, make sure EIO14 is enabled as an output. */
  844. dprintk(2, "%s: GPIO output EIO 0-15 was = 0x%x\n",
  845. __func__, gpio_output);
  846. /* Power-up seems to have GPIOs AFU. This was causing digital side
  847. * to fail at power-up. Seems GPIOs should be set to 0x10ff0411 at
  848. * power-up.
  849. * gpio_output |= (1<<14);
  850. */
  851. /* Note: GPIO14 is specific to the HVR1800 here */
  852. gpio_output = 0x10ff0411 | (1<<14);
  853. retval |= mc417_register_write(dev, 0x9020, gpio_output | (1<<14));
  854. dprintk(2, "%s: GPIO output EIO 0-15 now = 0x%x\n",
  855. __func__, gpio_output);
  856. dprintk(1, "%s: GPIO value EIO 0-15 was = 0x%x\n",
  857. __func__, value);
  858. value |= (1<<14);
  859. dprintk(1, "%s: GPIO value EIO 0-15 now = 0x%x\n",
  860. __func__, value);
  861. retval |= mc417_register_write(dev, 0x900C, value);
  862. retval |= mc417_register_read(dev, IVTV_REG_VPU, &value);
  863. retval |= mc417_register_write(dev, IVTV_REG_VPU, value & 0xFFFFFFE8);
  864. if (retval < 0)
  865. printk(KERN_ERR "%s: Error with mc417_register_write\n",
  866. __func__);
  867. return 0;
  868. }
  869. void cx23885_417_check_encoder(struct cx23885_dev *dev)
  870. {
  871. u32 status, seq;
  872. status = seq = 0;
  873. cx23885_api_cmd(dev, CX2341X_ENC_GET_SEQ_END, 0, 2, &status, &seq);
  874. dprintk(1, "%s() status = %d, seq = %d\n", __func__, status, seq);
  875. }
  876. static void cx23885_codec_settings(struct cx23885_dev *dev)
  877. {
  878. dprintk(1, "%s()\n", __func__);
  879. /* assign frame size */
  880. cx23885_api_cmd(dev, CX2341X_ENC_SET_FRAME_SIZE, 2, 0,
  881. dev->ts1.height, dev->ts1.width);
  882. dev->mpeg_params.width = dev->ts1.width;
  883. dev->mpeg_params.height = dev->ts1.height;
  884. dev->mpeg_params.is_50hz =
  885. (dev->encodernorm.id & V4L2_STD_625_50) != 0;
  886. cx2341x_update(dev, cx23885_mbox_func, NULL, &dev->mpeg_params);
  887. cx23885_api_cmd(dev, CX2341X_ENC_MISC, 2, 0, 3, 1);
  888. cx23885_api_cmd(dev, CX2341X_ENC_MISC, 2, 0, 4, 1);
  889. }
  890. static int cx23885_initialize_codec(struct cx23885_dev *dev)
  891. {
  892. int version;
  893. int retval;
  894. u32 i, data[7];
  895. dprintk(1, "%s()\n", __func__);
  896. retval = cx23885_api_cmd(dev, CX2341X_ENC_PING_FW, 0, 0); /* ping */
  897. if (retval < 0) {
  898. dprintk(2, "%s() PING OK\n", __func__);
  899. retval = cx23885_load_firmware(dev);
  900. if (retval < 0) {
  901. printk(KERN_ERR "%s() f/w load failed\n", __func__);
  902. return retval;
  903. }
  904. retval = cx23885_find_mailbox(dev);
  905. if (retval < 0) {
  906. printk(KERN_ERR "%s() mailbox < 0, error\n",
  907. __func__);
  908. return -1;
  909. }
  910. dev->cx23417_mailbox = retval;
  911. retval = cx23885_api_cmd(dev, CX2341X_ENC_PING_FW, 0, 0);
  912. if (retval < 0) {
  913. printk(KERN_ERR
  914. "ERROR: cx23417 firmware ping failed!\n");
  915. return -1;
  916. }
  917. retval = cx23885_api_cmd(dev, CX2341X_ENC_GET_VERSION, 0, 1,
  918. &version);
  919. if (retval < 0) {
  920. printk(KERN_ERR "ERROR: cx23417 firmware get encoder :"
  921. "version failed!\n");
  922. return -1;
  923. }
  924. dprintk(1, "cx23417 firmware version is 0x%08x\n", version);
  925. msleep(200);
  926. }
  927. cx23885_codec_settings(dev);
  928. msleep(60);
  929. cx23885_api_cmd(dev, CX2341X_ENC_SET_NUM_VSYNC_LINES, 2, 0,
  930. CX23885_FIELD1_SAA7115, CX23885_FIELD2_SAA7115);
  931. cx23885_api_cmd(dev, CX2341X_ENC_SET_PLACEHOLDER, 12, 0,
  932. CX23885_CUSTOM_EXTENSION_USR_DATA, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  933. 0, 0);
  934. /* Setup to capture VBI */
  935. data[0] = 0x0001BD00;
  936. data[1] = 1; /* frames per interrupt */
  937. data[2] = 4; /* total bufs */
  938. data[3] = 0x91559155; /* start codes */
  939. data[4] = 0x206080C0; /* stop codes */
  940. data[5] = 6; /* lines */
  941. data[6] = 64; /* BPL */
  942. cx23885_api_cmd(dev, CX2341X_ENC_SET_VBI_CONFIG, 7, 0, data[0], data[1],
  943. data[2], data[3], data[4], data[5], data[6]);
  944. for (i = 2; i <= 24; i++) {
  945. int valid;
  946. valid = ((i >= 19) && (i <= 21));
  947. cx23885_api_cmd(dev, CX2341X_ENC_SET_VBI_LINE, 5, 0, i,
  948. valid, 0 , 0, 0);
  949. cx23885_api_cmd(dev, CX2341X_ENC_SET_VBI_LINE, 5, 0,
  950. i | 0x80000000, valid, 0, 0, 0);
  951. }
  952. cx23885_api_cmd(dev, CX2341X_ENC_MUTE_AUDIO, 1, 0, CX23885_UNMUTE);
  953. msleep(60);
  954. /* initialize the video input */
  955. cx23885_api_cmd(dev, CX2341X_ENC_INITIALIZE_INPUT, 0, 0);
  956. msleep(60);
  957. /* Enable VIP style pixel invalidation so we work with scaled mode */
  958. mc417_memory_write(dev, 2120, 0x00000080);
  959. /* start capturing to the host interface */
  960. cx23885_api_cmd(dev, CX2341X_ENC_START_CAPTURE, 2, 0,
  961. CX23885_MPEG_CAPTURE, CX23885_RAW_BITS_NONE);
  962. msleep(10);
  963. return 0;
  964. }
  965. /* ------------------------------------------------------------------ */
  966. static int bb_buf_setup(struct videobuf_queue *q,
  967. unsigned int *count, unsigned int *size)
  968. {
  969. struct cx23885_fh *fh = q->priv_data;
  970. fh->dev->ts1.ts_packet_size = mpeglinesize;
  971. fh->dev->ts1.ts_packet_count = mpeglines;
  972. *size = fh->dev->ts1.ts_packet_size * fh->dev->ts1.ts_packet_count;
  973. *count = mpegbufs;
  974. return 0;
  975. }
  976. static int bb_buf_prepare(struct videobuf_queue *q,
  977. struct videobuf_buffer *vb, enum v4l2_field field)
  978. {
  979. struct cx23885_fh *fh = q->priv_data;
  980. return cx23885_buf_prepare(q, &fh->dev->ts1,
  981. (struct cx23885_buffer *)vb,
  982. field);
  983. }
  984. static void bb_buf_queue(struct videobuf_queue *q,
  985. struct videobuf_buffer *vb)
  986. {
  987. struct cx23885_fh *fh = q->priv_data;
  988. cx23885_buf_queue(&fh->dev->ts1, (struct cx23885_buffer *)vb);
  989. }
  990. static void bb_buf_release(struct videobuf_queue *q,
  991. struct videobuf_buffer *vb)
  992. {
  993. cx23885_free_buffer(q, (struct cx23885_buffer *)vb);
  994. }
  995. static struct videobuf_queue_ops cx23885_qops = {
  996. .buf_setup = bb_buf_setup,
  997. .buf_prepare = bb_buf_prepare,
  998. .buf_queue = bb_buf_queue,
  999. .buf_release = bb_buf_release,
  1000. };
  1001. /* ------------------------------------------------------------------ */
  1002. static const u32 *ctrl_classes[] = {
  1003. cx2341x_mpeg_ctrls,
  1004. NULL
  1005. };
  1006. static int cx23885_queryctrl(struct cx23885_dev *dev,
  1007. struct v4l2_queryctrl *qctrl)
  1008. {
  1009. qctrl->id = v4l2_ctrl_next(ctrl_classes, qctrl->id);
  1010. if (qctrl->id == 0)
  1011. return -EINVAL;
  1012. /* MPEG V4L2 controls */
  1013. if (cx2341x_ctrl_query(&dev->mpeg_params, qctrl))
  1014. qctrl->flags |= V4L2_CTRL_FLAG_DISABLED;
  1015. return 0;
  1016. }
  1017. static int cx23885_querymenu(struct cx23885_dev *dev,
  1018. struct v4l2_querymenu *qmenu)
  1019. {
  1020. struct v4l2_queryctrl qctrl;
  1021. qctrl.id = qmenu->id;
  1022. cx23885_queryctrl(dev, &qctrl);
  1023. return v4l2_ctrl_query_menu(qmenu, &qctrl,
  1024. cx2341x_ctrl_get_menu(&dev->mpeg_params, qmenu->id));
  1025. }
  1026. static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id *id)
  1027. {
  1028. struct cx23885_fh *fh = file->private_data;
  1029. struct cx23885_dev *dev = fh->dev;
  1030. unsigned int i;
  1031. for (i = 0; i < ARRAY_SIZE(cx23885_tvnorms); i++)
  1032. if (*id & cx23885_tvnorms[i].id)
  1033. break;
  1034. if (i == ARRAY_SIZE(cx23885_tvnorms))
  1035. return -EINVAL;
  1036. dev->encodernorm = cx23885_tvnorms[i];
  1037. return 0;
  1038. }
  1039. static int vidioc_enum_input(struct file *file, void *priv,
  1040. struct v4l2_input *i)
  1041. {
  1042. struct cx23885_fh *fh = file->private_data;
  1043. struct cx23885_dev *dev = fh->dev;
  1044. struct cx23885_input *input;
  1045. int n;
  1046. if (i->index >= 4)
  1047. return -EINVAL;
  1048. input = &cx23885_boards[dev->board].input[i->index];
  1049. if (input->type == 0)
  1050. return -EINVAL;
  1051. /* FIXME
  1052. * strcpy(i->name, input->name); */
  1053. strcpy(i->name, "unset");
  1054. if (input->type == CX23885_VMUX_TELEVISION ||
  1055. input->type == CX23885_VMUX_CABLE)
  1056. i->type = V4L2_INPUT_TYPE_TUNER;
  1057. else
  1058. i->type = V4L2_INPUT_TYPE_CAMERA;
  1059. for (n = 0; n < ARRAY_SIZE(cx23885_tvnorms); n++)
  1060. i->std |= cx23885_tvnorms[n].id;
  1061. return 0;
  1062. }
  1063. static int vidioc_g_input(struct file *file, void *priv, unsigned int *i)
  1064. {
  1065. struct cx23885_fh *fh = file->private_data;
  1066. struct cx23885_dev *dev = fh->dev;
  1067. *i = dev->input;
  1068. return 0;
  1069. }
  1070. static int vidioc_s_input(struct file *file, void *priv, unsigned int i)
  1071. {
  1072. if (i >= 4)
  1073. return -EINVAL;
  1074. return 0;
  1075. }
  1076. static int vidioc_g_tuner(struct file *file, void *priv,
  1077. struct v4l2_tuner *t)
  1078. {
  1079. struct cx23885_fh *fh = file->private_data;
  1080. struct cx23885_dev *dev = fh->dev;
  1081. if (UNSET == dev->tuner_type)
  1082. return -EINVAL;
  1083. if (0 != t->index)
  1084. return -EINVAL;
  1085. strcpy(t->name, "Television");
  1086. call_all(dev, tuner, g_tuner, t);
  1087. dprintk(1, "VIDIOC_G_TUNER: tuner type %d\n", t->type);
  1088. return 0;
  1089. }
  1090. static int vidioc_s_tuner(struct file *file, void *priv,
  1091. struct v4l2_tuner *t)
  1092. {
  1093. struct cx23885_fh *fh = file->private_data;
  1094. struct cx23885_dev *dev = fh->dev;
  1095. if (UNSET == dev->tuner_type)
  1096. return -EINVAL;
  1097. /* Update the A/V core */
  1098. call_all(dev, tuner, s_tuner, t);
  1099. return 0;
  1100. }
  1101. static int vidioc_g_frequency(struct file *file, void *priv,
  1102. struct v4l2_frequency *f)
  1103. {
  1104. struct cx23885_fh *fh = file->private_data;
  1105. struct cx23885_dev *dev = fh->dev;
  1106. if (UNSET == dev->tuner_type)
  1107. return -EINVAL;
  1108. f->type = V4L2_TUNER_ANALOG_TV;
  1109. f->frequency = dev->freq;
  1110. call_all(dev, tuner, g_frequency, f);
  1111. return 0;
  1112. }
  1113. static int vidioc_s_frequency(struct file *file, void *priv,
  1114. struct v4l2_frequency *f)
  1115. {
  1116. struct cx23885_fh *fh = file->private_data;
  1117. struct cx23885_dev *dev = fh->dev;
  1118. cx23885_api_cmd(fh->dev, CX2341X_ENC_STOP_CAPTURE, 3, 0,
  1119. CX23885_END_NOW, CX23885_MPEG_CAPTURE,
  1120. CX23885_RAW_BITS_NONE);
  1121. dprintk(1, "VIDIOC_S_FREQUENCY: dev type %d, f\n",
  1122. dev->tuner_type);
  1123. dprintk(1, "VIDIOC_S_FREQUENCY: f tuner %d, f type %d\n",
  1124. f->tuner, f->type);
  1125. if (UNSET == dev->tuner_type)
  1126. return -EINVAL;
  1127. if (f->tuner != 0)
  1128. return -EINVAL;
  1129. if (f->type != V4L2_TUNER_ANALOG_TV)
  1130. return -EINVAL;
  1131. dev->freq = f->frequency;
  1132. call_all(dev, tuner, s_frequency, f);
  1133. cx23885_initialize_codec(dev);
  1134. return 0;
  1135. }
  1136. static int vidioc_s_ctrl(struct file *file, void *priv,
  1137. struct v4l2_control *ctl)
  1138. {
  1139. struct cx23885_fh *fh = file->private_data;
  1140. struct cx23885_dev *dev = fh->dev;
  1141. /* Update the A/V core */
  1142. call_all(dev, core, s_ctrl, ctl);
  1143. return 0;
  1144. }
  1145. static int vidioc_querycap(struct file *file, void *priv,
  1146. struct v4l2_capability *cap)
  1147. {
  1148. struct cx23885_fh *fh = file->private_data;
  1149. struct cx23885_dev *dev = fh->dev;
  1150. struct cx23885_tsport *tsport = &dev->ts1;
  1151. strcpy(cap->driver, dev->name);
  1152. strlcpy(cap->card, cx23885_boards[tsport->dev->board].name,
  1153. sizeof(cap->card));
  1154. sprintf(cap->bus_info, "PCI:%s", pci_name(dev->pci));
  1155. cap->version = CX23885_VERSION_CODE;
  1156. cap->capabilities =
  1157. V4L2_CAP_VIDEO_CAPTURE |
  1158. V4L2_CAP_READWRITE |
  1159. V4L2_CAP_STREAMING |
  1160. 0;
  1161. if (UNSET != dev->tuner_type)
  1162. cap->capabilities |= V4L2_CAP_TUNER;
  1163. return 0;
  1164. }
  1165. static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv,
  1166. struct v4l2_fmtdesc *f)
  1167. {
  1168. if (f->index != 0)
  1169. return -EINVAL;
  1170. strlcpy(f->description, "MPEG", sizeof(f->description));
  1171. f->pixelformat = V4L2_PIX_FMT_MPEG;
  1172. return 0;
  1173. }
  1174. static int vidioc_g_fmt_vid_cap(struct file *file, void *priv,
  1175. struct v4l2_format *f)
  1176. {
  1177. struct cx23885_fh *fh = file->private_data;
  1178. struct cx23885_dev *dev = fh->dev;
  1179. f->fmt.pix.pixelformat = V4L2_PIX_FMT_MPEG;
  1180. f->fmt.pix.bytesperline = 0;
  1181. f->fmt.pix.sizeimage =
  1182. dev->ts1.ts_packet_size * dev->ts1.ts_packet_count;
  1183. f->fmt.pix.colorspace = 0;
  1184. f->fmt.pix.width = dev->ts1.width;
  1185. f->fmt.pix.height = dev->ts1.height;
  1186. f->fmt.pix.field = fh->mpegq.field;
  1187. dprintk(1, "VIDIOC_G_FMT: w: %d, h: %d, f: %d\n",
  1188. dev->ts1.width, dev->ts1.height, fh->mpegq.field);
  1189. return 0;
  1190. }
  1191. static int vidioc_try_fmt_vid_cap(struct file *file, void *priv,
  1192. struct v4l2_format *f)
  1193. {
  1194. struct cx23885_fh *fh = file->private_data;
  1195. struct cx23885_dev *dev = fh->dev;
  1196. f->fmt.pix.pixelformat = V4L2_PIX_FMT_MPEG;
  1197. f->fmt.pix.bytesperline = 0;
  1198. f->fmt.pix.sizeimage =
  1199. dev->ts1.ts_packet_size * dev->ts1.ts_packet_count;
  1200. f->fmt.pix.colorspace = 0;
  1201. dprintk(1, "VIDIOC_TRY_FMT: w: %d, h: %d, f: %d\n",
  1202. dev->ts1.width, dev->ts1.height, fh->mpegq.field);
  1203. return 0;
  1204. }
  1205. static int vidioc_s_fmt_vid_cap(struct file *file, void *priv,
  1206. struct v4l2_format *f)
  1207. {
  1208. struct cx23885_fh *fh = file->private_data;
  1209. struct cx23885_dev *dev = fh->dev;
  1210. f->fmt.pix.pixelformat = V4L2_PIX_FMT_MPEG;
  1211. f->fmt.pix.bytesperline = 0;
  1212. f->fmt.pix.sizeimage =
  1213. dev->ts1.ts_packet_size * dev->ts1.ts_packet_count;
  1214. f->fmt.pix.colorspace = 0;
  1215. dprintk(1, "VIDIOC_S_FMT: w: %d, h: %d, f: %d\n",
  1216. f->fmt.pix.width, f->fmt.pix.height, f->fmt.pix.field);
  1217. return 0;
  1218. }
  1219. static int vidioc_reqbufs(struct file *file, void *priv,
  1220. struct v4l2_requestbuffers *p)
  1221. {
  1222. struct cx23885_fh *fh = file->private_data;
  1223. return videobuf_reqbufs(&fh->mpegq, p);
  1224. }
  1225. static int vidioc_querybuf(struct file *file, void *priv,
  1226. struct v4l2_buffer *p)
  1227. {
  1228. struct cx23885_fh *fh = file->private_data;
  1229. return videobuf_querybuf(&fh->mpegq, p);
  1230. }
  1231. static int vidioc_qbuf(struct file *file, void *priv,
  1232. struct v4l2_buffer *p)
  1233. {
  1234. struct cx23885_fh *fh = file->private_data;
  1235. return videobuf_qbuf(&fh->mpegq, p);
  1236. }
  1237. static int vidioc_dqbuf(struct file *file, void *priv, struct v4l2_buffer *b)
  1238. {
  1239. struct cx23885_fh *fh = priv;
  1240. return videobuf_dqbuf(&fh->mpegq, b, file->f_flags & O_NONBLOCK);
  1241. }
  1242. static int vidioc_streamon(struct file *file, void *priv,
  1243. enum v4l2_buf_type i)
  1244. {
  1245. struct cx23885_fh *fh = file->private_data;
  1246. return videobuf_streamon(&fh->mpegq);
  1247. }
  1248. static int vidioc_streamoff(struct file *file, void *priv, enum v4l2_buf_type i)
  1249. {
  1250. struct cx23885_fh *fh = file->private_data;
  1251. return videobuf_streamoff(&fh->mpegq);
  1252. }
  1253. static int vidioc_g_ext_ctrls(struct file *file, void *priv,
  1254. struct v4l2_ext_controls *f)
  1255. {
  1256. struct cx23885_fh *fh = priv;
  1257. struct cx23885_dev *dev = fh->dev;
  1258. if (f->ctrl_class != V4L2_CTRL_CLASS_MPEG)
  1259. return -EINVAL;
  1260. return cx2341x_ext_ctrls(&dev->mpeg_params, 0, f, VIDIOC_G_EXT_CTRLS);
  1261. }
  1262. static int vidioc_s_ext_ctrls(struct file *file, void *priv,
  1263. struct v4l2_ext_controls *f)
  1264. {
  1265. struct cx23885_fh *fh = priv;
  1266. struct cx23885_dev *dev = fh->dev;
  1267. struct cx2341x_mpeg_params p;
  1268. int err;
  1269. if (f->ctrl_class != V4L2_CTRL_CLASS_MPEG)
  1270. return -EINVAL;
  1271. p = dev->mpeg_params;
  1272. err = cx2341x_ext_ctrls(&p, 0, f, VIDIOC_S_EXT_CTRLS);
  1273. if (err == 0) {
  1274. err = cx2341x_update(dev, cx23885_mbox_func,
  1275. &dev->mpeg_params, &p);
  1276. dev->mpeg_params = p;
  1277. }
  1278. return err;
  1279. }
  1280. static int vidioc_try_ext_ctrls(struct file *file, void *priv,
  1281. struct v4l2_ext_controls *f)
  1282. {
  1283. struct cx23885_fh *fh = priv;
  1284. struct cx23885_dev *dev = fh->dev;
  1285. struct cx2341x_mpeg_params p;
  1286. int err;
  1287. if (f->ctrl_class != V4L2_CTRL_CLASS_MPEG)
  1288. return -EINVAL;
  1289. p = dev->mpeg_params;
  1290. err = cx2341x_ext_ctrls(&p, 0, f, VIDIOC_TRY_EXT_CTRLS);
  1291. return err;
  1292. }
  1293. static int vidioc_log_status(struct file *file, void *priv)
  1294. {
  1295. struct cx23885_fh *fh = priv;
  1296. struct cx23885_dev *dev = fh->dev;
  1297. char name[32 + 2];
  1298. snprintf(name, sizeof(name), "%s/2", dev->name);
  1299. printk(KERN_INFO
  1300. "%s/2: ============ START LOG STATUS ============\n",
  1301. dev->name);
  1302. call_all(dev, core, log_status);
  1303. cx2341x_log_status(&dev->mpeg_params, name);
  1304. printk(KERN_INFO
  1305. "%s/2: ============= END LOG STATUS =============\n",
  1306. dev->name);
  1307. return 0;
  1308. }
  1309. static int vidioc_querymenu(struct file *file, void *priv,
  1310. struct v4l2_querymenu *a)
  1311. {
  1312. struct cx23885_fh *fh = priv;
  1313. struct cx23885_dev *dev = fh->dev;
  1314. return cx23885_querymenu(dev, a);
  1315. }
  1316. static int vidioc_queryctrl(struct file *file, void *priv,
  1317. struct v4l2_queryctrl *c)
  1318. {
  1319. struct cx23885_fh *fh = priv;
  1320. struct cx23885_dev *dev = fh->dev;
  1321. return cx23885_queryctrl(dev, c);
  1322. }
  1323. static int mpeg_open(struct file *file)
  1324. {
  1325. int minor = video_devdata(file)->minor;
  1326. struct cx23885_dev *h, *dev = NULL;
  1327. struct list_head *list;
  1328. struct cx23885_fh *fh;
  1329. dprintk(2, "%s()\n", __func__);
  1330. lock_kernel();
  1331. list_for_each(list, &cx23885_devlist) {
  1332. h = list_entry(list, struct cx23885_dev, devlist);
  1333. if (h->v4l_device &&
  1334. h->v4l_device->minor == minor) {
  1335. dev = h;
  1336. break;
  1337. }
  1338. }
  1339. if (dev == NULL) {
  1340. unlock_kernel();
  1341. return -ENODEV;
  1342. }
  1343. /* allocate + initialize per filehandle data */
  1344. fh = kzalloc(sizeof(*fh), GFP_KERNEL);
  1345. if (NULL == fh) {
  1346. unlock_kernel();
  1347. return -ENOMEM;
  1348. }
  1349. file->private_data = fh;
  1350. fh->dev = dev;
  1351. videobuf_queue_sg_init(&fh->mpegq, &cx23885_qops,
  1352. &dev->pci->dev, &dev->ts1.slock,
  1353. V4L2_BUF_TYPE_VIDEO_CAPTURE,
  1354. V4L2_FIELD_INTERLACED,
  1355. sizeof(struct cx23885_buffer),
  1356. fh);
  1357. unlock_kernel();
  1358. return 0;
  1359. }
  1360. static int mpeg_release(struct file *file)
  1361. {
  1362. struct cx23885_fh *fh = file->private_data;
  1363. struct cx23885_dev *dev = fh->dev;
  1364. dprintk(2, "%s()\n", __func__);
  1365. /* FIXME: Review this crap */
  1366. /* Shut device down on last close */
  1367. if (atomic_cmpxchg(&fh->v4l_reading, 1, 0) == 1) {
  1368. if (atomic_dec_return(&dev->v4l_reader_count) == 0) {
  1369. /* stop mpeg capture */
  1370. cx23885_api_cmd(fh->dev, CX2341X_ENC_STOP_CAPTURE, 3, 0,
  1371. CX23885_END_NOW, CX23885_MPEG_CAPTURE,
  1372. CX23885_RAW_BITS_NONE);
  1373. msleep(500);
  1374. cx23885_417_check_encoder(dev);
  1375. cx23885_cancel_buffers(&fh->dev->ts1);
  1376. }
  1377. }
  1378. if (fh->mpegq.streaming)
  1379. videobuf_streamoff(&fh->mpegq);
  1380. if (fh->mpegq.reading)
  1381. videobuf_read_stop(&fh->mpegq);
  1382. videobuf_mmap_free(&fh->mpegq);
  1383. file->private_data = NULL;
  1384. kfree(fh);
  1385. return 0;
  1386. }
  1387. static ssize_t mpeg_read(struct file *file, char __user *data,
  1388. size_t count, loff_t *ppos)
  1389. {
  1390. struct cx23885_fh *fh = file->private_data;
  1391. struct cx23885_dev *dev = fh->dev;
  1392. dprintk(2, "%s()\n", __func__);
  1393. /* Deal w/ A/V decoder * and mpeg encoder sync issues. */
  1394. /* Start mpeg encoder on first read. */
  1395. if (atomic_cmpxchg(&fh->v4l_reading, 0, 1) == 0) {
  1396. if (atomic_inc_return(&dev->v4l_reader_count) == 1) {
  1397. if (cx23885_initialize_codec(dev) < 0)
  1398. return -EINVAL;
  1399. }
  1400. }
  1401. return videobuf_read_stream(&fh->mpegq, data, count, ppos, 0,
  1402. file->f_flags & O_NONBLOCK);
  1403. }
  1404. static unsigned int mpeg_poll(struct file *file,
  1405. struct poll_table_struct *wait)
  1406. {
  1407. struct cx23885_fh *fh = file->private_data;
  1408. struct cx23885_dev *dev = fh->dev;
  1409. dprintk(2, "%s\n", __func__);
  1410. return videobuf_poll_stream(file, &fh->mpegq, wait);
  1411. }
  1412. static int mpeg_mmap(struct file *file, struct vm_area_struct *vma)
  1413. {
  1414. struct cx23885_fh *fh = file->private_data;
  1415. struct cx23885_dev *dev = fh->dev;
  1416. dprintk(2, "%s()\n", __func__);
  1417. return videobuf_mmap_mapper(&fh->mpegq, vma);
  1418. }
  1419. static struct v4l2_file_operations mpeg_fops = {
  1420. .owner = THIS_MODULE,
  1421. .open = mpeg_open,
  1422. .release = mpeg_release,
  1423. .read = mpeg_read,
  1424. .poll = mpeg_poll,
  1425. .mmap = mpeg_mmap,
  1426. };
  1427. static const struct v4l2_ioctl_ops mpeg_ioctl_ops = {
  1428. .vidioc_s_std = vidioc_s_std,
  1429. .vidioc_enum_input = vidioc_enum_input,
  1430. .vidioc_g_input = vidioc_g_input,
  1431. .vidioc_s_input = vidioc_s_input,
  1432. .vidioc_g_tuner = vidioc_g_tuner,
  1433. .vidioc_s_tuner = vidioc_s_tuner,
  1434. .vidioc_g_frequency = vidioc_g_frequency,
  1435. .vidioc_s_frequency = vidioc_s_frequency,
  1436. .vidioc_s_ctrl = vidioc_s_ctrl,
  1437. .vidioc_querycap = vidioc_querycap,
  1438. .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap,
  1439. .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap,
  1440. .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap,
  1441. .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap,
  1442. .vidioc_reqbufs = vidioc_reqbufs,
  1443. .vidioc_querybuf = vidioc_querybuf,
  1444. .vidioc_qbuf = vidioc_qbuf,
  1445. .vidioc_dqbuf = vidioc_dqbuf,
  1446. .vidioc_streamon = vidioc_streamon,
  1447. .vidioc_streamoff = vidioc_streamoff,
  1448. .vidioc_g_ext_ctrls = vidioc_g_ext_ctrls,
  1449. .vidioc_s_ext_ctrls = vidioc_s_ext_ctrls,
  1450. .vidioc_try_ext_ctrls = vidioc_try_ext_ctrls,
  1451. .vidioc_log_status = vidioc_log_status,
  1452. .vidioc_querymenu = vidioc_querymenu,
  1453. .vidioc_queryctrl = vidioc_queryctrl,
  1454. };
  1455. static struct video_device cx23885_mpeg_template = {
  1456. .name = "cx23885",
  1457. .fops = &mpeg_fops,
  1458. .ioctl_ops = &mpeg_ioctl_ops,
  1459. .minor = -1,
  1460. };
  1461. void cx23885_417_unregister(struct cx23885_dev *dev)
  1462. {
  1463. dprintk(1, "%s()\n", __func__);
  1464. if (dev->v4l_device) {
  1465. if (-1 != dev->v4l_device->minor)
  1466. video_unregister_device(dev->v4l_device);
  1467. else
  1468. video_device_release(dev->v4l_device);
  1469. dev->v4l_device = NULL;
  1470. }
  1471. }
  1472. static struct video_device *cx23885_video_dev_alloc(
  1473. struct cx23885_tsport *tsport,
  1474. struct pci_dev *pci,
  1475. struct video_device *template,
  1476. char *type)
  1477. {
  1478. struct video_device *vfd;
  1479. struct cx23885_dev *dev = tsport->dev;
  1480. dprintk(1, "%s()\n", __func__);
  1481. vfd = video_device_alloc();
  1482. if (NULL == vfd)
  1483. return NULL;
  1484. *vfd = *template;
  1485. snprintf(vfd->name, sizeof(vfd->name), "%s %s (%s)", dev->name,
  1486. type, cx23885_boards[tsport->dev->board].name);
  1487. vfd->parent = &pci->dev;
  1488. vfd->release = video_device_release;
  1489. return vfd;
  1490. }
  1491. int cx23885_417_register(struct cx23885_dev *dev)
  1492. {
  1493. /* FIXME: Port1 hardcoded here */
  1494. int err = -ENODEV;
  1495. struct cx23885_tsport *tsport = &dev->ts1;
  1496. dprintk(1, "%s()\n", __func__);
  1497. if (cx23885_boards[dev->board].portb != CX23885_MPEG_ENCODER)
  1498. return err;
  1499. /* Set default TV standard */
  1500. dev->encodernorm = cx23885_tvnorms[0];
  1501. if (dev->encodernorm.id & V4L2_STD_525_60)
  1502. tsport->height = 480;
  1503. else
  1504. tsport->height = 576;
  1505. tsport->width = 720;
  1506. cx2341x_fill_defaults(&dev->mpeg_params);
  1507. dev->mpeg_params.port = CX2341X_PORT_SERIAL;
  1508. /* Allocate and initialize V4L video device */
  1509. dev->v4l_device = cx23885_video_dev_alloc(tsport,
  1510. dev->pci, &cx23885_mpeg_template, "mpeg");
  1511. err = video_register_device(dev->v4l_device,
  1512. VFL_TYPE_GRABBER, -1);
  1513. if (err < 0) {
  1514. printk(KERN_INFO "%s: can't register mpeg device\n", dev->name);
  1515. return err;
  1516. }
  1517. /* Initialize MC417 registers */
  1518. cx23885_mc417_init(dev);
  1519. printk(KERN_INFO "%s: registered device video%d [mpeg]\n",
  1520. dev->name, dev->v4l_device->num);
  1521. return 0;
  1522. }