cx23885-417.c 49 KB

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