/drivers/media/video/cx23885/cx23885-417.c

https://bitbucket.org/wisechild/galaxy-nexus · C · 1796 lines · 1367 code · 272 blank · 157 comment · 110 complexity · d88212b834643d28cd86be992d0c92fd MD5 · raw file

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