cx23885-417.c 49 KB

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