162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci *
462306a36Sopenharmony_ci *  Support for a cx23417 mpeg encoder via cx23885 host port.
562306a36Sopenharmony_ci *
662306a36Sopenharmony_ci *    (c) 2004 Jelle Foks <jelle@foks.us>
762306a36Sopenharmony_ci *    (c) 2004 Gerd Knorr <kraxel@bytesex.org>
862306a36Sopenharmony_ci *    (c) 2008 Steven Toth <stoth@linuxtv.org>
962306a36Sopenharmony_ci *      - CX23885/7/8 support
1062306a36Sopenharmony_ci *
1162306a36Sopenharmony_ci *  Includes parts from the ivtv driver <http://sourceforge.net/projects/ivtv/>
1262306a36Sopenharmony_ci */
1362306a36Sopenharmony_ci
1462306a36Sopenharmony_ci#include "cx23885.h"
1562306a36Sopenharmony_ci#include "cx23885-ioctl.h"
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_ci#include <linux/module.h>
1862306a36Sopenharmony_ci#include <linux/moduleparam.h>
1962306a36Sopenharmony_ci#include <linux/init.h>
2062306a36Sopenharmony_ci#include <linux/fs.h>
2162306a36Sopenharmony_ci#include <linux/delay.h>
2262306a36Sopenharmony_ci#include <linux/device.h>
2362306a36Sopenharmony_ci#include <linux/firmware.h>
2462306a36Sopenharmony_ci#include <linux/slab.h>
2562306a36Sopenharmony_ci#include <media/v4l2-common.h>
2662306a36Sopenharmony_ci#include <media/v4l2-ioctl.h>
2762306a36Sopenharmony_ci#include <media/drv-intf/cx2341x.h>
2862306a36Sopenharmony_ci
2962306a36Sopenharmony_ci#define CX23885_FIRM_IMAGE_SIZE 376836
3062306a36Sopenharmony_ci#define CX23885_FIRM_IMAGE_NAME "v4l-cx23885-enc.fw"
3162306a36Sopenharmony_ci
3262306a36Sopenharmony_cistatic unsigned int mpegbufs = 32;
3362306a36Sopenharmony_cimodule_param(mpegbufs, int, 0644);
3462306a36Sopenharmony_ciMODULE_PARM_DESC(mpegbufs, "number of mpeg buffers, range 2-32");
3562306a36Sopenharmony_cistatic unsigned int mpeglines = 32;
3662306a36Sopenharmony_cimodule_param(mpeglines, int, 0644);
3762306a36Sopenharmony_ciMODULE_PARM_DESC(mpeglines, "number of lines in an MPEG buffer, range 2-32");
3862306a36Sopenharmony_cistatic unsigned int mpeglinesize = 512;
3962306a36Sopenharmony_cimodule_param(mpeglinesize, int, 0644);
4062306a36Sopenharmony_ciMODULE_PARM_DESC(mpeglinesize,
4162306a36Sopenharmony_ci	"number of bytes in each line of an MPEG buffer, range 512-1024");
4262306a36Sopenharmony_ci
4362306a36Sopenharmony_cistatic unsigned int v4l_debug;
4462306a36Sopenharmony_cimodule_param(v4l_debug, int, 0644);
4562306a36Sopenharmony_ciMODULE_PARM_DESC(v4l_debug, "enable V4L debug messages");
4662306a36Sopenharmony_ci
4762306a36Sopenharmony_ci#define dprintk(level, fmt, arg...)\
4862306a36Sopenharmony_ci	do { if (v4l_debug >= level) \
4962306a36Sopenharmony_ci		printk(KERN_DEBUG pr_fmt("%s: 417:" fmt), \
5062306a36Sopenharmony_ci			__func__, ##arg); \
5162306a36Sopenharmony_ci	} while (0)
5262306a36Sopenharmony_ci
5362306a36Sopenharmony_cistatic struct cx23885_tvnorm cx23885_tvnorms[] = {
5462306a36Sopenharmony_ci	{
5562306a36Sopenharmony_ci		.name      = "NTSC-M",
5662306a36Sopenharmony_ci		.id        = V4L2_STD_NTSC_M,
5762306a36Sopenharmony_ci	}, {
5862306a36Sopenharmony_ci		.name      = "NTSC-JP",
5962306a36Sopenharmony_ci		.id        = V4L2_STD_NTSC_M_JP,
6062306a36Sopenharmony_ci	}, {
6162306a36Sopenharmony_ci		.name      = "PAL-BG",
6262306a36Sopenharmony_ci		.id        = V4L2_STD_PAL_BG,
6362306a36Sopenharmony_ci	}, {
6462306a36Sopenharmony_ci		.name      = "PAL-DK",
6562306a36Sopenharmony_ci		.id        = V4L2_STD_PAL_DK,
6662306a36Sopenharmony_ci	}, {
6762306a36Sopenharmony_ci		.name      = "PAL-I",
6862306a36Sopenharmony_ci		.id        = V4L2_STD_PAL_I,
6962306a36Sopenharmony_ci	}, {
7062306a36Sopenharmony_ci		.name      = "PAL-M",
7162306a36Sopenharmony_ci		.id        = V4L2_STD_PAL_M,
7262306a36Sopenharmony_ci	}, {
7362306a36Sopenharmony_ci		.name      = "PAL-N",
7462306a36Sopenharmony_ci		.id        = V4L2_STD_PAL_N,
7562306a36Sopenharmony_ci	}, {
7662306a36Sopenharmony_ci		.name      = "PAL-Nc",
7762306a36Sopenharmony_ci		.id        = V4L2_STD_PAL_Nc,
7862306a36Sopenharmony_ci	}, {
7962306a36Sopenharmony_ci		.name      = "PAL-60",
8062306a36Sopenharmony_ci		.id        = V4L2_STD_PAL_60,
8162306a36Sopenharmony_ci	}, {
8262306a36Sopenharmony_ci		.name      = "SECAM-L",
8362306a36Sopenharmony_ci		.id        = V4L2_STD_SECAM_L,
8462306a36Sopenharmony_ci	}, {
8562306a36Sopenharmony_ci		.name      = "SECAM-DK",
8662306a36Sopenharmony_ci		.id        = V4L2_STD_SECAM_DK,
8762306a36Sopenharmony_ci	}
8862306a36Sopenharmony_ci};
8962306a36Sopenharmony_ci
9062306a36Sopenharmony_ci/* ------------------------------------------------------------------ */
9162306a36Sopenharmony_cienum cx23885_capture_type {
9262306a36Sopenharmony_ci	CX23885_MPEG_CAPTURE,
9362306a36Sopenharmony_ci	CX23885_RAW_CAPTURE,
9462306a36Sopenharmony_ci	CX23885_RAW_PASSTHRU_CAPTURE
9562306a36Sopenharmony_ci};
9662306a36Sopenharmony_cienum cx23885_capture_bits {
9762306a36Sopenharmony_ci	CX23885_RAW_BITS_NONE             = 0x00,
9862306a36Sopenharmony_ci	CX23885_RAW_BITS_YUV_CAPTURE      = 0x01,
9962306a36Sopenharmony_ci	CX23885_RAW_BITS_PCM_CAPTURE      = 0x02,
10062306a36Sopenharmony_ci	CX23885_RAW_BITS_VBI_CAPTURE      = 0x04,
10162306a36Sopenharmony_ci	CX23885_RAW_BITS_PASSTHRU_CAPTURE = 0x08,
10262306a36Sopenharmony_ci	CX23885_RAW_BITS_TO_HOST_CAPTURE  = 0x10
10362306a36Sopenharmony_ci};
10462306a36Sopenharmony_cienum cx23885_capture_end {
10562306a36Sopenharmony_ci	CX23885_END_AT_GOP, /* stop at the end of gop, generate irq */
10662306a36Sopenharmony_ci	CX23885_END_NOW, /* stop immediately, no irq */
10762306a36Sopenharmony_ci};
10862306a36Sopenharmony_cienum cx23885_framerate {
10962306a36Sopenharmony_ci	CX23885_FRAMERATE_NTSC_30, /* NTSC: 30fps */
11062306a36Sopenharmony_ci	CX23885_FRAMERATE_PAL_25   /* PAL: 25fps */
11162306a36Sopenharmony_ci};
11262306a36Sopenharmony_cienum cx23885_stream_port {
11362306a36Sopenharmony_ci	CX23885_OUTPUT_PORT_MEMORY,
11462306a36Sopenharmony_ci	CX23885_OUTPUT_PORT_STREAMING,
11562306a36Sopenharmony_ci	CX23885_OUTPUT_PORT_SERIAL
11662306a36Sopenharmony_ci};
11762306a36Sopenharmony_cienum cx23885_data_xfer_status {
11862306a36Sopenharmony_ci	CX23885_MORE_BUFFERS_FOLLOW,
11962306a36Sopenharmony_ci	CX23885_LAST_BUFFER,
12062306a36Sopenharmony_ci};
12162306a36Sopenharmony_cienum cx23885_picture_mask {
12262306a36Sopenharmony_ci	CX23885_PICTURE_MASK_NONE,
12362306a36Sopenharmony_ci	CX23885_PICTURE_MASK_I_FRAMES,
12462306a36Sopenharmony_ci	CX23885_PICTURE_MASK_I_P_FRAMES = 0x3,
12562306a36Sopenharmony_ci	CX23885_PICTURE_MASK_ALL_FRAMES = 0x7,
12662306a36Sopenharmony_ci};
12762306a36Sopenharmony_cienum cx23885_vbi_mode_bits {
12862306a36Sopenharmony_ci	CX23885_VBI_BITS_SLICED,
12962306a36Sopenharmony_ci	CX23885_VBI_BITS_RAW,
13062306a36Sopenharmony_ci};
13162306a36Sopenharmony_cienum cx23885_vbi_insertion_bits {
13262306a36Sopenharmony_ci	CX23885_VBI_BITS_INSERT_IN_XTENSION_USR_DATA,
13362306a36Sopenharmony_ci	CX23885_VBI_BITS_INSERT_IN_PRIVATE_PACKETS = 0x1 << 1,
13462306a36Sopenharmony_ci	CX23885_VBI_BITS_SEPARATE_STREAM = 0x2 << 1,
13562306a36Sopenharmony_ci	CX23885_VBI_BITS_SEPARATE_STREAM_USR_DATA = 0x4 << 1,
13662306a36Sopenharmony_ci	CX23885_VBI_BITS_SEPARATE_STREAM_PRV_DATA = 0x5 << 1,
13762306a36Sopenharmony_ci};
13862306a36Sopenharmony_cienum cx23885_dma_unit {
13962306a36Sopenharmony_ci	CX23885_DMA_BYTES,
14062306a36Sopenharmony_ci	CX23885_DMA_FRAMES,
14162306a36Sopenharmony_ci};
14262306a36Sopenharmony_cienum cx23885_dma_transfer_status_bits {
14362306a36Sopenharmony_ci	CX23885_DMA_TRANSFER_BITS_DONE = 0x01,
14462306a36Sopenharmony_ci	CX23885_DMA_TRANSFER_BITS_ERROR = 0x04,
14562306a36Sopenharmony_ci	CX23885_DMA_TRANSFER_BITS_LL_ERROR = 0x10,
14662306a36Sopenharmony_ci};
14762306a36Sopenharmony_cienum cx23885_pause {
14862306a36Sopenharmony_ci	CX23885_PAUSE_ENCODING,
14962306a36Sopenharmony_ci	CX23885_RESUME_ENCODING,
15062306a36Sopenharmony_ci};
15162306a36Sopenharmony_cienum cx23885_copyright {
15262306a36Sopenharmony_ci	CX23885_COPYRIGHT_OFF,
15362306a36Sopenharmony_ci	CX23885_COPYRIGHT_ON,
15462306a36Sopenharmony_ci};
15562306a36Sopenharmony_cienum cx23885_notification_type {
15662306a36Sopenharmony_ci	CX23885_NOTIFICATION_REFRESH,
15762306a36Sopenharmony_ci};
15862306a36Sopenharmony_cienum cx23885_notification_status {
15962306a36Sopenharmony_ci	CX23885_NOTIFICATION_OFF,
16062306a36Sopenharmony_ci	CX23885_NOTIFICATION_ON,
16162306a36Sopenharmony_ci};
16262306a36Sopenharmony_cienum cx23885_notification_mailbox {
16362306a36Sopenharmony_ci	CX23885_NOTIFICATION_NO_MAILBOX = -1,
16462306a36Sopenharmony_ci};
16562306a36Sopenharmony_cienum cx23885_field1_lines {
16662306a36Sopenharmony_ci	CX23885_FIELD1_SAA7114 = 0x00EF, /* 239 */
16762306a36Sopenharmony_ci	CX23885_FIELD1_SAA7115 = 0x00F0, /* 240 */
16862306a36Sopenharmony_ci	CX23885_FIELD1_MICRONAS = 0x0105, /* 261 */
16962306a36Sopenharmony_ci};
17062306a36Sopenharmony_cienum cx23885_field2_lines {
17162306a36Sopenharmony_ci	CX23885_FIELD2_SAA7114 = 0x00EF, /* 239 */
17262306a36Sopenharmony_ci	CX23885_FIELD2_SAA7115 = 0x00F0, /* 240 */
17362306a36Sopenharmony_ci	CX23885_FIELD2_MICRONAS = 0x0106, /* 262 */
17462306a36Sopenharmony_ci};
17562306a36Sopenharmony_cienum cx23885_custom_data_type {
17662306a36Sopenharmony_ci	CX23885_CUSTOM_EXTENSION_USR_DATA,
17762306a36Sopenharmony_ci	CX23885_CUSTOM_PRIVATE_PACKET,
17862306a36Sopenharmony_ci};
17962306a36Sopenharmony_cienum cx23885_mute {
18062306a36Sopenharmony_ci	CX23885_UNMUTE,
18162306a36Sopenharmony_ci	CX23885_MUTE,
18262306a36Sopenharmony_ci};
18362306a36Sopenharmony_cienum cx23885_mute_video_mask {
18462306a36Sopenharmony_ci	CX23885_MUTE_VIDEO_V_MASK = 0x0000FF00,
18562306a36Sopenharmony_ci	CX23885_MUTE_VIDEO_U_MASK = 0x00FF0000,
18662306a36Sopenharmony_ci	CX23885_MUTE_VIDEO_Y_MASK = 0xFF000000,
18762306a36Sopenharmony_ci};
18862306a36Sopenharmony_cienum cx23885_mute_video_shift {
18962306a36Sopenharmony_ci	CX23885_MUTE_VIDEO_V_SHIFT = 8,
19062306a36Sopenharmony_ci	CX23885_MUTE_VIDEO_U_SHIFT = 16,
19162306a36Sopenharmony_ci	CX23885_MUTE_VIDEO_Y_SHIFT = 24,
19262306a36Sopenharmony_ci};
19362306a36Sopenharmony_ci
19462306a36Sopenharmony_ci/* defines below are from ivtv-driver.h */
19562306a36Sopenharmony_ci#define IVTV_CMD_HW_BLOCKS_RST 0xFFFFFFFF
19662306a36Sopenharmony_ci
19762306a36Sopenharmony_ci/* Firmware API commands */
19862306a36Sopenharmony_ci#define IVTV_API_STD_TIMEOUT 500
19962306a36Sopenharmony_ci
20062306a36Sopenharmony_ci/* Registers */
20162306a36Sopenharmony_ci/* IVTV_REG_OFFSET */
20262306a36Sopenharmony_ci#define IVTV_REG_ENC_SDRAM_REFRESH (0x07F8)
20362306a36Sopenharmony_ci#define IVTV_REG_ENC_SDRAM_PRECHARGE (0x07FC)
20462306a36Sopenharmony_ci#define IVTV_REG_SPU (0x9050)
20562306a36Sopenharmony_ci#define IVTV_REG_HW_BLOCKS (0x9054)
20662306a36Sopenharmony_ci#define IVTV_REG_VPU (0x9058)
20762306a36Sopenharmony_ci#define IVTV_REG_APU (0xA064)
20862306a36Sopenharmony_ci
20962306a36Sopenharmony_ci/**** Bit definitions for MC417_RWD and MC417_OEN registers  ***
21062306a36Sopenharmony_ci  bits 31-16
21162306a36Sopenharmony_ci+-----------+
21262306a36Sopenharmony_ci| Reserved  |
21362306a36Sopenharmony_ci+-----------+
21462306a36Sopenharmony_ci  bit 15  bit 14  bit 13 bit 12  bit 11  bit 10  bit 9   bit 8
21562306a36Sopenharmony_ci+-------+-------+-------+-------+-------+-------+-------+-------+
21662306a36Sopenharmony_ci| MIWR# | MIRD# | MICS# |MIRDY# |MIADDR3|MIADDR2|MIADDR1|MIADDR0|
21762306a36Sopenharmony_ci+-------+-------+-------+-------+-------+-------+-------+-------+
21862306a36Sopenharmony_ci bit 7   bit 6   bit 5   bit 4   bit 3   bit 2   bit 1   bit 0
21962306a36Sopenharmony_ci+-------+-------+-------+-------+-------+-------+-------+-------+
22062306a36Sopenharmony_ci|MIDATA7|MIDATA6|MIDATA5|MIDATA4|MIDATA3|MIDATA2|MIDATA1|MIDATA0|
22162306a36Sopenharmony_ci+-------+-------+-------+-------+-------+-------+-------+-------+
22262306a36Sopenharmony_ci***/
22362306a36Sopenharmony_ci#define MC417_MIWR	0x8000
22462306a36Sopenharmony_ci#define MC417_MIRD	0x4000
22562306a36Sopenharmony_ci#define MC417_MICS	0x2000
22662306a36Sopenharmony_ci#define MC417_MIRDY	0x1000
22762306a36Sopenharmony_ci#define MC417_MIADDR	0x0F00
22862306a36Sopenharmony_ci#define MC417_MIDATA	0x00FF
22962306a36Sopenharmony_ci
23062306a36Sopenharmony_ci/* MIADDR* nibble definitions */
23162306a36Sopenharmony_ci#define  MCI_MEMORY_DATA_BYTE0          0x000
23262306a36Sopenharmony_ci#define  MCI_MEMORY_DATA_BYTE1          0x100
23362306a36Sopenharmony_ci#define  MCI_MEMORY_DATA_BYTE2          0x200
23462306a36Sopenharmony_ci#define  MCI_MEMORY_DATA_BYTE3          0x300
23562306a36Sopenharmony_ci#define  MCI_MEMORY_ADDRESS_BYTE2       0x400
23662306a36Sopenharmony_ci#define  MCI_MEMORY_ADDRESS_BYTE1       0x500
23762306a36Sopenharmony_ci#define  MCI_MEMORY_ADDRESS_BYTE0       0x600
23862306a36Sopenharmony_ci#define  MCI_REGISTER_DATA_BYTE0        0x800
23962306a36Sopenharmony_ci#define  MCI_REGISTER_DATA_BYTE1        0x900
24062306a36Sopenharmony_ci#define  MCI_REGISTER_DATA_BYTE2        0xA00
24162306a36Sopenharmony_ci#define  MCI_REGISTER_DATA_BYTE3        0xB00
24262306a36Sopenharmony_ci#define  MCI_REGISTER_ADDRESS_BYTE0     0xC00
24362306a36Sopenharmony_ci#define  MCI_REGISTER_ADDRESS_BYTE1     0xD00
24462306a36Sopenharmony_ci#define  MCI_REGISTER_MODE              0xE00
24562306a36Sopenharmony_ci
24662306a36Sopenharmony_ci/* Read and write modes */
24762306a36Sopenharmony_ci#define  MCI_MODE_REGISTER_READ         0
24862306a36Sopenharmony_ci#define  MCI_MODE_REGISTER_WRITE        1
24962306a36Sopenharmony_ci#define  MCI_MODE_MEMORY_READ           0
25062306a36Sopenharmony_ci#define  MCI_MODE_MEMORY_WRITE          0x40
25162306a36Sopenharmony_ci
25262306a36Sopenharmony_ci/*** Bit definitions for MC417_CTL register ****
25362306a36Sopenharmony_ci bits 31-6   bits 5-4   bit 3    bits 2-1       Bit 0
25462306a36Sopenharmony_ci+--------+-------------+--------+--------------+------------+
25562306a36Sopenharmony_ci|Reserved|MC417_SPD_CTL|Reserved|MC417_GPIO_SEL|UART_GPIO_EN|
25662306a36Sopenharmony_ci+--------+-------------+--------+--------------+------------+
25762306a36Sopenharmony_ci***/
25862306a36Sopenharmony_ci#define MC417_SPD_CTL(x)	(((x) << 4) & 0x00000030)
25962306a36Sopenharmony_ci#define MC417_GPIO_SEL(x)	(((x) << 1) & 0x00000006)
26062306a36Sopenharmony_ci#define MC417_UART_GPIO_EN	0x00000001
26162306a36Sopenharmony_ci
26262306a36Sopenharmony_ci/* Values for speed control */
26362306a36Sopenharmony_ci#define MC417_SPD_CTL_SLOW	0x1
26462306a36Sopenharmony_ci#define MC417_SPD_CTL_MEDIUM	0x0
26562306a36Sopenharmony_ci#define MC417_SPD_CTL_FAST	0x3     /* b'1x, but we use b'11 */
26662306a36Sopenharmony_ci
26762306a36Sopenharmony_ci/* Values for GPIO select */
26862306a36Sopenharmony_ci#define MC417_GPIO_SEL_GPIO3	0x3
26962306a36Sopenharmony_ci#define MC417_GPIO_SEL_GPIO2	0x2
27062306a36Sopenharmony_ci#define MC417_GPIO_SEL_GPIO1	0x1
27162306a36Sopenharmony_ci#define MC417_GPIO_SEL_GPIO0	0x0
27262306a36Sopenharmony_ci
27362306a36Sopenharmony_civoid cx23885_mc417_init(struct cx23885_dev *dev)
27462306a36Sopenharmony_ci{
27562306a36Sopenharmony_ci	u32 regval;
27662306a36Sopenharmony_ci
27762306a36Sopenharmony_ci	dprintk(2, "%s()\n", __func__);
27862306a36Sopenharmony_ci
27962306a36Sopenharmony_ci	/* Configure MC417_CTL register to defaults. */
28062306a36Sopenharmony_ci	regval = MC417_SPD_CTL(MC417_SPD_CTL_FAST)	|
28162306a36Sopenharmony_ci		 MC417_GPIO_SEL(MC417_GPIO_SEL_GPIO3)	|
28262306a36Sopenharmony_ci		 MC417_UART_GPIO_EN;
28362306a36Sopenharmony_ci	cx_write(MC417_CTL, regval);
28462306a36Sopenharmony_ci
28562306a36Sopenharmony_ci	/* Configure MC417_OEN to defaults. */
28662306a36Sopenharmony_ci	regval = MC417_MIRDY;
28762306a36Sopenharmony_ci	cx_write(MC417_OEN, regval);
28862306a36Sopenharmony_ci
28962306a36Sopenharmony_ci	/* Configure MC417_RWD to defaults. */
29062306a36Sopenharmony_ci	regval = MC417_MIWR | MC417_MIRD | MC417_MICS;
29162306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
29262306a36Sopenharmony_ci}
29362306a36Sopenharmony_ci
29462306a36Sopenharmony_cistatic int mc417_wait_ready(struct cx23885_dev *dev)
29562306a36Sopenharmony_ci{
29662306a36Sopenharmony_ci	u32 mi_ready;
29762306a36Sopenharmony_ci	unsigned long timeout = jiffies + msecs_to_jiffies(1);
29862306a36Sopenharmony_ci
29962306a36Sopenharmony_ci	for (;;) {
30062306a36Sopenharmony_ci		mi_ready = cx_read(MC417_RWD) & MC417_MIRDY;
30162306a36Sopenharmony_ci		if (mi_ready != 0)
30262306a36Sopenharmony_ci			return 0;
30362306a36Sopenharmony_ci		if (time_after(jiffies, timeout))
30462306a36Sopenharmony_ci			return -1;
30562306a36Sopenharmony_ci		udelay(1);
30662306a36Sopenharmony_ci	}
30762306a36Sopenharmony_ci}
30862306a36Sopenharmony_ci
30962306a36Sopenharmony_ciint mc417_register_write(struct cx23885_dev *dev, u16 address, u32 value)
31062306a36Sopenharmony_ci{
31162306a36Sopenharmony_ci	u32 regval;
31262306a36Sopenharmony_ci
31362306a36Sopenharmony_ci	/* Enable MC417 GPIO outputs except for MC417_MIRDY,
31462306a36Sopenharmony_ci	 * which is an input.
31562306a36Sopenharmony_ci	 */
31662306a36Sopenharmony_ci	cx_write(MC417_OEN, MC417_MIRDY);
31762306a36Sopenharmony_ci
31862306a36Sopenharmony_ci	/* Write data byte 0 */
31962306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE0 |
32062306a36Sopenharmony_ci		(value & 0x000000FF);
32162306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
32262306a36Sopenharmony_ci
32362306a36Sopenharmony_ci	/* Transition CS/WR to effect write transaction across bus. */
32462306a36Sopenharmony_ci	regval |= MC417_MICS | MC417_MIWR;
32562306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
32662306a36Sopenharmony_ci
32762306a36Sopenharmony_ci	/* Write data byte 1 */
32862306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE1 |
32962306a36Sopenharmony_ci		((value >> 8) & 0x000000FF);
33062306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
33162306a36Sopenharmony_ci	regval |= MC417_MICS | MC417_MIWR;
33262306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
33362306a36Sopenharmony_ci
33462306a36Sopenharmony_ci	/* Write data byte 2 */
33562306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE2 |
33662306a36Sopenharmony_ci		((value >> 16) & 0x000000FF);
33762306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
33862306a36Sopenharmony_ci	regval |= MC417_MICS | MC417_MIWR;
33962306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
34062306a36Sopenharmony_ci
34162306a36Sopenharmony_ci	/* Write data byte 3 */
34262306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE3 |
34362306a36Sopenharmony_ci		((value >> 24) & 0x000000FF);
34462306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
34562306a36Sopenharmony_ci	regval |= MC417_MICS | MC417_MIWR;
34662306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
34762306a36Sopenharmony_ci
34862306a36Sopenharmony_ci	/* Write address byte 0 */
34962306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_ADDRESS_BYTE0 |
35062306a36Sopenharmony_ci		(address & 0xFF);
35162306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
35262306a36Sopenharmony_ci	regval |= MC417_MICS | MC417_MIWR;
35362306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
35462306a36Sopenharmony_ci
35562306a36Sopenharmony_ci	/* Write address byte 1 */
35662306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_ADDRESS_BYTE1 |
35762306a36Sopenharmony_ci		((address >> 8) & 0xFF);
35862306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
35962306a36Sopenharmony_ci	regval |= MC417_MICS | MC417_MIWR;
36062306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
36162306a36Sopenharmony_ci
36262306a36Sopenharmony_ci	/* Indicate that this is a write. */
36362306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_MODE |
36462306a36Sopenharmony_ci		MCI_MODE_REGISTER_WRITE;
36562306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
36662306a36Sopenharmony_ci	regval |= MC417_MICS | MC417_MIWR;
36762306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
36862306a36Sopenharmony_ci
36962306a36Sopenharmony_ci	/* Wait for the trans to complete (MC417_MIRDY asserted). */
37062306a36Sopenharmony_ci	return mc417_wait_ready(dev);
37162306a36Sopenharmony_ci}
37262306a36Sopenharmony_ci
37362306a36Sopenharmony_ciint mc417_register_read(struct cx23885_dev *dev, u16 address, u32 *value)
37462306a36Sopenharmony_ci{
37562306a36Sopenharmony_ci	int retval;
37662306a36Sopenharmony_ci	u32 regval;
37762306a36Sopenharmony_ci	u32 tempval;
37862306a36Sopenharmony_ci	u32 dataval;
37962306a36Sopenharmony_ci
38062306a36Sopenharmony_ci	/* Enable MC417 GPIO outputs except for MC417_MIRDY,
38162306a36Sopenharmony_ci	 * which is an input.
38262306a36Sopenharmony_ci	 */
38362306a36Sopenharmony_ci	cx_write(MC417_OEN, MC417_MIRDY);
38462306a36Sopenharmony_ci
38562306a36Sopenharmony_ci	/* Write address byte 0 */
38662306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_ADDRESS_BYTE0 |
38762306a36Sopenharmony_ci		((address & 0x00FF));
38862306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
38962306a36Sopenharmony_ci	regval |= MC417_MICS | MC417_MIWR;
39062306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
39162306a36Sopenharmony_ci
39262306a36Sopenharmony_ci	/* Write address byte 1 */
39362306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_ADDRESS_BYTE1 |
39462306a36Sopenharmony_ci		((address >> 8) & 0xFF);
39562306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
39662306a36Sopenharmony_ci	regval |= MC417_MICS | MC417_MIWR;
39762306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
39862306a36Sopenharmony_ci
39962306a36Sopenharmony_ci	/* Indicate that this is a register read. */
40062306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_MODE |
40162306a36Sopenharmony_ci		MCI_MODE_REGISTER_READ;
40262306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
40362306a36Sopenharmony_ci	regval |= MC417_MICS | MC417_MIWR;
40462306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
40562306a36Sopenharmony_ci
40662306a36Sopenharmony_ci	/* Wait for the trans to complete (MC417_MIRDY asserted). */
40762306a36Sopenharmony_ci	retval = mc417_wait_ready(dev);
40862306a36Sopenharmony_ci
40962306a36Sopenharmony_ci	/* switch the DAT0-7 GPIO[10:3] to input mode */
41062306a36Sopenharmony_ci	cx_write(MC417_OEN, MC417_MIRDY | MC417_MIDATA);
41162306a36Sopenharmony_ci
41262306a36Sopenharmony_ci	/* Read data byte 0 */
41362306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE0;
41462306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
41562306a36Sopenharmony_ci
41662306a36Sopenharmony_ci	/* Transition RD to effect read transaction across bus.
41762306a36Sopenharmony_ci	 * Transition 0x5000 -> 0x9000 correct (RD/RDY -> WR/RDY)?
41862306a36Sopenharmony_ci	 * Should it be 0x9000 -> 0xF000 (also why is RDY being set, its
41962306a36Sopenharmony_ci	 * input only...)
42062306a36Sopenharmony_ci	 */
42162306a36Sopenharmony_ci	regval = MC417_MIWR | MC417_MIRDY | MCI_REGISTER_DATA_BYTE0;
42262306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
42362306a36Sopenharmony_ci
42462306a36Sopenharmony_ci	/* Collect byte */
42562306a36Sopenharmony_ci	tempval = cx_read(MC417_RWD);
42662306a36Sopenharmony_ci	dataval = tempval & 0x000000FF;
42762306a36Sopenharmony_ci
42862306a36Sopenharmony_ci	/* Bring CS and RD high. */
42962306a36Sopenharmony_ci	regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY;
43062306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
43162306a36Sopenharmony_ci
43262306a36Sopenharmony_ci	/* Read data byte 1 */
43362306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE1;
43462306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
43562306a36Sopenharmony_ci	regval = MC417_MIWR | MC417_MIRDY | MCI_REGISTER_DATA_BYTE1;
43662306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
43762306a36Sopenharmony_ci	tempval = cx_read(MC417_RWD);
43862306a36Sopenharmony_ci	dataval |= ((tempval & 0x000000FF) << 8);
43962306a36Sopenharmony_ci	regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY;
44062306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
44162306a36Sopenharmony_ci
44262306a36Sopenharmony_ci	/* Read data byte 2 */
44362306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE2;
44462306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
44562306a36Sopenharmony_ci	regval = MC417_MIWR | MC417_MIRDY | MCI_REGISTER_DATA_BYTE2;
44662306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
44762306a36Sopenharmony_ci	tempval = cx_read(MC417_RWD);
44862306a36Sopenharmony_ci	dataval |= ((tempval & 0x000000FF) << 16);
44962306a36Sopenharmony_ci	regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY;
45062306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
45162306a36Sopenharmony_ci
45262306a36Sopenharmony_ci	/* Read data byte 3 */
45362306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE3;
45462306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
45562306a36Sopenharmony_ci	regval = MC417_MIWR | MC417_MIRDY | MCI_REGISTER_DATA_BYTE3;
45662306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
45762306a36Sopenharmony_ci	tempval = cx_read(MC417_RWD);
45862306a36Sopenharmony_ci	dataval |= ((tempval & 0x000000FF) << 24);
45962306a36Sopenharmony_ci	regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY;
46062306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
46162306a36Sopenharmony_ci
46262306a36Sopenharmony_ci	*value  = dataval;
46362306a36Sopenharmony_ci
46462306a36Sopenharmony_ci	return retval;
46562306a36Sopenharmony_ci}
46662306a36Sopenharmony_ci
46762306a36Sopenharmony_ciint mc417_memory_write(struct cx23885_dev *dev, u32 address, u32 value)
46862306a36Sopenharmony_ci{
46962306a36Sopenharmony_ci	u32 regval;
47062306a36Sopenharmony_ci
47162306a36Sopenharmony_ci	/* Enable MC417 GPIO outputs except for MC417_MIRDY,
47262306a36Sopenharmony_ci	 * which is an input.
47362306a36Sopenharmony_ci	 */
47462306a36Sopenharmony_ci	cx_write(MC417_OEN, MC417_MIRDY);
47562306a36Sopenharmony_ci
47662306a36Sopenharmony_ci	/* Write data byte 0 */
47762306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE0 |
47862306a36Sopenharmony_ci		(value & 0x000000FF);
47962306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
48062306a36Sopenharmony_ci
48162306a36Sopenharmony_ci	/* Transition CS/WR to effect write transaction across bus. */
48262306a36Sopenharmony_ci	regval |= MC417_MICS | MC417_MIWR;
48362306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
48462306a36Sopenharmony_ci
48562306a36Sopenharmony_ci	/* Write data byte 1 */
48662306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE1 |
48762306a36Sopenharmony_ci		((value >> 8) & 0x000000FF);
48862306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
48962306a36Sopenharmony_ci	regval |= MC417_MICS | MC417_MIWR;
49062306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
49162306a36Sopenharmony_ci
49262306a36Sopenharmony_ci	/* Write data byte 2 */
49362306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE2 |
49462306a36Sopenharmony_ci		((value >> 16) & 0x000000FF);
49562306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
49662306a36Sopenharmony_ci	regval |= MC417_MICS | MC417_MIWR;
49762306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
49862306a36Sopenharmony_ci
49962306a36Sopenharmony_ci	/* Write data byte 3 */
50062306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE3 |
50162306a36Sopenharmony_ci		((value >> 24) & 0x000000FF);
50262306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
50362306a36Sopenharmony_ci	regval |= MC417_MICS | MC417_MIWR;
50462306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
50562306a36Sopenharmony_ci
50662306a36Sopenharmony_ci	/* Write address byte 2 */
50762306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_ADDRESS_BYTE2 |
50862306a36Sopenharmony_ci		MCI_MODE_MEMORY_WRITE | ((address >> 16) & 0x3F);
50962306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
51062306a36Sopenharmony_ci	regval |= MC417_MICS | MC417_MIWR;
51162306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
51262306a36Sopenharmony_ci
51362306a36Sopenharmony_ci	/* Write address byte 1 */
51462306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_ADDRESS_BYTE1 |
51562306a36Sopenharmony_ci		((address >> 8) & 0xFF);
51662306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
51762306a36Sopenharmony_ci	regval |= MC417_MICS | MC417_MIWR;
51862306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
51962306a36Sopenharmony_ci
52062306a36Sopenharmony_ci	/* Write address byte 0 */
52162306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_ADDRESS_BYTE0 |
52262306a36Sopenharmony_ci		(address & 0xFF);
52362306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
52462306a36Sopenharmony_ci	regval |= MC417_MICS | MC417_MIWR;
52562306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
52662306a36Sopenharmony_ci
52762306a36Sopenharmony_ci	/* Wait for the trans to complete (MC417_MIRDY asserted). */
52862306a36Sopenharmony_ci	return mc417_wait_ready(dev);
52962306a36Sopenharmony_ci}
53062306a36Sopenharmony_ci
53162306a36Sopenharmony_ciint mc417_memory_read(struct cx23885_dev *dev, u32 address, u32 *value)
53262306a36Sopenharmony_ci{
53362306a36Sopenharmony_ci	int retval;
53462306a36Sopenharmony_ci	u32 regval;
53562306a36Sopenharmony_ci	u32 tempval;
53662306a36Sopenharmony_ci	u32 dataval;
53762306a36Sopenharmony_ci
53862306a36Sopenharmony_ci	/* Enable MC417 GPIO outputs except for MC417_MIRDY,
53962306a36Sopenharmony_ci	 * which is an input.
54062306a36Sopenharmony_ci	 */
54162306a36Sopenharmony_ci	cx_write(MC417_OEN, MC417_MIRDY);
54262306a36Sopenharmony_ci
54362306a36Sopenharmony_ci	/* Write address byte 2 */
54462306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_ADDRESS_BYTE2 |
54562306a36Sopenharmony_ci		MCI_MODE_MEMORY_READ | ((address >> 16) & 0x3F);
54662306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
54762306a36Sopenharmony_ci	regval |= MC417_MICS | MC417_MIWR;
54862306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
54962306a36Sopenharmony_ci
55062306a36Sopenharmony_ci	/* Write address byte 1 */
55162306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_ADDRESS_BYTE1 |
55262306a36Sopenharmony_ci		((address >> 8) & 0xFF);
55362306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
55462306a36Sopenharmony_ci	regval |= MC417_MICS | MC417_MIWR;
55562306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
55662306a36Sopenharmony_ci
55762306a36Sopenharmony_ci	/* Write address byte 0 */
55862306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_ADDRESS_BYTE0 |
55962306a36Sopenharmony_ci		(address & 0xFF);
56062306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
56162306a36Sopenharmony_ci	regval |= MC417_MICS | MC417_MIWR;
56262306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
56362306a36Sopenharmony_ci
56462306a36Sopenharmony_ci	/* Wait for the trans to complete (MC417_MIRDY asserted). */
56562306a36Sopenharmony_ci	retval = mc417_wait_ready(dev);
56662306a36Sopenharmony_ci
56762306a36Sopenharmony_ci	/* switch the DAT0-7 GPIO[10:3] to input mode */
56862306a36Sopenharmony_ci	cx_write(MC417_OEN, MC417_MIRDY | MC417_MIDATA);
56962306a36Sopenharmony_ci
57062306a36Sopenharmony_ci	/* Read data byte 3 */
57162306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE3;
57262306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
57362306a36Sopenharmony_ci
57462306a36Sopenharmony_ci	/* Transition RD to effect read transaction across bus. */
57562306a36Sopenharmony_ci	regval = MC417_MIWR | MC417_MIRDY | MCI_MEMORY_DATA_BYTE3;
57662306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
57762306a36Sopenharmony_ci
57862306a36Sopenharmony_ci	/* Collect byte */
57962306a36Sopenharmony_ci	tempval = cx_read(MC417_RWD);
58062306a36Sopenharmony_ci	dataval = ((tempval & 0x000000FF) << 24);
58162306a36Sopenharmony_ci
58262306a36Sopenharmony_ci	/* Bring CS and RD high. */
58362306a36Sopenharmony_ci	regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY;
58462306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
58562306a36Sopenharmony_ci
58662306a36Sopenharmony_ci	/* Read data byte 2 */
58762306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE2;
58862306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
58962306a36Sopenharmony_ci	regval = MC417_MIWR | MC417_MIRDY | MCI_MEMORY_DATA_BYTE2;
59062306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
59162306a36Sopenharmony_ci	tempval = cx_read(MC417_RWD);
59262306a36Sopenharmony_ci	dataval |= ((tempval & 0x000000FF) << 16);
59362306a36Sopenharmony_ci	regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY;
59462306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
59562306a36Sopenharmony_ci
59662306a36Sopenharmony_ci	/* Read data byte 1 */
59762306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE1;
59862306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
59962306a36Sopenharmony_ci	regval = MC417_MIWR | MC417_MIRDY | MCI_MEMORY_DATA_BYTE1;
60062306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
60162306a36Sopenharmony_ci	tempval = cx_read(MC417_RWD);
60262306a36Sopenharmony_ci	dataval |= ((tempval & 0x000000FF) << 8);
60362306a36Sopenharmony_ci	regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY;
60462306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
60562306a36Sopenharmony_ci
60662306a36Sopenharmony_ci	/* Read data byte 0 */
60762306a36Sopenharmony_ci	regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE0;
60862306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
60962306a36Sopenharmony_ci	regval = MC417_MIWR | MC417_MIRDY | MCI_MEMORY_DATA_BYTE0;
61062306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
61162306a36Sopenharmony_ci	tempval = cx_read(MC417_RWD);
61262306a36Sopenharmony_ci	dataval |= (tempval & 0x000000FF);
61362306a36Sopenharmony_ci	regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY;
61462306a36Sopenharmony_ci	cx_write(MC417_RWD, regval);
61562306a36Sopenharmony_ci
61662306a36Sopenharmony_ci	*value  = dataval;
61762306a36Sopenharmony_ci
61862306a36Sopenharmony_ci	return retval;
61962306a36Sopenharmony_ci}
62062306a36Sopenharmony_ci
62162306a36Sopenharmony_civoid mc417_gpio_set(struct cx23885_dev *dev, u32 mask)
62262306a36Sopenharmony_ci{
62362306a36Sopenharmony_ci	u32 val;
62462306a36Sopenharmony_ci
62562306a36Sopenharmony_ci	/* Set the gpio value */
62662306a36Sopenharmony_ci	mc417_register_read(dev, 0x900C, &val);
62762306a36Sopenharmony_ci	val |= (mask & 0x000ffff);
62862306a36Sopenharmony_ci	mc417_register_write(dev, 0x900C, val);
62962306a36Sopenharmony_ci}
63062306a36Sopenharmony_ci
63162306a36Sopenharmony_civoid mc417_gpio_clear(struct cx23885_dev *dev, u32 mask)
63262306a36Sopenharmony_ci{
63362306a36Sopenharmony_ci	u32 val;
63462306a36Sopenharmony_ci
63562306a36Sopenharmony_ci	/* Clear the gpio value */
63662306a36Sopenharmony_ci	mc417_register_read(dev, 0x900C, &val);
63762306a36Sopenharmony_ci	val &= ~(mask & 0x0000ffff);
63862306a36Sopenharmony_ci	mc417_register_write(dev, 0x900C, val);
63962306a36Sopenharmony_ci}
64062306a36Sopenharmony_ci
64162306a36Sopenharmony_civoid mc417_gpio_enable(struct cx23885_dev *dev, u32 mask, int asoutput)
64262306a36Sopenharmony_ci{
64362306a36Sopenharmony_ci	u32 val;
64462306a36Sopenharmony_ci
64562306a36Sopenharmony_ci	/* Enable GPIO direction bits */
64662306a36Sopenharmony_ci	mc417_register_read(dev, 0x9020, &val);
64762306a36Sopenharmony_ci	if (asoutput)
64862306a36Sopenharmony_ci		val |= (mask & 0x0000ffff);
64962306a36Sopenharmony_ci	else
65062306a36Sopenharmony_ci		val &= ~(mask & 0x0000ffff);
65162306a36Sopenharmony_ci
65262306a36Sopenharmony_ci	mc417_register_write(dev, 0x9020, val);
65362306a36Sopenharmony_ci}
65462306a36Sopenharmony_ci/* ------------------------------------------------------------------ */
65562306a36Sopenharmony_ci
65662306a36Sopenharmony_ci/* MPEG encoder API */
65762306a36Sopenharmony_cistatic char *cmd_to_str(int cmd)
65862306a36Sopenharmony_ci{
65962306a36Sopenharmony_ci	switch (cmd) {
66062306a36Sopenharmony_ci	case CX2341X_ENC_PING_FW:
66162306a36Sopenharmony_ci		return  "PING_FW";
66262306a36Sopenharmony_ci	case CX2341X_ENC_START_CAPTURE:
66362306a36Sopenharmony_ci		return  "START_CAPTURE";
66462306a36Sopenharmony_ci	case CX2341X_ENC_STOP_CAPTURE:
66562306a36Sopenharmony_ci		return  "STOP_CAPTURE";
66662306a36Sopenharmony_ci	case CX2341X_ENC_SET_AUDIO_ID:
66762306a36Sopenharmony_ci		return  "SET_AUDIO_ID";
66862306a36Sopenharmony_ci	case CX2341X_ENC_SET_VIDEO_ID:
66962306a36Sopenharmony_ci		return  "SET_VIDEO_ID";
67062306a36Sopenharmony_ci	case CX2341X_ENC_SET_PCR_ID:
67162306a36Sopenharmony_ci		return  "SET_PCR_ID";
67262306a36Sopenharmony_ci	case CX2341X_ENC_SET_FRAME_RATE:
67362306a36Sopenharmony_ci		return  "SET_FRAME_RATE";
67462306a36Sopenharmony_ci	case CX2341X_ENC_SET_FRAME_SIZE:
67562306a36Sopenharmony_ci		return  "SET_FRAME_SIZE";
67662306a36Sopenharmony_ci	case CX2341X_ENC_SET_BIT_RATE:
67762306a36Sopenharmony_ci		return  "SET_BIT_RATE";
67862306a36Sopenharmony_ci	case CX2341X_ENC_SET_GOP_PROPERTIES:
67962306a36Sopenharmony_ci		return  "SET_GOP_PROPERTIES";
68062306a36Sopenharmony_ci	case CX2341X_ENC_SET_ASPECT_RATIO:
68162306a36Sopenharmony_ci		return  "SET_ASPECT_RATIO";
68262306a36Sopenharmony_ci	case CX2341X_ENC_SET_DNR_FILTER_MODE:
68362306a36Sopenharmony_ci		return  "SET_DNR_FILTER_MODE";
68462306a36Sopenharmony_ci	case CX2341X_ENC_SET_DNR_FILTER_PROPS:
68562306a36Sopenharmony_ci		return  "SET_DNR_FILTER_PROPS";
68662306a36Sopenharmony_ci	case CX2341X_ENC_SET_CORING_LEVELS:
68762306a36Sopenharmony_ci		return  "SET_CORING_LEVELS";
68862306a36Sopenharmony_ci	case CX2341X_ENC_SET_SPATIAL_FILTER_TYPE:
68962306a36Sopenharmony_ci		return  "SET_SPATIAL_FILTER_TYPE";
69062306a36Sopenharmony_ci	case CX2341X_ENC_SET_VBI_LINE:
69162306a36Sopenharmony_ci		return  "SET_VBI_LINE";
69262306a36Sopenharmony_ci	case CX2341X_ENC_SET_STREAM_TYPE:
69362306a36Sopenharmony_ci		return  "SET_STREAM_TYPE";
69462306a36Sopenharmony_ci	case CX2341X_ENC_SET_OUTPUT_PORT:
69562306a36Sopenharmony_ci		return  "SET_OUTPUT_PORT";
69662306a36Sopenharmony_ci	case CX2341X_ENC_SET_AUDIO_PROPERTIES:
69762306a36Sopenharmony_ci		return  "SET_AUDIO_PROPERTIES";
69862306a36Sopenharmony_ci	case CX2341X_ENC_HALT_FW:
69962306a36Sopenharmony_ci		return  "HALT_FW";
70062306a36Sopenharmony_ci	case CX2341X_ENC_GET_VERSION:
70162306a36Sopenharmony_ci		return  "GET_VERSION";
70262306a36Sopenharmony_ci	case CX2341X_ENC_SET_GOP_CLOSURE:
70362306a36Sopenharmony_ci		return  "SET_GOP_CLOSURE";
70462306a36Sopenharmony_ci	case CX2341X_ENC_GET_SEQ_END:
70562306a36Sopenharmony_ci		return  "GET_SEQ_END";
70662306a36Sopenharmony_ci	case CX2341X_ENC_SET_PGM_INDEX_INFO:
70762306a36Sopenharmony_ci		return  "SET_PGM_INDEX_INFO";
70862306a36Sopenharmony_ci	case CX2341X_ENC_SET_VBI_CONFIG:
70962306a36Sopenharmony_ci		return  "SET_VBI_CONFIG";
71062306a36Sopenharmony_ci	case CX2341X_ENC_SET_DMA_BLOCK_SIZE:
71162306a36Sopenharmony_ci		return  "SET_DMA_BLOCK_SIZE";
71262306a36Sopenharmony_ci	case CX2341X_ENC_GET_PREV_DMA_INFO_MB_10:
71362306a36Sopenharmony_ci		return  "GET_PREV_DMA_INFO_MB_10";
71462306a36Sopenharmony_ci	case CX2341X_ENC_GET_PREV_DMA_INFO_MB_9:
71562306a36Sopenharmony_ci		return  "GET_PREV_DMA_INFO_MB_9";
71662306a36Sopenharmony_ci	case CX2341X_ENC_SCHED_DMA_TO_HOST:
71762306a36Sopenharmony_ci		return  "SCHED_DMA_TO_HOST";
71862306a36Sopenharmony_ci	case CX2341X_ENC_INITIALIZE_INPUT:
71962306a36Sopenharmony_ci		return  "INITIALIZE_INPUT";
72062306a36Sopenharmony_ci	case CX2341X_ENC_SET_FRAME_DROP_RATE:
72162306a36Sopenharmony_ci		return  "SET_FRAME_DROP_RATE";
72262306a36Sopenharmony_ci	case CX2341X_ENC_PAUSE_ENCODER:
72362306a36Sopenharmony_ci		return  "PAUSE_ENCODER";
72462306a36Sopenharmony_ci	case CX2341X_ENC_REFRESH_INPUT:
72562306a36Sopenharmony_ci		return  "REFRESH_INPUT";
72662306a36Sopenharmony_ci	case CX2341X_ENC_SET_COPYRIGHT:
72762306a36Sopenharmony_ci		return  "SET_COPYRIGHT";
72862306a36Sopenharmony_ci	case CX2341X_ENC_SET_EVENT_NOTIFICATION:
72962306a36Sopenharmony_ci		return  "SET_EVENT_NOTIFICATION";
73062306a36Sopenharmony_ci	case CX2341X_ENC_SET_NUM_VSYNC_LINES:
73162306a36Sopenharmony_ci		return  "SET_NUM_VSYNC_LINES";
73262306a36Sopenharmony_ci	case CX2341X_ENC_SET_PLACEHOLDER:
73362306a36Sopenharmony_ci		return  "SET_PLACEHOLDER";
73462306a36Sopenharmony_ci	case CX2341X_ENC_MUTE_VIDEO:
73562306a36Sopenharmony_ci		return  "MUTE_VIDEO";
73662306a36Sopenharmony_ci	case CX2341X_ENC_MUTE_AUDIO:
73762306a36Sopenharmony_ci		return  "MUTE_AUDIO";
73862306a36Sopenharmony_ci	case CX2341X_ENC_MISC:
73962306a36Sopenharmony_ci		return  "MISC";
74062306a36Sopenharmony_ci	default:
74162306a36Sopenharmony_ci		return "UNKNOWN";
74262306a36Sopenharmony_ci	}
74362306a36Sopenharmony_ci}
74462306a36Sopenharmony_ci
74562306a36Sopenharmony_cistatic int cx23885_mbox_func(void *priv,
74662306a36Sopenharmony_ci			     u32 command,
74762306a36Sopenharmony_ci			     int in,
74862306a36Sopenharmony_ci			     int out,
74962306a36Sopenharmony_ci			     u32 data[CX2341X_MBOX_MAX_DATA])
75062306a36Sopenharmony_ci{
75162306a36Sopenharmony_ci	struct cx23885_dev *dev = priv;
75262306a36Sopenharmony_ci	unsigned long timeout;
75362306a36Sopenharmony_ci	u32 value, flag, retval = 0;
75462306a36Sopenharmony_ci	int i;
75562306a36Sopenharmony_ci
75662306a36Sopenharmony_ci	dprintk(3, "%s: command(0x%X) = %s\n", __func__, command,
75762306a36Sopenharmony_ci		cmd_to_str(command));
75862306a36Sopenharmony_ci
75962306a36Sopenharmony_ci	/* this may not be 100% safe if we can't read any memory location
76062306a36Sopenharmony_ci	   without side effects */
76162306a36Sopenharmony_ci	mc417_memory_read(dev, dev->cx23417_mailbox - 4, &value);
76262306a36Sopenharmony_ci	if (value != 0x12345678) {
76362306a36Sopenharmony_ci		pr_err("Firmware and/or mailbox pointer not initialized or corrupted, signature = 0x%x, cmd = %s\n",
76462306a36Sopenharmony_ci			value, cmd_to_str(command));
76562306a36Sopenharmony_ci		return -1;
76662306a36Sopenharmony_ci	}
76762306a36Sopenharmony_ci
76862306a36Sopenharmony_ci	/* This read looks at 32 bits, but flag is only 8 bits.
76962306a36Sopenharmony_ci	 * Seems we also bail if CMD or TIMEOUT bytes are set???
77062306a36Sopenharmony_ci	 */
77162306a36Sopenharmony_ci	mc417_memory_read(dev, dev->cx23417_mailbox, &flag);
77262306a36Sopenharmony_ci	if (flag) {
77362306a36Sopenharmony_ci		pr_err("ERROR: Mailbox appears to be in use (%x), cmd = %s\n",
77462306a36Sopenharmony_ci		       flag, cmd_to_str(command));
77562306a36Sopenharmony_ci		return -1;
77662306a36Sopenharmony_ci	}
77762306a36Sopenharmony_ci
77862306a36Sopenharmony_ci	flag |= 1; /* tell 'em we're working on it */
77962306a36Sopenharmony_ci	mc417_memory_write(dev, dev->cx23417_mailbox, flag);
78062306a36Sopenharmony_ci
78162306a36Sopenharmony_ci	/* write command + args + fill remaining with zeros */
78262306a36Sopenharmony_ci	/* command code */
78362306a36Sopenharmony_ci	mc417_memory_write(dev, dev->cx23417_mailbox + 1, command);
78462306a36Sopenharmony_ci	mc417_memory_write(dev, dev->cx23417_mailbox + 3,
78562306a36Sopenharmony_ci		IVTV_API_STD_TIMEOUT); /* timeout */
78662306a36Sopenharmony_ci	for (i = 0; i < in; i++) {
78762306a36Sopenharmony_ci		mc417_memory_write(dev, dev->cx23417_mailbox + 4 + i, data[i]);
78862306a36Sopenharmony_ci		dprintk(3, "API Input %d = %d\n", i, data[i]);
78962306a36Sopenharmony_ci	}
79062306a36Sopenharmony_ci	for (; i < CX2341X_MBOX_MAX_DATA; i++)
79162306a36Sopenharmony_ci		mc417_memory_write(dev, dev->cx23417_mailbox + 4 + i, 0);
79262306a36Sopenharmony_ci
79362306a36Sopenharmony_ci	flag |= 3; /* tell 'em we're done writing */
79462306a36Sopenharmony_ci	mc417_memory_write(dev, dev->cx23417_mailbox, flag);
79562306a36Sopenharmony_ci
79662306a36Sopenharmony_ci	/* wait for firmware to handle the API command */
79762306a36Sopenharmony_ci	timeout = jiffies + msecs_to_jiffies(10);
79862306a36Sopenharmony_ci	for (;;) {
79962306a36Sopenharmony_ci		mc417_memory_read(dev, dev->cx23417_mailbox, &flag);
80062306a36Sopenharmony_ci		if (0 != (flag & 4))
80162306a36Sopenharmony_ci			break;
80262306a36Sopenharmony_ci		if (time_after(jiffies, timeout)) {
80362306a36Sopenharmony_ci			pr_err("ERROR: API Mailbox timeout\n");
80462306a36Sopenharmony_ci			return -1;
80562306a36Sopenharmony_ci		}
80662306a36Sopenharmony_ci		udelay(10);
80762306a36Sopenharmony_ci	}
80862306a36Sopenharmony_ci
80962306a36Sopenharmony_ci	/* read output values */
81062306a36Sopenharmony_ci	for (i = 0; i < out; i++) {
81162306a36Sopenharmony_ci		mc417_memory_read(dev, dev->cx23417_mailbox + 4 + i, data + i);
81262306a36Sopenharmony_ci		dprintk(3, "API Output %d = %d\n", i, data[i]);
81362306a36Sopenharmony_ci	}
81462306a36Sopenharmony_ci
81562306a36Sopenharmony_ci	mc417_memory_read(dev, dev->cx23417_mailbox + 2, &retval);
81662306a36Sopenharmony_ci	dprintk(3, "API result = %d\n", retval);
81762306a36Sopenharmony_ci
81862306a36Sopenharmony_ci	flag = 0;
81962306a36Sopenharmony_ci	mc417_memory_write(dev, dev->cx23417_mailbox, flag);
82062306a36Sopenharmony_ci
82162306a36Sopenharmony_ci	return retval;
82262306a36Sopenharmony_ci}
82362306a36Sopenharmony_ci
82462306a36Sopenharmony_ci/* We don't need to call the API often, so using just one
82562306a36Sopenharmony_ci * mailbox will probably suffice
82662306a36Sopenharmony_ci */
82762306a36Sopenharmony_cistatic int cx23885_api_cmd(struct cx23885_dev *dev,
82862306a36Sopenharmony_ci			   u32 command,
82962306a36Sopenharmony_ci			   u32 inputcnt,
83062306a36Sopenharmony_ci			   u32 outputcnt,
83162306a36Sopenharmony_ci			   ...)
83262306a36Sopenharmony_ci{
83362306a36Sopenharmony_ci	u32 data[CX2341X_MBOX_MAX_DATA];
83462306a36Sopenharmony_ci	va_list vargs;
83562306a36Sopenharmony_ci	int i, err;
83662306a36Sopenharmony_ci
83762306a36Sopenharmony_ci	dprintk(3, "%s() cmds = 0x%08x\n", __func__, command);
83862306a36Sopenharmony_ci
83962306a36Sopenharmony_ci	va_start(vargs, outputcnt);
84062306a36Sopenharmony_ci	for (i = 0; i < inputcnt; i++)
84162306a36Sopenharmony_ci		data[i] = va_arg(vargs, int);
84262306a36Sopenharmony_ci
84362306a36Sopenharmony_ci	err = cx23885_mbox_func(dev, command, inputcnt, outputcnt, data);
84462306a36Sopenharmony_ci	for (i = 0; i < outputcnt; i++) {
84562306a36Sopenharmony_ci		int *vptr = va_arg(vargs, int *);
84662306a36Sopenharmony_ci		*vptr = data[i];
84762306a36Sopenharmony_ci	}
84862306a36Sopenharmony_ci	va_end(vargs);
84962306a36Sopenharmony_ci
85062306a36Sopenharmony_ci	return err;
85162306a36Sopenharmony_ci}
85262306a36Sopenharmony_ci
85362306a36Sopenharmony_cistatic int cx23885_api_func(void *priv, u32 cmd, int in, int out, u32 data[CX2341X_MBOX_MAX_DATA])
85462306a36Sopenharmony_ci{
85562306a36Sopenharmony_ci	return cx23885_mbox_func(priv, cmd, in, out, data);
85662306a36Sopenharmony_ci}
85762306a36Sopenharmony_ci
85862306a36Sopenharmony_cistatic int cx23885_find_mailbox(struct cx23885_dev *dev)
85962306a36Sopenharmony_ci{
86062306a36Sopenharmony_ci	u32 signature[4] = {
86162306a36Sopenharmony_ci		0x12345678, 0x34567812, 0x56781234, 0x78123456
86262306a36Sopenharmony_ci	};
86362306a36Sopenharmony_ci	int signaturecnt = 0;
86462306a36Sopenharmony_ci	u32 value;
86562306a36Sopenharmony_ci	int i;
86662306a36Sopenharmony_ci
86762306a36Sopenharmony_ci	dprintk(2, "%s()\n", __func__);
86862306a36Sopenharmony_ci
86962306a36Sopenharmony_ci	for (i = 0; i < CX23885_FIRM_IMAGE_SIZE; i++) {
87062306a36Sopenharmony_ci		mc417_memory_read(dev, i, &value);
87162306a36Sopenharmony_ci		if (value == signature[signaturecnt])
87262306a36Sopenharmony_ci			signaturecnt++;
87362306a36Sopenharmony_ci		else
87462306a36Sopenharmony_ci			signaturecnt = 0;
87562306a36Sopenharmony_ci		if (4 == signaturecnt) {
87662306a36Sopenharmony_ci			dprintk(1, "Mailbox signature found at 0x%x\n", i+1);
87762306a36Sopenharmony_ci			return i+1;
87862306a36Sopenharmony_ci		}
87962306a36Sopenharmony_ci	}
88062306a36Sopenharmony_ci	pr_err("Mailbox signature values not found!\n");
88162306a36Sopenharmony_ci	return -1;
88262306a36Sopenharmony_ci}
88362306a36Sopenharmony_ci
88462306a36Sopenharmony_cistatic int cx23885_load_firmware(struct cx23885_dev *dev)
88562306a36Sopenharmony_ci{
88662306a36Sopenharmony_ci	static const unsigned char magic[8] = {
88762306a36Sopenharmony_ci		0xa7, 0x0d, 0x00, 0x00, 0x66, 0xbb, 0x55, 0xaa
88862306a36Sopenharmony_ci	};
88962306a36Sopenharmony_ci	const struct firmware *firmware;
89062306a36Sopenharmony_ci	int i, retval = 0;
89162306a36Sopenharmony_ci	u32 value = 0;
89262306a36Sopenharmony_ci	u32 gpio_output = 0;
89362306a36Sopenharmony_ci	u32 gpio_value;
89462306a36Sopenharmony_ci	u32 checksum = 0;
89562306a36Sopenharmony_ci	u32 *dataptr;
89662306a36Sopenharmony_ci
89762306a36Sopenharmony_ci	dprintk(2, "%s()\n", __func__);
89862306a36Sopenharmony_ci
89962306a36Sopenharmony_ci	/* Save GPIO settings before reset of APU */
90062306a36Sopenharmony_ci	retval |= mc417_memory_read(dev, 0x9020, &gpio_output);
90162306a36Sopenharmony_ci	retval |= mc417_memory_read(dev, 0x900C, &gpio_value);
90262306a36Sopenharmony_ci
90362306a36Sopenharmony_ci	retval  = mc417_register_write(dev,
90462306a36Sopenharmony_ci		IVTV_REG_VPU, 0xFFFFFFED);
90562306a36Sopenharmony_ci	retval |= mc417_register_write(dev,
90662306a36Sopenharmony_ci		IVTV_REG_HW_BLOCKS, IVTV_CMD_HW_BLOCKS_RST);
90762306a36Sopenharmony_ci	retval |= mc417_register_write(dev,
90862306a36Sopenharmony_ci		IVTV_REG_ENC_SDRAM_REFRESH, 0x80000800);
90962306a36Sopenharmony_ci	retval |= mc417_register_write(dev,
91062306a36Sopenharmony_ci		IVTV_REG_ENC_SDRAM_PRECHARGE, 0x1A);
91162306a36Sopenharmony_ci	retval |= mc417_register_write(dev,
91262306a36Sopenharmony_ci		IVTV_REG_APU, 0);
91362306a36Sopenharmony_ci
91462306a36Sopenharmony_ci	if (retval != 0) {
91562306a36Sopenharmony_ci		pr_err("%s: Error with mc417_register_write\n",
91662306a36Sopenharmony_ci			__func__);
91762306a36Sopenharmony_ci		return -1;
91862306a36Sopenharmony_ci	}
91962306a36Sopenharmony_ci
92062306a36Sopenharmony_ci	retval = request_firmware(&firmware, CX23885_FIRM_IMAGE_NAME,
92162306a36Sopenharmony_ci				  &dev->pci->dev);
92262306a36Sopenharmony_ci
92362306a36Sopenharmony_ci	if (retval != 0) {
92462306a36Sopenharmony_ci		pr_err("ERROR: Hotplug firmware request failed (%s).\n",
92562306a36Sopenharmony_ci		       CX23885_FIRM_IMAGE_NAME);
92662306a36Sopenharmony_ci		pr_err("Please fix your hotplug setup, the board will not work without firmware loaded!\n");
92762306a36Sopenharmony_ci		return -1;
92862306a36Sopenharmony_ci	}
92962306a36Sopenharmony_ci
93062306a36Sopenharmony_ci	if (firmware->size != CX23885_FIRM_IMAGE_SIZE) {
93162306a36Sopenharmony_ci		pr_err("ERROR: Firmware size mismatch (have %zu, expected %d)\n",
93262306a36Sopenharmony_ci		       firmware->size, CX23885_FIRM_IMAGE_SIZE);
93362306a36Sopenharmony_ci		release_firmware(firmware);
93462306a36Sopenharmony_ci		return -1;
93562306a36Sopenharmony_ci	}
93662306a36Sopenharmony_ci
93762306a36Sopenharmony_ci	if (0 != memcmp(firmware->data, magic, 8)) {
93862306a36Sopenharmony_ci		pr_err("ERROR: Firmware magic mismatch, wrong file?\n");
93962306a36Sopenharmony_ci		release_firmware(firmware);
94062306a36Sopenharmony_ci		return -1;
94162306a36Sopenharmony_ci	}
94262306a36Sopenharmony_ci
94362306a36Sopenharmony_ci	/* transfer to the chip */
94462306a36Sopenharmony_ci	dprintk(2, "Loading firmware ...\n");
94562306a36Sopenharmony_ci	dataptr = (u32 *)firmware->data;
94662306a36Sopenharmony_ci	for (i = 0; i < (firmware->size >> 2); i++) {
94762306a36Sopenharmony_ci		value = *dataptr;
94862306a36Sopenharmony_ci		checksum += ~value;
94962306a36Sopenharmony_ci		if (mc417_memory_write(dev, i, value) != 0) {
95062306a36Sopenharmony_ci			pr_err("ERROR: Loading firmware failed!\n");
95162306a36Sopenharmony_ci			release_firmware(firmware);
95262306a36Sopenharmony_ci			return -1;
95362306a36Sopenharmony_ci		}
95462306a36Sopenharmony_ci		dataptr++;
95562306a36Sopenharmony_ci	}
95662306a36Sopenharmony_ci
95762306a36Sopenharmony_ci	/* read back to verify with the checksum */
95862306a36Sopenharmony_ci	dprintk(1, "Verifying firmware ...\n");
95962306a36Sopenharmony_ci	for (i--; i >= 0; i--) {
96062306a36Sopenharmony_ci		if (mc417_memory_read(dev, i, &value) != 0) {
96162306a36Sopenharmony_ci			pr_err("ERROR: Reading firmware failed!\n");
96262306a36Sopenharmony_ci			release_firmware(firmware);
96362306a36Sopenharmony_ci			return -1;
96462306a36Sopenharmony_ci		}
96562306a36Sopenharmony_ci		checksum -= ~value;
96662306a36Sopenharmony_ci	}
96762306a36Sopenharmony_ci	if (checksum) {
96862306a36Sopenharmony_ci		pr_err("ERROR: Firmware load failed (checksum mismatch).\n");
96962306a36Sopenharmony_ci		release_firmware(firmware);
97062306a36Sopenharmony_ci		return -1;
97162306a36Sopenharmony_ci	}
97262306a36Sopenharmony_ci	release_firmware(firmware);
97362306a36Sopenharmony_ci	dprintk(1, "Firmware upload successful.\n");
97462306a36Sopenharmony_ci
97562306a36Sopenharmony_ci	retval |= mc417_register_write(dev, IVTV_REG_HW_BLOCKS,
97662306a36Sopenharmony_ci		IVTV_CMD_HW_BLOCKS_RST);
97762306a36Sopenharmony_ci
97862306a36Sopenharmony_ci	/* F/W power up disturbs the GPIOs, restore state */
97962306a36Sopenharmony_ci	retval |= mc417_register_write(dev, 0x9020, gpio_output);
98062306a36Sopenharmony_ci	retval |= mc417_register_write(dev, 0x900C, gpio_value);
98162306a36Sopenharmony_ci
98262306a36Sopenharmony_ci	retval |= mc417_register_read(dev, IVTV_REG_VPU, &value);
98362306a36Sopenharmony_ci	retval |= mc417_register_write(dev, IVTV_REG_VPU, value & 0xFFFFFFE8);
98462306a36Sopenharmony_ci
98562306a36Sopenharmony_ci	/* Hardcoded GPIO's here */
98662306a36Sopenharmony_ci	retval |= mc417_register_write(dev, 0x9020, 0x4000);
98762306a36Sopenharmony_ci	retval |= mc417_register_write(dev, 0x900C, 0x4000);
98862306a36Sopenharmony_ci
98962306a36Sopenharmony_ci	mc417_register_read(dev, 0x9020, &gpio_output);
99062306a36Sopenharmony_ci	mc417_register_read(dev, 0x900C, &gpio_value);
99162306a36Sopenharmony_ci
99262306a36Sopenharmony_ci	if (retval < 0)
99362306a36Sopenharmony_ci		pr_err("%s: Error with mc417_register_write\n",
99462306a36Sopenharmony_ci			__func__);
99562306a36Sopenharmony_ci	return 0;
99662306a36Sopenharmony_ci}
99762306a36Sopenharmony_ci
99862306a36Sopenharmony_civoid cx23885_417_check_encoder(struct cx23885_dev *dev)
99962306a36Sopenharmony_ci{
100062306a36Sopenharmony_ci	u32 status, seq;
100162306a36Sopenharmony_ci
100262306a36Sopenharmony_ci	status = seq = 0;
100362306a36Sopenharmony_ci	cx23885_api_cmd(dev, CX2341X_ENC_GET_SEQ_END, 0, 2, &status, &seq);
100462306a36Sopenharmony_ci	dprintk(1, "%s() status = %d, seq = %d\n", __func__, status, seq);
100562306a36Sopenharmony_ci}
100662306a36Sopenharmony_ci
100762306a36Sopenharmony_cistatic void cx23885_codec_settings(struct cx23885_dev *dev)
100862306a36Sopenharmony_ci{
100962306a36Sopenharmony_ci	dprintk(1, "%s()\n", __func__);
101062306a36Sopenharmony_ci
101162306a36Sopenharmony_ci	/* Dynamically change the height based on video standard */
101262306a36Sopenharmony_ci	if (dev->encodernorm.id & V4L2_STD_525_60)
101362306a36Sopenharmony_ci		dev->ts1.height = 480;
101462306a36Sopenharmony_ci	else
101562306a36Sopenharmony_ci		dev->ts1.height = 576;
101662306a36Sopenharmony_ci
101762306a36Sopenharmony_ci	/* assign frame size */
101862306a36Sopenharmony_ci	cx23885_api_cmd(dev, CX2341X_ENC_SET_FRAME_SIZE, 2, 0,
101962306a36Sopenharmony_ci				dev->ts1.height, dev->ts1.width);
102062306a36Sopenharmony_ci
102162306a36Sopenharmony_ci	dev->cxhdl.width = dev->ts1.width;
102262306a36Sopenharmony_ci	dev->cxhdl.height = dev->ts1.height;
102362306a36Sopenharmony_ci	dev->cxhdl.is_50hz =
102462306a36Sopenharmony_ci		(dev->encodernorm.id & V4L2_STD_625_50) != 0;
102562306a36Sopenharmony_ci
102662306a36Sopenharmony_ci	cx2341x_handler_setup(&dev->cxhdl);
102762306a36Sopenharmony_ci
102862306a36Sopenharmony_ci	cx23885_api_cmd(dev, CX2341X_ENC_MISC, 2, 0, 3, 1);
102962306a36Sopenharmony_ci	cx23885_api_cmd(dev, CX2341X_ENC_MISC, 2, 0, 4, 1);
103062306a36Sopenharmony_ci}
103162306a36Sopenharmony_ci
103262306a36Sopenharmony_cistatic int cx23885_initialize_codec(struct cx23885_dev *dev, int startencoder)
103362306a36Sopenharmony_ci{
103462306a36Sopenharmony_ci	int version;
103562306a36Sopenharmony_ci	int retval;
103662306a36Sopenharmony_ci	u32 i, data[7];
103762306a36Sopenharmony_ci
103862306a36Sopenharmony_ci	dprintk(1, "%s()\n", __func__);
103962306a36Sopenharmony_ci
104062306a36Sopenharmony_ci	retval = cx23885_api_cmd(dev, CX2341X_ENC_PING_FW, 0, 0); /* ping */
104162306a36Sopenharmony_ci	if (retval < 0) {
104262306a36Sopenharmony_ci		dprintk(2, "%s() PING OK\n", __func__);
104362306a36Sopenharmony_ci		retval = cx23885_load_firmware(dev);
104462306a36Sopenharmony_ci		if (retval < 0) {
104562306a36Sopenharmony_ci			pr_err("%s() f/w load failed\n", __func__);
104662306a36Sopenharmony_ci			return retval;
104762306a36Sopenharmony_ci		}
104862306a36Sopenharmony_ci		retval = cx23885_find_mailbox(dev);
104962306a36Sopenharmony_ci		if (retval < 0) {
105062306a36Sopenharmony_ci			pr_err("%s() mailbox < 0, error\n",
105162306a36Sopenharmony_ci				__func__);
105262306a36Sopenharmony_ci			return -1;
105362306a36Sopenharmony_ci		}
105462306a36Sopenharmony_ci		dev->cx23417_mailbox = retval;
105562306a36Sopenharmony_ci		retval = cx23885_api_cmd(dev, CX2341X_ENC_PING_FW, 0, 0);
105662306a36Sopenharmony_ci		if (retval < 0) {
105762306a36Sopenharmony_ci			pr_err("ERROR: cx23417 firmware ping failed!\n");
105862306a36Sopenharmony_ci			return -1;
105962306a36Sopenharmony_ci		}
106062306a36Sopenharmony_ci		retval = cx23885_api_cmd(dev, CX2341X_ENC_GET_VERSION, 0, 1,
106162306a36Sopenharmony_ci			&version);
106262306a36Sopenharmony_ci		if (retval < 0) {
106362306a36Sopenharmony_ci			pr_err("ERROR: cx23417 firmware get encoder :version failed!\n");
106462306a36Sopenharmony_ci			return -1;
106562306a36Sopenharmony_ci		}
106662306a36Sopenharmony_ci		dprintk(1, "cx23417 firmware version is 0x%08x\n", version);
106762306a36Sopenharmony_ci		msleep(200);
106862306a36Sopenharmony_ci	}
106962306a36Sopenharmony_ci
107062306a36Sopenharmony_ci	cx23885_codec_settings(dev);
107162306a36Sopenharmony_ci	msleep(60);
107262306a36Sopenharmony_ci
107362306a36Sopenharmony_ci	cx23885_api_cmd(dev, CX2341X_ENC_SET_NUM_VSYNC_LINES, 2, 0,
107462306a36Sopenharmony_ci		CX23885_FIELD1_SAA7115, CX23885_FIELD2_SAA7115);
107562306a36Sopenharmony_ci	cx23885_api_cmd(dev, CX2341X_ENC_SET_PLACEHOLDER, 12, 0,
107662306a36Sopenharmony_ci		CX23885_CUSTOM_EXTENSION_USR_DATA, 0, 0, 0, 0, 0, 0, 0, 0, 0,
107762306a36Sopenharmony_ci		0, 0);
107862306a36Sopenharmony_ci
107962306a36Sopenharmony_ci	/* Setup to capture VBI */
108062306a36Sopenharmony_ci	data[0] = 0x0001BD00;
108162306a36Sopenharmony_ci	data[1] = 1;          /* frames per interrupt */
108262306a36Sopenharmony_ci	data[2] = 4;          /* total bufs */
108362306a36Sopenharmony_ci	data[3] = 0x91559155; /* start codes */
108462306a36Sopenharmony_ci	data[4] = 0x206080C0; /* stop codes */
108562306a36Sopenharmony_ci	data[5] = 6;          /* lines */
108662306a36Sopenharmony_ci	data[6] = 64;         /* BPL */
108762306a36Sopenharmony_ci
108862306a36Sopenharmony_ci	cx23885_api_cmd(dev, CX2341X_ENC_SET_VBI_CONFIG, 7, 0, data[0], data[1],
108962306a36Sopenharmony_ci		data[2], data[3], data[4], data[5], data[6]);
109062306a36Sopenharmony_ci
109162306a36Sopenharmony_ci	for (i = 2; i <= 24; i++) {
109262306a36Sopenharmony_ci		int valid;
109362306a36Sopenharmony_ci
109462306a36Sopenharmony_ci		valid = ((i >= 19) && (i <= 21));
109562306a36Sopenharmony_ci		cx23885_api_cmd(dev, CX2341X_ENC_SET_VBI_LINE, 5, 0, i,
109662306a36Sopenharmony_ci				valid, 0 , 0, 0);
109762306a36Sopenharmony_ci		cx23885_api_cmd(dev, CX2341X_ENC_SET_VBI_LINE, 5, 0,
109862306a36Sopenharmony_ci				i | 0x80000000, valid, 0, 0, 0);
109962306a36Sopenharmony_ci	}
110062306a36Sopenharmony_ci
110162306a36Sopenharmony_ci	cx23885_api_cmd(dev, CX2341X_ENC_MUTE_AUDIO, 1, 0, CX23885_UNMUTE);
110262306a36Sopenharmony_ci	msleep(60);
110362306a36Sopenharmony_ci
110462306a36Sopenharmony_ci	/* initialize the video input */
110562306a36Sopenharmony_ci	cx23885_api_cmd(dev, CX2341X_ENC_INITIALIZE_INPUT, 0, 0);
110662306a36Sopenharmony_ci	msleep(60);
110762306a36Sopenharmony_ci
110862306a36Sopenharmony_ci	/* Enable VIP style pixel invalidation so we work with scaled mode */
110962306a36Sopenharmony_ci	mc417_memory_write(dev, 2120, 0x00000080);
111062306a36Sopenharmony_ci
111162306a36Sopenharmony_ci	/* start capturing to the host interface */
111262306a36Sopenharmony_ci	if (startencoder) {
111362306a36Sopenharmony_ci		cx23885_api_cmd(dev, CX2341X_ENC_START_CAPTURE, 2, 0,
111462306a36Sopenharmony_ci			CX23885_MPEG_CAPTURE, CX23885_RAW_BITS_NONE);
111562306a36Sopenharmony_ci		msleep(10);
111662306a36Sopenharmony_ci	}
111762306a36Sopenharmony_ci
111862306a36Sopenharmony_ci	return 0;
111962306a36Sopenharmony_ci}
112062306a36Sopenharmony_ci
112162306a36Sopenharmony_ci/* ------------------------------------------------------------------ */
112262306a36Sopenharmony_ci
112362306a36Sopenharmony_cistatic int queue_setup(struct vb2_queue *q,
112462306a36Sopenharmony_ci			   unsigned int *num_buffers, unsigned int *num_planes,
112562306a36Sopenharmony_ci			   unsigned int sizes[], struct device *alloc_devs[])
112662306a36Sopenharmony_ci{
112762306a36Sopenharmony_ci	struct cx23885_dev *dev = q->drv_priv;
112862306a36Sopenharmony_ci
112962306a36Sopenharmony_ci	dev->ts1.ts_packet_size  = mpeglinesize;
113062306a36Sopenharmony_ci	dev->ts1.ts_packet_count = mpeglines;
113162306a36Sopenharmony_ci	*num_planes = 1;
113262306a36Sopenharmony_ci	sizes[0] = mpeglinesize * mpeglines;
113362306a36Sopenharmony_ci	*num_buffers = mpegbufs;
113462306a36Sopenharmony_ci	return 0;
113562306a36Sopenharmony_ci}
113662306a36Sopenharmony_ci
113762306a36Sopenharmony_cistatic int buffer_prepare(struct vb2_buffer *vb)
113862306a36Sopenharmony_ci{
113962306a36Sopenharmony_ci	struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
114062306a36Sopenharmony_ci	struct cx23885_dev *dev = vb->vb2_queue->drv_priv;
114162306a36Sopenharmony_ci	struct cx23885_buffer *buf =
114262306a36Sopenharmony_ci		container_of(vbuf, struct cx23885_buffer, vb);
114362306a36Sopenharmony_ci
114462306a36Sopenharmony_ci	return cx23885_buf_prepare(buf, &dev->ts1);
114562306a36Sopenharmony_ci}
114662306a36Sopenharmony_ci
114762306a36Sopenharmony_cistatic void buffer_finish(struct vb2_buffer *vb)
114862306a36Sopenharmony_ci{
114962306a36Sopenharmony_ci	struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
115062306a36Sopenharmony_ci	struct cx23885_dev *dev = vb->vb2_queue->drv_priv;
115162306a36Sopenharmony_ci	struct cx23885_buffer *buf = container_of(vbuf,
115262306a36Sopenharmony_ci		struct cx23885_buffer, vb);
115362306a36Sopenharmony_ci
115462306a36Sopenharmony_ci	cx23885_free_buffer(dev, buf);
115562306a36Sopenharmony_ci}
115662306a36Sopenharmony_ci
115762306a36Sopenharmony_cistatic void buffer_queue(struct vb2_buffer *vb)
115862306a36Sopenharmony_ci{
115962306a36Sopenharmony_ci	struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
116062306a36Sopenharmony_ci	struct cx23885_dev *dev = vb->vb2_queue->drv_priv;
116162306a36Sopenharmony_ci	struct cx23885_buffer   *buf = container_of(vbuf,
116262306a36Sopenharmony_ci		struct cx23885_buffer, vb);
116362306a36Sopenharmony_ci
116462306a36Sopenharmony_ci	cx23885_buf_queue(&dev->ts1, buf);
116562306a36Sopenharmony_ci}
116662306a36Sopenharmony_ci
116762306a36Sopenharmony_cistatic int cx23885_start_streaming(struct vb2_queue *q, unsigned int count)
116862306a36Sopenharmony_ci{
116962306a36Sopenharmony_ci	struct cx23885_dev *dev = q->drv_priv;
117062306a36Sopenharmony_ci	struct cx23885_dmaqueue *dmaq = &dev->ts1.mpegq;
117162306a36Sopenharmony_ci	unsigned long flags;
117262306a36Sopenharmony_ci	int ret;
117362306a36Sopenharmony_ci
117462306a36Sopenharmony_ci	ret = cx23885_initialize_codec(dev, 1);
117562306a36Sopenharmony_ci	if (ret == 0) {
117662306a36Sopenharmony_ci		struct cx23885_buffer *buf = list_entry(dmaq->active.next,
117762306a36Sopenharmony_ci			struct cx23885_buffer, queue);
117862306a36Sopenharmony_ci
117962306a36Sopenharmony_ci		cx23885_start_dma(&dev->ts1, dmaq, buf);
118062306a36Sopenharmony_ci		return 0;
118162306a36Sopenharmony_ci	}
118262306a36Sopenharmony_ci	spin_lock_irqsave(&dev->slock, flags);
118362306a36Sopenharmony_ci	while (!list_empty(&dmaq->active)) {
118462306a36Sopenharmony_ci		struct cx23885_buffer *buf = list_entry(dmaq->active.next,
118562306a36Sopenharmony_ci			struct cx23885_buffer, queue);
118662306a36Sopenharmony_ci
118762306a36Sopenharmony_ci		list_del(&buf->queue);
118862306a36Sopenharmony_ci		vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_QUEUED);
118962306a36Sopenharmony_ci	}
119062306a36Sopenharmony_ci	spin_unlock_irqrestore(&dev->slock, flags);
119162306a36Sopenharmony_ci	return ret;
119262306a36Sopenharmony_ci}
119362306a36Sopenharmony_ci
119462306a36Sopenharmony_cistatic void cx23885_stop_streaming(struct vb2_queue *q)
119562306a36Sopenharmony_ci{
119662306a36Sopenharmony_ci	struct cx23885_dev *dev = q->drv_priv;
119762306a36Sopenharmony_ci
119862306a36Sopenharmony_ci	/* stop mpeg capture */
119962306a36Sopenharmony_ci	cx23885_api_cmd(dev, CX2341X_ENC_STOP_CAPTURE, 3, 0,
120062306a36Sopenharmony_ci			CX23885_END_NOW, CX23885_MPEG_CAPTURE,
120162306a36Sopenharmony_ci			CX23885_RAW_BITS_NONE);
120262306a36Sopenharmony_ci
120362306a36Sopenharmony_ci	msleep(500);
120462306a36Sopenharmony_ci	cx23885_417_check_encoder(dev);
120562306a36Sopenharmony_ci	cx23885_cancel_buffers(&dev->ts1);
120662306a36Sopenharmony_ci}
120762306a36Sopenharmony_ci
120862306a36Sopenharmony_cistatic const struct vb2_ops cx23885_qops = {
120962306a36Sopenharmony_ci	.queue_setup    = queue_setup,
121062306a36Sopenharmony_ci	.buf_prepare  = buffer_prepare,
121162306a36Sopenharmony_ci	.buf_finish = buffer_finish,
121262306a36Sopenharmony_ci	.buf_queue    = buffer_queue,
121362306a36Sopenharmony_ci	.wait_prepare = vb2_ops_wait_prepare,
121462306a36Sopenharmony_ci	.wait_finish = vb2_ops_wait_finish,
121562306a36Sopenharmony_ci	.start_streaming = cx23885_start_streaming,
121662306a36Sopenharmony_ci	.stop_streaming = cx23885_stop_streaming,
121762306a36Sopenharmony_ci};
121862306a36Sopenharmony_ci
121962306a36Sopenharmony_ci/* ------------------------------------------------------------------ */
122062306a36Sopenharmony_ci
122162306a36Sopenharmony_cistatic int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *id)
122262306a36Sopenharmony_ci{
122362306a36Sopenharmony_ci	struct cx23885_dev *dev = video_drvdata(file);
122462306a36Sopenharmony_ci
122562306a36Sopenharmony_ci	*id = dev->tvnorm;
122662306a36Sopenharmony_ci	return 0;
122762306a36Sopenharmony_ci}
122862306a36Sopenharmony_ci
122962306a36Sopenharmony_cistatic int vidioc_s_std(struct file *file, void *priv, v4l2_std_id id)
123062306a36Sopenharmony_ci{
123162306a36Sopenharmony_ci	struct cx23885_dev *dev = video_drvdata(file);
123262306a36Sopenharmony_ci	unsigned int i;
123362306a36Sopenharmony_ci	int ret;
123462306a36Sopenharmony_ci
123562306a36Sopenharmony_ci	for (i = 0; i < ARRAY_SIZE(cx23885_tvnorms); i++)
123662306a36Sopenharmony_ci		if (id & cx23885_tvnorms[i].id)
123762306a36Sopenharmony_ci			break;
123862306a36Sopenharmony_ci	if (i == ARRAY_SIZE(cx23885_tvnorms))
123962306a36Sopenharmony_ci		return -EINVAL;
124062306a36Sopenharmony_ci
124162306a36Sopenharmony_ci	ret = cx23885_set_tvnorm(dev, id);
124262306a36Sopenharmony_ci	if (!ret)
124362306a36Sopenharmony_ci		dev->encodernorm = cx23885_tvnorms[i];
124462306a36Sopenharmony_ci	return ret;
124562306a36Sopenharmony_ci}
124662306a36Sopenharmony_ci
124762306a36Sopenharmony_cistatic int vidioc_enum_input(struct file *file, void *priv,
124862306a36Sopenharmony_ci	struct v4l2_input *i)
124962306a36Sopenharmony_ci{
125062306a36Sopenharmony_ci	struct cx23885_dev *dev = video_drvdata(file);
125162306a36Sopenharmony_ci	dprintk(1, "%s()\n", __func__);
125262306a36Sopenharmony_ci	return cx23885_enum_input(dev, i);
125362306a36Sopenharmony_ci}
125462306a36Sopenharmony_ci
125562306a36Sopenharmony_cistatic int vidioc_g_input(struct file *file, void *priv, unsigned int *i)
125662306a36Sopenharmony_ci{
125762306a36Sopenharmony_ci	return cx23885_get_input(file, priv, i);
125862306a36Sopenharmony_ci}
125962306a36Sopenharmony_ci
126062306a36Sopenharmony_cistatic int vidioc_s_input(struct file *file, void *priv, unsigned int i)
126162306a36Sopenharmony_ci{
126262306a36Sopenharmony_ci	return cx23885_set_input(file, priv, i);
126362306a36Sopenharmony_ci}
126462306a36Sopenharmony_ci
126562306a36Sopenharmony_cistatic int vidioc_g_tuner(struct file *file, void *priv,
126662306a36Sopenharmony_ci				struct v4l2_tuner *t)
126762306a36Sopenharmony_ci{
126862306a36Sopenharmony_ci	struct cx23885_dev *dev = video_drvdata(file);
126962306a36Sopenharmony_ci
127062306a36Sopenharmony_ci	if (dev->tuner_type == TUNER_ABSENT)
127162306a36Sopenharmony_ci		return -EINVAL;
127262306a36Sopenharmony_ci	if (0 != t->index)
127362306a36Sopenharmony_ci		return -EINVAL;
127462306a36Sopenharmony_ci	strscpy(t->name, "Television", sizeof(t->name));
127562306a36Sopenharmony_ci	call_all(dev, tuner, g_tuner, t);
127662306a36Sopenharmony_ci
127762306a36Sopenharmony_ci	dprintk(1, "VIDIOC_G_TUNER: tuner type %d\n", t->type);
127862306a36Sopenharmony_ci
127962306a36Sopenharmony_ci	return 0;
128062306a36Sopenharmony_ci}
128162306a36Sopenharmony_ci
128262306a36Sopenharmony_cistatic int vidioc_s_tuner(struct file *file, void *priv,
128362306a36Sopenharmony_ci				const struct v4l2_tuner *t)
128462306a36Sopenharmony_ci{
128562306a36Sopenharmony_ci	struct cx23885_dev *dev = video_drvdata(file);
128662306a36Sopenharmony_ci
128762306a36Sopenharmony_ci	if (dev->tuner_type == TUNER_ABSENT)
128862306a36Sopenharmony_ci		return -EINVAL;
128962306a36Sopenharmony_ci
129062306a36Sopenharmony_ci	/* Update the A/V core */
129162306a36Sopenharmony_ci	call_all(dev, tuner, s_tuner, t);
129262306a36Sopenharmony_ci
129362306a36Sopenharmony_ci	return 0;
129462306a36Sopenharmony_ci}
129562306a36Sopenharmony_ci
129662306a36Sopenharmony_cistatic int vidioc_g_frequency(struct file *file, void *priv,
129762306a36Sopenharmony_ci				struct v4l2_frequency *f)
129862306a36Sopenharmony_ci{
129962306a36Sopenharmony_ci	struct cx23885_dev *dev = video_drvdata(file);
130062306a36Sopenharmony_ci
130162306a36Sopenharmony_ci	if (dev->tuner_type == TUNER_ABSENT)
130262306a36Sopenharmony_ci		return -EINVAL;
130362306a36Sopenharmony_ci	f->type = V4L2_TUNER_ANALOG_TV;
130462306a36Sopenharmony_ci	f->frequency = dev->freq;
130562306a36Sopenharmony_ci
130662306a36Sopenharmony_ci	call_all(dev, tuner, g_frequency, f);
130762306a36Sopenharmony_ci
130862306a36Sopenharmony_ci	return 0;
130962306a36Sopenharmony_ci}
131062306a36Sopenharmony_ci
131162306a36Sopenharmony_cistatic int vidioc_s_frequency(struct file *file, void *priv,
131262306a36Sopenharmony_ci	const struct v4l2_frequency *f)
131362306a36Sopenharmony_ci{
131462306a36Sopenharmony_ci	return cx23885_set_frequency(file, priv, f);
131562306a36Sopenharmony_ci}
131662306a36Sopenharmony_ci
131762306a36Sopenharmony_cistatic int vidioc_querycap(struct file *file, void  *priv,
131862306a36Sopenharmony_ci				struct v4l2_capability *cap)
131962306a36Sopenharmony_ci{
132062306a36Sopenharmony_ci	struct cx23885_dev *dev = video_drvdata(file);
132162306a36Sopenharmony_ci	struct cx23885_tsport  *tsport = &dev->ts1;
132262306a36Sopenharmony_ci
132362306a36Sopenharmony_ci	strscpy(cap->driver, dev->name, sizeof(cap->driver));
132462306a36Sopenharmony_ci	strscpy(cap->card, cx23885_boards[tsport->dev->board].name,
132562306a36Sopenharmony_ci		sizeof(cap->card));
132662306a36Sopenharmony_ci	sprintf(cap->bus_info, "PCIe:%s", pci_name(dev->pci));
132762306a36Sopenharmony_ci	cap->capabilities = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_READWRITE |
132862306a36Sopenharmony_ci			    V4L2_CAP_STREAMING | V4L2_CAP_VBI_CAPTURE |
132962306a36Sopenharmony_ci			    V4L2_CAP_AUDIO | V4L2_CAP_DEVICE_CAPS;
133062306a36Sopenharmony_ci	if (dev->tuner_type != TUNER_ABSENT)
133162306a36Sopenharmony_ci		cap->capabilities |= V4L2_CAP_TUNER;
133262306a36Sopenharmony_ci
133362306a36Sopenharmony_ci	return 0;
133462306a36Sopenharmony_ci}
133562306a36Sopenharmony_ci
133662306a36Sopenharmony_cistatic int vidioc_enum_fmt_vid_cap(struct file *file, void  *priv,
133762306a36Sopenharmony_ci					struct v4l2_fmtdesc *f)
133862306a36Sopenharmony_ci{
133962306a36Sopenharmony_ci	if (f->index != 0)
134062306a36Sopenharmony_ci		return -EINVAL;
134162306a36Sopenharmony_ci
134262306a36Sopenharmony_ci	f->pixelformat = V4L2_PIX_FMT_MPEG;
134362306a36Sopenharmony_ci
134462306a36Sopenharmony_ci	return 0;
134562306a36Sopenharmony_ci}
134662306a36Sopenharmony_ci
134762306a36Sopenharmony_cistatic int vidioc_g_fmt_vid_cap(struct file *file, void *priv,
134862306a36Sopenharmony_ci				struct v4l2_format *f)
134962306a36Sopenharmony_ci{
135062306a36Sopenharmony_ci	struct cx23885_dev *dev = video_drvdata(file);
135162306a36Sopenharmony_ci
135262306a36Sopenharmony_ci	f->fmt.pix.pixelformat  = V4L2_PIX_FMT_MPEG;
135362306a36Sopenharmony_ci	f->fmt.pix.bytesperline = 0;
135462306a36Sopenharmony_ci	f->fmt.pix.sizeimage    =
135562306a36Sopenharmony_ci		dev->ts1.ts_packet_size * dev->ts1.ts_packet_count;
135662306a36Sopenharmony_ci	f->fmt.pix.colorspace   = 0;
135762306a36Sopenharmony_ci	f->fmt.pix.width        = dev->ts1.width;
135862306a36Sopenharmony_ci	f->fmt.pix.height       = dev->ts1.height;
135962306a36Sopenharmony_ci	f->fmt.pix.field        = V4L2_FIELD_INTERLACED;
136062306a36Sopenharmony_ci	dprintk(1, "VIDIOC_G_FMT: w: %d, h: %d\n",
136162306a36Sopenharmony_ci		dev->ts1.width, dev->ts1.height);
136262306a36Sopenharmony_ci	return 0;
136362306a36Sopenharmony_ci}
136462306a36Sopenharmony_ci
136562306a36Sopenharmony_cistatic int vidioc_try_fmt_vid_cap(struct file *file, void *priv,
136662306a36Sopenharmony_ci				struct v4l2_format *f)
136762306a36Sopenharmony_ci{
136862306a36Sopenharmony_ci	struct cx23885_dev *dev = video_drvdata(file);
136962306a36Sopenharmony_ci
137062306a36Sopenharmony_ci	f->fmt.pix.pixelformat  = V4L2_PIX_FMT_MPEG;
137162306a36Sopenharmony_ci	f->fmt.pix.bytesperline = 0;
137262306a36Sopenharmony_ci	f->fmt.pix.sizeimage    =
137362306a36Sopenharmony_ci		dev->ts1.ts_packet_size * dev->ts1.ts_packet_count;
137462306a36Sopenharmony_ci	f->fmt.pix.colorspace   = 0;
137562306a36Sopenharmony_ci	f->fmt.pix.field        = V4L2_FIELD_INTERLACED;
137662306a36Sopenharmony_ci	dprintk(1, "VIDIOC_TRY_FMT: w: %d, h: %d\n",
137762306a36Sopenharmony_ci		dev->ts1.width, dev->ts1.height);
137862306a36Sopenharmony_ci	return 0;
137962306a36Sopenharmony_ci}
138062306a36Sopenharmony_ci
138162306a36Sopenharmony_cistatic int vidioc_s_fmt_vid_cap(struct file *file, void *priv,
138262306a36Sopenharmony_ci				struct v4l2_format *f)
138362306a36Sopenharmony_ci{
138462306a36Sopenharmony_ci	struct cx23885_dev *dev = video_drvdata(file);
138562306a36Sopenharmony_ci
138662306a36Sopenharmony_ci	f->fmt.pix.pixelformat  = V4L2_PIX_FMT_MPEG;
138762306a36Sopenharmony_ci	f->fmt.pix.bytesperline = 0;
138862306a36Sopenharmony_ci	f->fmt.pix.sizeimage    =
138962306a36Sopenharmony_ci		dev->ts1.ts_packet_size * dev->ts1.ts_packet_count;
139062306a36Sopenharmony_ci	f->fmt.pix.colorspace   = 0;
139162306a36Sopenharmony_ci	f->fmt.pix.field        = V4L2_FIELD_INTERLACED;
139262306a36Sopenharmony_ci	dprintk(1, "VIDIOC_S_FMT: w: %d, h: %d, f: %d\n",
139362306a36Sopenharmony_ci		f->fmt.pix.width, f->fmt.pix.height, f->fmt.pix.field);
139462306a36Sopenharmony_ci	return 0;
139562306a36Sopenharmony_ci}
139662306a36Sopenharmony_ci
139762306a36Sopenharmony_cistatic int vidioc_log_status(struct file *file, void *priv)
139862306a36Sopenharmony_ci{
139962306a36Sopenharmony_ci	struct cx23885_dev *dev = video_drvdata(file);
140062306a36Sopenharmony_ci	char name[32 + 2];
140162306a36Sopenharmony_ci
140262306a36Sopenharmony_ci	snprintf(name, sizeof(name), "%s/2", dev->name);
140362306a36Sopenharmony_ci	call_all(dev, core, log_status);
140462306a36Sopenharmony_ci	v4l2_ctrl_handler_log_status(&dev->cxhdl.hdl, name);
140562306a36Sopenharmony_ci	return 0;
140662306a36Sopenharmony_ci}
140762306a36Sopenharmony_ci
140862306a36Sopenharmony_cistatic const struct v4l2_file_operations mpeg_fops = {
140962306a36Sopenharmony_ci	.owner	       = THIS_MODULE,
141062306a36Sopenharmony_ci	.open           = v4l2_fh_open,
141162306a36Sopenharmony_ci	.release        = vb2_fop_release,
141262306a36Sopenharmony_ci	.read           = vb2_fop_read,
141362306a36Sopenharmony_ci	.poll		= vb2_fop_poll,
141462306a36Sopenharmony_ci	.unlocked_ioctl = video_ioctl2,
141562306a36Sopenharmony_ci	.mmap           = vb2_fop_mmap,
141662306a36Sopenharmony_ci};
141762306a36Sopenharmony_ci
141862306a36Sopenharmony_cistatic const struct v4l2_ioctl_ops mpeg_ioctl_ops = {
141962306a36Sopenharmony_ci	.vidioc_g_std		 = vidioc_g_std,
142062306a36Sopenharmony_ci	.vidioc_s_std		 = vidioc_s_std,
142162306a36Sopenharmony_ci	.vidioc_enum_input	 = vidioc_enum_input,
142262306a36Sopenharmony_ci	.vidioc_g_input		 = vidioc_g_input,
142362306a36Sopenharmony_ci	.vidioc_s_input		 = vidioc_s_input,
142462306a36Sopenharmony_ci	.vidioc_g_tuner		 = vidioc_g_tuner,
142562306a36Sopenharmony_ci	.vidioc_s_tuner		 = vidioc_s_tuner,
142662306a36Sopenharmony_ci	.vidioc_g_frequency	 = vidioc_g_frequency,
142762306a36Sopenharmony_ci	.vidioc_s_frequency	 = vidioc_s_frequency,
142862306a36Sopenharmony_ci	.vidioc_querycap	 = vidioc_querycap,
142962306a36Sopenharmony_ci	.vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap,
143062306a36Sopenharmony_ci	.vidioc_g_fmt_vid_cap	 = vidioc_g_fmt_vid_cap,
143162306a36Sopenharmony_ci	.vidioc_try_fmt_vid_cap	 = vidioc_try_fmt_vid_cap,
143262306a36Sopenharmony_ci	.vidioc_s_fmt_vid_cap	 = vidioc_s_fmt_vid_cap,
143362306a36Sopenharmony_ci	.vidioc_reqbufs       = vb2_ioctl_reqbufs,
143462306a36Sopenharmony_ci	.vidioc_prepare_buf   = vb2_ioctl_prepare_buf,
143562306a36Sopenharmony_ci	.vidioc_querybuf      = vb2_ioctl_querybuf,
143662306a36Sopenharmony_ci	.vidioc_qbuf          = vb2_ioctl_qbuf,
143762306a36Sopenharmony_ci	.vidioc_dqbuf         = vb2_ioctl_dqbuf,
143862306a36Sopenharmony_ci	.vidioc_streamon      = vb2_ioctl_streamon,
143962306a36Sopenharmony_ci	.vidioc_streamoff     = vb2_ioctl_streamoff,
144062306a36Sopenharmony_ci	.vidioc_log_status	 = vidioc_log_status,
144162306a36Sopenharmony_ci#ifdef CONFIG_VIDEO_ADV_DEBUG
144262306a36Sopenharmony_ci	.vidioc_g_chip_info	 = cx23885_g_chip_info,
144362306a36Sopenharmony_ci	.vidioc_g_register	 = cx23885_g_register,
144462306a36Sopenharmony_ci	.vidioc_s_register	 = cx23885_s_register,
144562306a36Sopenharmony_ci#endif
144662306a36Sopenharmony_ci};
144762306a36Sopenharmony_ci
144862306a36Sopenharmony_cistatic struct video_device cx23885_mpeg_template = {
144962306a36Sopenharmony_ci	.name          = "cx23885",
145062306a36Sopenharmony_ci	.fops          = &mpeg_fops,
145162306a36Sopenharmony_ci	.ioctl_ops     = &mpeg_ioctl_ops,
145262306a36Sopenharmony_ci	.tvnorms       = CX23885_NORMS,
145362306a36Sopenharmony_ci};
145462306a36Sopenharmony_ci
145562306a36Sopenharmony_civoid cx23885_417_unregister(struct cx23885_dev *dev)
145662306a36Sopenharmony_ci{
145762306a36Sopenharmony_ci	dprintk(1, "%s()\n", __func__);
145862306a36Sopenharmony_ci
145962306a36Sopenharmony_ci	if (dev->v4l_device) {
146062306a36Sopenharmony_ci		if (video_is_registered(dev->v4l_device))
146162306a36Sopenharmony_ci			video_unregister_device(dev->v4l_device);
146262306a36Sopenharmony_ci		else
146362306a36Sopenharmony_ci			video_device_release(dev->v4l_device);
146462306a36Sopenharmony_ci		v4l2_ctrl_handler_free(&dev->cxhdl.hdl);
146562306a36Sopenharmony_ci		dev->v4l_device = NULL;
146662306a36Sopenharmony_ci	}
146762306a36Sopenharmony_ci}
146862306a36Sopenharmony_ci
146962306a36Sopenharmony_cistatic struct video_device *cx23885_video_dev_alloc(
147062306a36Sopenharmony_ci	struct cx23885_tsport *tsport,
147162306a36Sopenharmony_ci	struct pci_dev *pci,
147262306a36Sopenharmony_ci	struct video_device *template,
147362306a36Sopenharmony_ci	char *type)
147462306a36Sopenharmony_ci{
147562306a36Sopenharmony_ci	struct video_device *vfd;
147662306a36Sopenharmony_ci	struct cx23885_dev *dev = tsport->dev;
147762306a36Sopenharmony_ci
147862306a36Sopenharmony_ci	dprintk(1, "%s()\n", __func__);
147962306a36Sopenharmony_ci
148062306a36Sopenharmony_ci	vfd = video_device_alloc();
148162306a36Sopenharmony_ci	if (NULL == vfd)
148262306a36Sopenharmony_ci		return NULL;
148362306a36Sopenharmony_ci	*vfd = *template;
148462306a36Sopenharmony_ci	snprintf(vfd->name, sizeof(vfd->name), "%s (%s)",
148562306a36Sopenharmony_ci		cx23885_boards[tsport->dev->board].name, type);
148662306a36Sopenharmony_ci	vfd->v4l2_dev = &dev->v4l2_dev;
148762306a36Sopenharmony_ci	vfd->release = video_device_release;
148862306a36Sopenharmony_ci	return vfd;
148962306a36Sopenharmony_ci}
149062306a36Sopenharmony_ci
149162306a36Sopenharmony_ciint cx23885_417_register(struct cx23885_dev *dev)
149262306a36Sopenharmony_ci{
149362306a36Sopenharmony_ci	/* FIXME: Port1 hardcoded here */
149462306a36Sopenharmony_ci	int err = -ENODEV;
149562306a36Sopenharmony_ci	struct cx23885_tsport *tsport = &dev->ts1;
149662306a36Sopenharmony_ci	struct vb2_queue *q;
149762306a36Sopenharmony_ci
149862306a36Sopenharmony_ci	dprintk(1, "%s()\n", __func__);
149962306a36Sopenharmony_ci
150062306a36Sopenharmony_ci	if (cx23885_boards[dev->board].portb != CX23885_MPEG_ENCODER)
150162306a36Sopenharmony_ci		return err;
150262306a36Sopenharmony_ci
150362306a36Sopenharmony_ci	/* Set default TV standard */
150462306a36Sopenharmony_ci	dev->encodernorm = cx23885_tvnorms[0];
150562306a36Sopenharmony_ci
150662306a36Sopenharmony_ci	if (dev->encodernorm.id & V4L2_STD_525_60)
150762306a36Sopenharmony_ci		tsport->height = 480;
150862306a36Sopenharmony_ci	else
150962306a36Sopenharmony_ci		tsport->height = 576;
151062306a36Sopenharmony_ci
151162306a36Sopenharmony_ci	tsport->width = 720;
151262306a36Sopenharmony_ci	dev->cxhdl.port = CX2341X_PORT_SERIAL;
151362306a36Sopenharmony_ci	err = cx2341x_handler_init(&dev->cxhdl, 50);
151462306a36Sopenharmony_ci	if (err)
151562306a36Sopenharmony_ci		return err;
151662306a36Sopenharmony_ci	dev->cxhdl.priv = dev;
151762306a36Sopenharmony_ci	dev->cxhdl.func = cx23885_api_func;
151862306a36Sopenharmony_ci	cx2341x_handler_set_50hz(&dev->cxhdl, tsport->height == 576);
151962306a36Sopenharmony_ci	v4l2_ctrl_add_handler(&dev->ctrl_handler, &dev->cxhdl.hdl, NULL, false);
152062306a36Sopenharmony_ci
152162306a36Sopenharmony_ci	/* Allocate and initialize V4L video device */
152262306a36Sopenharmony_ci	dev->v4l_device = cx23885_video_dev_alloc(tsport,
152362306a36Sopenharmony_ci		dev->pci, &cx23885_mpeg_template, "mpeg");
152462306a36Sopenharmony_ci	q = &dev->vb2_mpegq;
152562306a36Sopenharmony_ci	q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
152662306a36Sopenharmony_ci	q->io_modes = VB2_MMAP | VB2_USERPTR | VB2_DMABUF | VB2_READ;
152762306a36Sopenharmony_ci	q->gfp_flags = GFP_DMA32;
152862306a36Sopenharmony_ci	q->min_buffers_needed = 2;
152962306a36Sopenharmony_ci	q->drv_priv = dev;
153062306a36Sopenharmony_ci	q->buf_struct_size = sizeof(struct cx23885_buffer);
153162306a36Sopenharmony_ci	q->ops = &cx23885_qops;
153262306a36Sopenharmony_ci	q->mem_ops = &vb2_dma_sg_memops;
153362306a36Sopenharmony_ci	q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC;
153462306a36Sopenharmony_ci	q->lock = &dev->lock;
153562306a36Sopenharmony_ci	q->dev = &dev->pci->dev;
153662306a36Sopenharmony_ci
153762306a36Sopenharmony_ci	err = vb2_queue_init(q);
153862306a36Sopenharmony_ci	if (err < 0)
153962306a36Sopenharmony_ci		return err;
154062306a36Sopenharmony_ci	video_set_drvdata(dev->v4l_device, dev);
154162306a36Sopenharmony_ci	dev->v4l_device->lock = &dev->lock;
154262306a36Sopenharmony_ci	dev->v4l_device->queue = q;
154362306a36Sopenharmony_ci	dev->v4l_device->device_caps = V4L2_CAP_VIDEO_CAPTURE |
154462306a36Sopenharmony_ci				       V4L2_CAP_READWRITE | V4L2_CAP_STREAMING;
154562306a36Sopenharmony_ci	if (dev->tuner_type != TUNER_ABSENT)
154662306a36Sopenharmony_ci		dev->v4l_device->device_caps |= V4L2_CAP_TUNER;
154762306a36Sopenharmony_ci	err = video_register_device(dev->v4l_device,
154862306a36Sopenharmony_ci		VFL_TYPE_VIDEO, -1);
154962306a36Sopenharmony_ci	if (err < 0) {
155062306a36Sopenharmony_ci		pr_info("%s: can't register mpeg device\n", dev->name);
155162306a36Sopenharmony_ci		return err;
155262306a36Sopenharmony_ci	}
155362306a36Sopenharmony_ci
155462306a36Sopenharmony_ci	pr_info("%s: registered device %s [mpeg]\n",
155562306a36Sopenharmony_ci	       dev->name, video_device_node_name(dev->v4l_device));
155662306a36Sopenharmony_ci
155762306a36Sopenharmony_ci	/* ST: Configure the encoder parameters, but don't begin
155862306a36Sopenharmony_ci	 * encoding, this resolves an issue where the first time the
155962306a36Sopenharmony_ci	 * encoder is started video can be choppy.
156062306a36Sopenharmony_ci	 */
156162306a36Sopenharmony_ci	cx23885_initialize_codec(dev, 0);
156262306a36Sopenharmony_ci
156362306a36Sopenharmony_ci	return 0;
156462306a36Sopenharmony_ci}
156562306a36Sopenharmony_ci
156662306a36Sopenharmony_ciMODULE_FIRMWARE(CX23885_FIRM_IMAGE_NAME);
1567