cx23885-417.c 48 KB

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