[linux-2.6-block.git] / drivers / media / pci / saa7134 / saa7134-go7007.c

/*
 * Copyright (C) 2005-2006 Micronas USA Inc.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License (Version 2) as
 * published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 */

#include "saa7134.h"
#include "saa7134-reg.h"

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/spinlock.h>
#include <linux/wait.h>
#include <linux/list.h>
#include <linux/slab.h>
#include <linux/time.h>
#include <linux/mm.h>
#include <linux/usb.h>
#include <linux/i2c.h>
#include <asm/byteorder.h>
#include <media/v4l2-common.h>
#include <media/v4l2-device.h>
#include <media/v4l2-subdev.h>

#include "go7007-priv.h"

/*#define GO7007_HPI_DEBUG*/

enum hpi_address {
	HPI_ADDR_VIDEO_BUFFER = 0xe4,
	HPI_ADDR_INIT_BUFFER = 0xea,
	HPI_ADDR_INTR_RET_VALUE = 0xee,
	HPI_ADDR_INTR_RET_DATA = 0xec,
	HPI_ADDR_INTR_STATUS = 0xf4,
	HPI_ADDR_INTR_WR_PARAM = 0xf6,
	HPI_ADDR_INTR_WR_INDEX = 0xf8,
};

enum gpio_command {
	GPIO_COMMAND_RESET = 0x00, /* 000b */
	GPIO_COMMAND_REQ1  = 0x04, /* 001b */
	GPIO_COMMAND_WRITE = 0x20, /* 010b */
	GPIO_COMMAND_REQ2  = 0x24, /* 011b */
	GPIO_COMMAND_READ  = 0x80, /* 100b */
	GPIO_COMMAND_VIDEO = 0x84, /* 101b */
	GPIO_COMMAND_IDLE  = 0xA0, /* 110b */
	GPIO_COMMAND_ADDR  = 0xA4, /* 111b */
};

struct saa7134_go7007 {
	struct v4l2_subdev sd;
	struct saa7134_dev *dev;
	u8 *top;
	u8 *bottom;
	dma_addr_t top_dma;
	dma_addr_t bottom_dma;
};

static inline struct saa7134_go7007 *to_state(struct v4l2_subdev *sd)
{
	return container_of(sd, struct saa7134_go7007, sd);
}

static const struct go7007_board_info board_voyager = {
	.flags		 = 0,
	.sensor_flags	 = GO7007_SENSOR_656 |
				GO7007_SENSOR_VALID_ENABLE |
				GO7007_SENSOR_TV |
				GO7007_SENSOR_VBI,
	.audio_flags	= GO7007_AUDIO_I2S_MODE_1 |
				GO7007_AUDIO_WORD_16,
	.audio_rate	 = 48000,
	.audio_bclk_div	 = 8,
	.audio_main_div	 = 2,
	.hpi_buffer_cap  = 7,
	.num_inputs	 = 1,
	.inputs		 = {
		{
			.name		= "SAA7134",
		},
	},
};

/********************* Driver for GPIO HPI interface *********************/

static int gpio_write(struct saa7134_dev *dev, u8 addr, u16 data)
{
	saa_writeb(SAA7134_GPIO_GPMODE0, 0xff);

	/* Write HPI address */
	saa_writeb(SAA7134_GPIO_GPSTATUS0, addr);
	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_ADDR);
	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);

	/* Write low byte */
	saa_writeb(SAA7134_GPIO_GPSTATUS0, data & 0xff);
	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_WRITE);
	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);

	/* Write high byte */
	saa_writeb(SAA7134_GPIO_GPSTATUS0, data >> 8);
	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_WRITE);
	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);

	return 0;
}

static int gpio_read(struct saa7134_dev *dev, u8 addr, u16 *data)
{
	saa_writeb(SAA7134_GPIO_GPMODE0, 0xff);

	/* Write HPI address */
	saa_writeb(SAA7134_GPIO_GPSTATUS0, addr);
	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_ADDR);
	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);

	saa_writeb(SAA7134_GPIO_GPMODE0, 0x00);

	/* Read low byte */
	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_READ);
	saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
	saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
	*data = saa_readb(SAA7134_GPIO_GPSTATUS0);
	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);

	/* Read high byte */
	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_READ);
	saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
	saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
	*data |= saa_readb(SAA7134_GPIO_GPSTATUS0) << 8;
	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);

	return 0;
}

static int saa7134_go7007_interface_reset(struct go7007 *go)
{
	struct saa7134_go7007 *saa = go->hpi_context;
	struct saa7134_dev *dev = saa->dev;
	u16 intr_val, intr_data;
	int count = 20;

	saa_clearb(SAA7134_TS_PARALLEL, 0x80); /* Disable TS interface */
	saa_writeb(SAA7134_GPIO_GPMODE2, 0xa4);
	saa_writeb(SAA7134_GPIO_GPMODE0, 0xff);

	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ1);
	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_RESET);
	msleep(1);
	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ1);
	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ2);
	msleep(10);

	saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
	saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);

	saa_readb(SAA7134_GPIO_GPSTATUS2);
	/*pr_debug("status is %s\n", saa_readb(SAA7134_GPIO_GPSTATUS2) & 0x40 ? "OK" : "not OK"); */

	/* enter command mode...(?) */
	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ1);
	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ2);

	do {
		saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
		saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
		saa_readb(SAA7134_GPIO_GPSTATUS2);
		/*pr_info("gpio is %08x\n", saa_readl(SAA7134_GPIO_GPSTATUS0 >> 2)); */
	} while (--count > 0);

	/* Wait for an interrupt to indicate successful hardware reset */
	if (go7007_read_interrupt(go, &intr_val, &intr_data) < 0 ||
			(intr_val & ~0x1) != 0x55aa) {
		pr_err("saa7134-go7007: unable to reset the GO7007\n");
		return -1;
	}
	return 0;
}

static int saa7134_go7007_write_interrupt(struct go7007 *go, int addr, int data)
{
	struct saa7134_go7007 *saa = go->hpi_context;
	struct saa7134_dev *dev = saa->dev;
	int i;
	u16 status_reg;

#ifdef GO7007_HPI_DEBUG
	pr_debug("saa7134-go7007: WriteInterrupt: %04x %04x\n", addr, data);
#endif

	for (i = 0; i < 100; ++i) {
		gpio_read(dev, HPI_ADDR_INTR_STATUS, &status_reg);
		if (!(status_reg & 0x0010))
			break;
		msleep(10);
	}
	if (i == 100) {
		pr_err("saa7134-go7007: device is hung, status reg = 0x%04x\n",
			status_reg);
		return -1;
	}
	gpio_write(dev, HPI_ADDR_INTR_WR_PARAM, data);
	gpio_write(dev, HPI_ADDR_INTR_WR_INDEX, addr);

	return 0;
}

static int saa7134_go7007_read_interrupt(struct go7007 *go)
{
	struct saa7134_go7007 *saa = go->hpi_context;
	struct saa7134_dev *dev = saa->dev;

	/* XXX we need to wait if there is no interrupt available */
	go->interrupt_available = 1;
	gpio_read(dev, HPI_ADDR_INTR_RET_VALUE, &go->interrupt_value);
	gpio_read(dev, HPI_ADDR_INTR_RET_DATA, &go->interrupt_data);
#ifdef GO7007_HPI_DEBUG
	pr_debug("saa7134-go7007: ReadInterrupt: %04x %04x\n",
			go->interrupt_value, go->interrupt_data);
#endif
	return 0;
}

static void saa7134_go7007_irq_ts_done(struct saa7134_dev *dev,
						unsigned long status)
{
	struct go7007 *go = video_get_drvdata(dev->empress_dev);
	struct saa7134_go7007 *saa = go->hpi_context;

	if (!vb2_is_streaming(&go->vidq))
		return;
	if (0 != (status & 0x000f0000))
		pr_debug("saa7134-go7007: irq: lost %ld\n",
				(status >> 16) & 0x0f);
	if (status & 0x100000) {
		dma_sync_single_for_cpu(&dev->pci->dev,
					saa->bottom_dma, PAGE_SIZE, DMA_FROM_DEVICE);
		go7007_parse_video_stream(go, saa->bottom, PAGE_SIZE);
		saa_writel(SAA7134_RS_BA2(5), saa->bottom_dma);
	} else {
		dma_sync_single_for_cpu(&dev->pci->dev,
					saa->top_dma, PAGE_SIZE, DMA_FROM_DEVICE);
		go7007_parse_video_stream(go, saa->top, PAGE_SIZE);
		saa_writel(SAA7134_RS_BA1(5), saa->top_dma);
	}
}

static int saa7134_go7007_stream_start(struct go7007 *go)
{
	struct saa7134_go7007 *saa = go->hpi_context;
	struct saa7134_dev *dev = saa->dev;

	saa->top_dma = dma_map_page(&dev->pci->dev, virt_to_page(saa->top),
			0, PAGE_SIZE, DMA_FROM_DEVICE);
	if (dma_mapping_error(&dev->pci->dev, saa->top_dma))
		return -ENOMEM;
	saa->bottom_dma = dma_map_page(&dev->pci->dev,
			virt_to_page(saa->bottom),
			0, PAGE_SIZE, DMA_FROM_DEVICE);
	if (dma_mapping_error(&dev->pci->dev, saa->bottom_dma)) {
		dma_unmap_page(&dev->pci->dev, saa->top_dma, PAGE_SIZE,
				DMA_FROM_DEVICE);
		return -ENOMEM;
	}

	saa_writel(SAA7134_VIDEO_PORT_CTRL0 >> 2, 0xA300B000);
	saa_writel(SAA7134_VIDEO_PORT_CTRL4 >> 2, 0x40000200);

	/* Set HPI interface for video */
	saa_writeb(SAA7134_GPIO_GPMODE0, 0xff);
	saa_writeb(SAA7134_GPIO_GPSTATUS0, HPI_ADDR_VIDEO_BUFFER);
	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_ADDR);
	saa_writeb(SAA7134_GPIO_GPMODE0, 0x00);

	/* Enable TS interface */
	saa_writeb(SAA7134_TS_PARALLEL, 0xe6);

	/* Reset TS interface */
	saa_setb(SAA7134_TS_SERIAL1, 0x01);
	saa_clearb(SAA7134_TS_SERIAL1, 0x01);

	/* Set up transfer block size */
	saa_writeb(SAA7134_TS_PARALLEL_SERIAL, 128 - 1);
	saa_writeb(SAA7134_TS_DMA0, ((PAGE_SIZE >> 7) - 1) & 0xff);
	saa_writeb(SAA7134_TS_DMA1, (PAGE_SIZE >> 15) & 0xff);
	saa_writeb(SAA7134_TS_DMA2, (PAGE_SIZE >> 31) & 0x3f);

	/* Enable video streaming mode */
	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_VIDEO);

	saa_writel(SAA7134_RS_BA1(5), saa->top_dma);
	saa_writel(SAA7134_RS_BA2(5), saa->bottom_dma);
	saa_writel(SAA7134_RS_PITCH(5), 128);
	saa_writel(SAA7134_RS_CONTROL(5), SAA7134_RS_CONTROL_BURST_MAX);

	/* Enable TS FIFO */
	saa_setl(SAA7134_MAIN_CTRL, SAA7134_MAIN_CTRL_TE5);

	/* Enable DMA IRQ */
	saa_setl(SAA7134_IRQ1,
			SAA7134_IRQ1_INTE_RA2_1 | SAA7134_IRQ1_INTE_RA2_0);

	return 0;
}

static int saa7134_go7007_stream_stop(struct go7007 *go)
{
	struct saa7134_go7007 *saa = go->hpi_context;
	struct saa7134_dev *dev;

	if (!saa)
		return -EINVAL;
	dev = saa->dev;
	if (!dev)
		return -EINVAL;

	/* Shut down TS FIFO */
	saa_clearl(SAA7134_MAIN_CTRL, SAA7134_MAIN_CTRL_TE5);

	/* Disable DMA IRQ */
	saa_clearl(SAA7134_IRQ1,
			SAA7134_IRQ1_INTE_RA2_1 | SAA7134_IRQ1_INTE_RA2_0);

	/* Disable TS interface */
	saa_clearb(SAA7134_TS_PARALLEL, 0x80);

	dma_unmap_page(&dev->pci->dev, saa->top_dma, PAGE_SIZE,
			DMA_FROM_DEVICE);
	dma_unmap_page(&dev->pci->dev, saa->bottom_dma, PAGE_SIZE,
			DMA_FROM_DEVICE);

	return 0;
}

static int saa7134_go7007_send_firmware(struct go7007 *go, u8 *data, int len)
{
	struct saa7134_go7007 *saa = go->hpi_context;
	struct saa7134_dev *dev = saa->dev;
	u16 status_reg;
	int i;

#ifdef GO7007_HPI_DEBUG
	pr_debug("saa7134-go7007: DownloadBuffer sending %d bytes\n", len);
#endif

	while (len > 0) {
		i = len > 64 ? 64 : len;
		saa_writeb(SAA7134_GPIO_GPMODE0, 0xff);
		saa_writeb(SAA7134_GPIO_GPSTATUS0, HPI_ADDR_INIT_BUFFER);
		saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_ADDR);
		saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);
		while (i-- > 0) {
			saa_writeb(SAA7134_GPIO_GPSTATUS0, *data);
			saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_WRITE);
			saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);
			++data;
			--len;
		}
		for (i = 0; i < 100; ++i) {
			gpio_read(dev, HPI_ADDR_INTR_STATUS, &status_reg);
			if (!(status_reg & 0x0002))
				break;
		}
		if (i == 100) {
			pr_err("saa7134-go7007: device is hung, status reg = 0x%04x\n",
			       status_reg);
			return -1;
		}
	}
	return 0;
}

static const struct go7007_hpi_ops saa7134_go7007_hpi_ops = {
	.interface_reset	= saa7134_go7007_interface_reset,
	.write_interrupt	= saa7134_go7007_write_interrupt,
	.read_interrupt		= saa7134_go7007_read_interrupt,
	.stream_start		= saa7134_go7007_stream_start,
	.stream_stop		= saa7134_go7007_stream_stop,
	.send_firmware		= saa7134_go7007_send_firmware,
};
MODULE_FIRMWARE("go7007/go7007tv.bin");

/* --------------------------------------------------------------------------*/

static int saa7134_go7007_s_std(struct v4l2_subdev *sd, v4l2_std_id norm)
{
#if 0
	struct saa7134_go7007 *saa = to_state(sd);
	struct saa7134_dev *dev = saa->dev;

	return saa7134_s_std_internal(dev, NULL, norm);
#else
	return 0;
#endif
}

static const struct v4l2_subdev_video_ops saa7134_go7007_video_ops = {
	.s_std = saa7134_go7007_s_std,
};

static const struct v4l2_subdev_ops saa7134_go7007_sd_ops = {
	.video = &saa7134_go7007_video_ops,
};

/* --------------------------------------------------------------------------*/


/********************* Add/remove functions *********************/

static int saa7134_go7007_init(struct saa7134_dev *dev)
{
	struct go7007 *go;
	struct saa7134_go7007 *saa;
	struct v4l2_subdev *sd;

	pr_debug("saa7134-go7007: probing new SAA713X board\n");

	go = go7007_alloc(&board_voyager, &dev->pci->dev);
	if (go == NULL)
		return -ENOMEM;

	saa = kzalloc(sizeof(struct saa7134_go7007), GFP_KERNEL);
	if (saa == NULL) {
		kfree(go);
		return -ENOMEM;
	}

	go->board_id = GO7007_BOARDID_PCI_VOYAGER;
	snprintf(go->bus_info, sizeof(go->bus_info), "PCI:%s", pci_name(dev->pci));
	strlcpy(go->name, saa7134_boards[dev->board].name, sizeof(go->name));
	go->hpi_ops = &saa7134_go7007_hpi_ops;
	go->hpi_context = saa;
	saa->dev = dev;

	/* Init the subdevice interface */
	sd = &saa->sd;
	v4l2_subdev_init(sd, &saa7134_go7007_sd_ops);
	v4l2_set_subdevdata(sd, saa);
	strncpy(sd->name, "saa7134-go7007", sizeof(sd->name));

	/* Allocate a couple pages for receiving the compressed stream */
	saa->top = (u8 *)get_zeroed_page(GFP_KERNEL);
	if (!saa->top)
		goto allocfail;
	saa->bottom = (u8 *)get_zeroed_page(GFP_KERNEL);
	if (!saa->bottom)
		goto allocfail;

	/* Boot the GO7007 */
	if (go7007_boot_encoder(go, go->board_info->flags &
					GO7007_BOARD_USE_ONBOARD_I2C) < 0)
		goto allocfail;

	/* Do any final GO7007 initialization, then register the
	 * V4L2 and ALSA interfaces */
	if (go7007_register_encoder(go, go->board_info->num_i2c_devs) < 0)
		goto allocfail;

	/* Register the subdevice interface with the go7007 device */
	if (v4l2_device_register_subdev(&go->v4l2_dev, sd) < 0)
		pr_info("saa7134-go7007: register subdev failed\n");

	dev->empress_dev = &go->vdev;

	go->status = STATUS_ONLINE;
	return 0;

allocfail:
	if (saa->top)
		free_page((unsigned long)saa->top);
	if (saa->bottom)
		free_page((unsigned long)saa->bottom);
	kfree(saa);
	kfree(go);
	return -ENOMEM;
}

static int saa7134_go7007_fini(struct saa7134_dev *dev)
{
	struct go7007 *go;
	struct saa7134_go7007 *saa;

	if (NULL == dev->empress_dev)
		return 0;

	go = video_get_drvdata(dev->empress_dev);
	if (go->audio_enabled)
		go7007_snd_remove(go);

	saa = go->hpi_context;
	go->status = STATUS_SHUTDOWN;
	free_page((unsigned long)saa->top);
	free_page((unsigned long)saa->bottom);
	v4l2_device_unregister_subdev(&saa->sd);
	kfree(saa);
	video_unregister_device(&go->vdev);

	v4l2_device_put(&go->v4l2_dev);
	dev->empress_dev = NULL;

	return 0;
}

static struct saa7134_mpeg_ops saa7134_go7007_ops = {
	.type          = SAA7134_MPEG_GO7007,
	.init          = saa7134_go7007_init,
	.fini          = saa7134_go7007_fini,
	.irq_ts_done   = saa7134_go7007_irq_ts_done,
};

static int __init saa7134_go7007_mod_init(void)
{
	return saa7134_ts_register(&saa7134_go7007_ops);
}

static void __exit saa7134_go7007_mod_cleanup(void)
{
	saa7134_ts_unregister(&saa7134_go7007_ops);
}

module_init(saa7134_go7007_mod_init);
module_exit(saa7134_go7007_mod_cleanup);

MODULE_LICENSE("GPL v2");
Commit	Line	Data
452015de HV	1	/*
	2	* Copyright (C) 2005-2006 Micronas USA Inc.
	3	*
	4	* This program is free software; you can redistribute it and/or modify
	5	* it under the terms of the GNU General Public License (Version 2) as
	6	* published by the Free Software Foundation.
	7	*
	8	* This program is distributed in the hope that it will be useful,
	9	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	10	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	11	* GNU General Public License for more details.
	12	*/
	13
9a12ccfc MCC	14	#include "saa7134.h"
	15	#include "saa7134-reg.h"
	16
452015de HV	17	#include <linux/module.h>
	18	#include <linux/kernel.h>
	19	#include <linux/init.h>
	20	#include <linux/spinlock.h>
	21	#include <linux/wait.h>
	22	#include <linux/list.h>
	23	#include <linux/slab.h>
	24	#include <linux/time.h>
	25	#include <linux/mm.h>
	26	#include <linux/usb.h>
	27	#include <linux/i2c.h>
	28	#include <asm/byteorder.h>
	29	#include <media/v4l2-common.h>
	30	#include <media/v4l2-device.h>
	31	#include <media/v4l2-subdev.h>
	32
452015de HV	33	#include "go7007-priv.h"
	34
	35	/#define GO7007_HPI_DEBUG/
	36
	37	enum hpi_address {
	38	HPI_ADDR_VIDEO_BUFFER = 0xe4,
	39	HPI_ADDR_INIT_BUFFER = 0xea,
	40	HPI_ADDR_INTR_RET_VALUE = 0xee,
	41	HPI_ADDR_INTR_RET_DATA = 0xec,
	42	HPI_ADDR_INTR_STATUS = 0xf4,
	43	HPI_ADDR_INTR_WR_PARAM = 0xf6,
	44	HPI_ADDR_INTR_WR_INDEX = 0xf8,
	45	};
	46
	47	enum gpio_command {
	48	GPIO_COMMAND_RESET = 0x00, /* 000b */
	49	GPIO_COMMAND_REQ1 = 0x04, /* 001b */
	50	GPIO_COMMAND_WRITE = 0x20, /* 010b */
	51	GPIO_COMMAND_REQ2 = 0x24, /* 011b */
	52	GPIO_COMMAND_READ = 0x80, /* 100b */
	53	GPIO_COMMAND_VIDEO = 0x84, /* 101b */
	54	GPIO_COMMAND_IDLE = 0xA0, /* 110b */
	55	GPIO_COMMAND_ADDR = 0xA4, /* 111b */
	56	};
	57
	58	struct saa7134_go7007 {
	59	struct v4l2_subdev sd;
	60	struct saa7134_dev *dev;
	61	u8 *top;
	62	u8 *bottom;
	63	dma_addr_t top_dma;
	64	dma_addr_t bottom_dma;
	65	};
	66
	67	static inline struct saa7134_go7007 to_state(struct v4l2_subdev sd)
	68	{
	69	return container_of(sd, struct saa7134_go7007, sd);
	70	}
	71
	72	static const struct go7007_board_info board_voyager = {
	73	.flags = 0,
	74	.sensor_flags = GO7007_SENSOR_656 \|
	75	GO7007_SENSOR_VALID_ENABLE \|
	76	GO7007_SENSOR_TV \|
	77	GO7007_SENSOR_VBI,
	78	.audio_flags = GO7007_AUDIO_I2S_MODE_1 \|
	79	GO7007_AUDIO_WORD_16,
	80	.audio_rate = 48000,
	81	.audio_bclk_div = 8,
	82	.audio_main_div = 2,
	83	.hpi_buffer_cap = 7,
	84	.num_inputs = 1,
	85	.inputs = {
	86	{
	87	.name = "SAA7134",
	88	},
	89	},
	90	};
	91
	92	/******************* Driver for GPIO HPI interface *******************/
	93
	94	static int gpio_write(struct saa7134_dev *dev, u8 addr, u16 data)
	95	{
	96	saa_writeb(SAA7134_GPIO_GPMODE0, 0xff);
97
98	/* Write HPI address */
99	saa_writeb(SAA7134_GPIO_GPSTATUS0, addr);
100	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_ADDR);
101	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);
102
103	/* Write low byte */
104	saa_writeb(SAA7134_GPIO_GPSTATUS0, data & 0xff);
105	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_WRITE);
106	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);
107
108	/* Write high byte */
109	saa_writeb(SAA7134_GPIO_GPSTATUS0, data >> 8);
110	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_WRITE);
111	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);
112
113	return 0;
114	}
115
116	static int gpio_read(struct saa7134_dev dev, u8 addr, u16 data)
117	{
118	saa_writeb(SAA7134_GPIO_GPMODE0, 0xff);
119
120	/* Write HPI address */
121	saa_writeb(SAA7134_GPIO_GPSTATUS0, addr);
122	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_ADDR);
123	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);
124
125	saa_writeb(SAA7134_GPIO_GPMODE0, 0x00);
126
127	/* Read low byte */
128	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_READ);
129	saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
130	saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
131	*data = saa_readb(SAA7134_GPIO_GPSTATUS0);
132	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);
133
134	/* Read high byte */
135	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_READ);
136	saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
137	saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
138	*data \|= saa_readb(SAA7134_GPIO_GPSTATUS0) << 8;
139	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);
140
141	return 0;
142	}
143
144	static int saa7134_go7007_interface_reset(struct go7007 *go)
145	{
146	struct saa7134_go7007 *saa = go->hpi_context;
147	struct saa7134_dev *dev = saa->dev;
452015de HV	148	u16 intr_val, intr_data;
	149	int count = 20;
	150
	151	saa_clearb(SAA7134_TS_PARALLEL, 0x80); /* Disable TS interface */
	152	saa_writeb(SAA7134_GPIO_GPMODE2, 0xa4);
	153	saa_writeb(SAA7134_GPIO_GPMODE0, 0xff);
	154
	155	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ1);
	156	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_RESET);
	157	msleep(1);
	158	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ1);
	159	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ2);
	160	msleep(10);
	161
	162	saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
	163	saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
	164
8eb988f1 MCC	165	saa_readb(SAA7134_GPIO_GPSTATUS2);
8eb988f1 MCC	166	/pr_debug("status is %s\n", saa_readb(SAA7134_GPIO_GPSTATUS2) & 0x40 ? "OK" : "not OK"); /
452015de HV	167
	168	/* enter command mode...(?) */
	169	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ1);
	170	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ2);
	171
	172	do {
	173	saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
	174	saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
8eb988f1	175	saa_readb(SAA7134_GPIO_GPSTATUS2);
452015de HV	176	/pr_info("gpio is %08x\n", saa_readl(SAA7134_GPIO_GPSTATUS0 >> 2)); /
	177	} while (--count > 0);
	178
	179	/* Wait for an interrupt to indicate successful hardware reset */
	180	if (go7007_read_interrupt(go, &intr_val, &intr_data) < 0 \|\|
	181	(intr_val & ~0x1) != 0x55aa) {
	182	pr_err("saa7134-go7007: unable to reset the GO7007\n");
	183	return -1;
	184	}
	185	return 0;
	186	}
	187
	188	static int saa7134_go7007_write_interrupt(struct go7007 *go, int addr, int data)
	189	{
	190	struct saa7134_go7007 *saa = go->hpi_context;
	191	struct saa7134_dev *dev = saa->dev;
	192	int i;
	193	u16 status_reg;
	194
	195	#ifdef GO7007_HPI_DEBUG
	196	pr_debug("saa7134-go7007: WriteInterrupt: %04x %04x\n", addr, data);
	197	#endif
	198
	199	for (i = 0; i < 100; ++i) {
	200	gpio_read(dev, HPI_ADDR_INTR_STATUS, &status_reg);
	201	if (!(status_reg & 0x0010))
	202	break;
	203	msleep(10);
	204	}
	205	if (i == 100) {
	206	pr_err("saa7134-go7007: device is hung, status reg = 0x%04x\n",
	207	status_reg);
	208	return -1;
	209	}
	210	gpio_write(dev, HPI_ADDR_INTR_WR_PARAM, data);
	211	gpio_write(dev, HPI_ADDR_INTR_WR_INDEX, addr);
	212
	213	return 0;
	214	}
	215
	216	static int saa7134_go7007_read_interrupt(struct go7007 *go)
	217	{
	218	struct saa7134_go7007 *saa = go->hpi_context;
	219	struct saa7134_dev *dev = saa->dev;
	220
	221	/* XXX we need to wait if there is no interrupt available */
	222	go->interrupt_available = 1;
	223	gpio_read(dev, HPI_ADDR_INTR_RET_VALUE, &go->interrupt_value);
	224	gpio_read(dev, HPI_ADDR_INTR_RET_DATA, &go->interrupt_data);
	225	#ifdef GO7007_HPI_DEBUG
	226	pr_debug("saa7134-go7007: ReadInterrupt: %04x %04x\n",
	227	go->interrupt_value, go->interrupt_data);
	228	#endif
	229	return 0;
	230	}
	231
	232	static void saa7134_go7007_irq_ts_done(struct saa7134_dev *dev,
	233	unsigned long status)
	234	{
	235	struct go7007 *go = video_get_drvdata(dev->empress_dev);
	236	struct saa7134_go7007 *saa = go->hpi_context;
	237
	238	if (!vb2_is_streaming(&go->vidq))
	239	return;
240	if (0 != (status & 0x000f0000))
241	pr_debug("saa7134-go7007: irq: lost %ld\n",
242	(status >> 16) & 0x0f);
243	if (status & 0x100000) {
244	dma_sync_single_for_cpu(&dev->pci->dev,
245	saa->bottom_dma, PAGE_SIZE, DMA_FROM_DEVICE);
246	go7007_parse_video_stream(go, saa->bottom, PAGE_SIZE);
23ea6ec0	247	saa_writel(SAA7134_RS_BA2(5), saa->bottom_dma);
452015de HV	248	} else {
	249	dma_sync_single_for_cpu(&dev->pci->dev,
	250	saa->top_dma, PAGE_SIZE, DMA_FROM_DEVICE);
	251	go7007_parse_video_stream(go, saa->top, PAGE_SIZE);
23ea6ec0	252	saa_writel(SAA7134_RS_BA1(5), saa->top_dma);
452015de HV	253	}
	254	}
	255
	256	static int saa7134_go7007_stream_start(struct go7007 *go)
	257	{
	258	struct saa7134_go7007 *saa = go->hpi_context;
	259	struct saa7134_dev *dev = saa->dev;
	260
	261	saa->top_dma = dma_map_page(&dev->pci->dev, virt_to_page(saa->top),
	262	0, PAGE_SIZE, DMA_FROM_DEVICE);
	263	if (dma_mapping_error(&dev->pci->dev, saa->top_dma))
	264	return -ENOMEM;
	265	saa->bottom_dma = dma_map_page(&dev->pci->dev,
	266	virt_to_page(saa->bottom),
	267	0, PAGE_SIZE, DMA_FROM_DEVICE);
	268	if (dma_mapping_error(&dev->pci->dev, saa->bottom_dma)) {
	269	dma_unmap_page(&dev->pci->dev, saa->top_dma, PAGE_SIZE,
	270	DMA_FROM_DEVICE);
	271	return -ENOMEM;
	272	}
	273
	274	saa_writel(SAA7134_VIDEO_PORT_CTRL0 >> 2, 0xA300B000);
	275	saa_writel(SAA7134_VIDEO_PORT_CTRL4 >> 2, 0x40000200);
	276
	277	/* Set HPI interface for video */
	278	saa_writeb(SAA7134_GPIO_GPMODE0, 0xff);
	279	saa_writeb(SAA7134_GPIO_GPSTATUS0, HPI_ADDR_VIDEO_BUFFER);
	280	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_ADDR);
	281	saa_writeb(SAA7134_GPIO_GPMODE0, 0x00);
	282
	283	/* Enable TS interface */
	284	saa_writeb(SAA7134_TS_PARALLEL, 0xe6);
	285
	286	/* Reset TS interface */
	287	saa_setb(SAA7134_TS_SERIAL1, 0x01);
	288	saa_clearb(SAA7134_TS_SERIAL1, 0x01);
	289
	290	/* Set up transfer block size */
	291	saa_writeb(SAA7134_TS_PARALLEL_SERIAL, 128 - 1);
816de50d MCC	292	saa_writeb(SAA7134_TS_DMA0, ((PAGE_SIZE >> 7) - 1) & 0xff);
	293	saa_writeb(SAA7134_TS_DMA1, (PAGE_SIZE >> 15) & 0xff);
	294	saa_writeb(SAA7134_TS_DMA2, (PAGE_SIZE >> 31) & 0x3f);
452015de HV	295
	296	/* Enable video streaming mode */
	297	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_VIDEO);
	298
23ea6ec0 MCC	299	saa_writel(SAA7134_RS_BA1(5), saa->top_dma);
23ea6ec0 MCC	300	saa_writel(SAA7134_RS_BA2(5), saa->bottom_dma);
452015de HV	301	saa_writel(SAA7134_RS_PITCH(5), 128);
	302	saa_writel(SAA7134_RS_CONTROL(5), SAA7134_RS_CONTROL_BURST_MAX);
	303
	304	/* Enable TS FIFO */
	305	saa_setl(SAA7134_MAIN_CTRL, SAA7134_MAIN_CTRL_TE5);
	306
	307	/* Enable DMA IRQ */
	308	saa_setl(SAA7134_IRQ1,
	309	SAA7134_IRQ1_INTE_RA2_1 \| SAA7134_IRQ1_INTE_RA2_0);
	310
	311	return 0;
	312	}
	313
	314	static int saa7134_go7007_stream_stop(struct go7007 *go)
	315	{
	316	struct saa7134_go7007 *saa = go->hpi_context;
	317	struct saa7134_dev *dev;
	318
	319	if (!saa)
	320	return -EINVAL;
	321	dev = saa->dev;
	322	if (!dev)
	323	return -EINVAL;
	324
	325	/* Shut down TS FIFO */
	326	saa_clearl(SAA7134_MAIN_CTRL, SAA7134_MAIN_CTRL_TE5);
	327
	328	/* Disable DMA IRQ */
	329	saa_clearl(SAA7134_IRQ1,
	330	SAA7134_IRQ1_INTE_RA2_1 \| SAA7134_IRQ1_INTE_RA2_0);
	331
	332	/* Disable TS interface */
	333	saa_clearb(SAA7134_TS_PARALLEL, 0x80);
	334
	335	dma_unmap_page(&dev->pci->dev, saa->top_dma, PAGE_SIZE,
	336	DMA_FROM_DEVICE);
	337	dma_unmap_page(&dev->pci->dev, saa->bottom_dma, PAGE_SIZE,
	338	DMA_FROM_DEVICE);
	339
	340	return 0;
	341	}
	342
	343	static int saa7134_go7007_send_firmware(struct go7007 go, u8 data, int len)
	344	{
	345	struct saa7134_go7007 *saa = go->hpi_context;
	346	struct saa7134_dev *dev = saa->dev;
	347	u16 status_reg;
	348	int i;
	349
	350	#ifdef GO7007_HPI_DEBUG
	351	pr_debug("saa7134-go7007: DownloadBuffer sending %d bytes\n", len);
	352	#endif
	353
	354	while (len > 0) {
	355	i = len > 64 ? 64 : len;
	356	saa_writeb(SAA7134_GPIO_GPMODE0, 0xff);
	357	saa_writeb(SAA7134_GPIO_GPSTATUS0, HPI_ADDR_INIT_BUFFER);
	358	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_ADDR);
	359	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);
	360	while (i-- > 0) {
	361	saa_writeb(SAA7134_GPIO_GPSTATUS0, *data);
	362	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_WRITE);
	363	saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);
	364	++data;
365	--len;
366	}
367	for (i = 0; i < 100; ++i) {
368	gpio_read(dev, HPI_ADDR_INTR_STATUS, &status_reg);
369	if (!(status_reg & 0x0002))
370	break;
371	}
372	if (i == 100) {
373	pr_err("saa7134-go7007: device is hung, status reg = 0x%04x\n",
374	status_reg);
375	return -1;
376	}
377	}
378	return 0;
379	}
380
ff880348	381	static const struct go7007_hpi_ops saa7134_go7007_hpi_ops = {
452015de HV	382	.interface_reset = saa7134_go7007_interface_reset,
	383	.write_interrupt = saa7134_go7007_write_interrupt,
	384	.read_interrupt = saa7134_go7007_read_interrupt,
	385	.stream_start = saa7134_go7007_stream_start,
	386	.stream_stop = saa7134_go7007_stream_stop,
	387	.send_firmware = saa7134_go7007_send_firmware,
	388	};
	389	MODULE_FIRMWARE("go7007/go7007tv.bin");
	390
	391	/* --------------------------------------------------------------------------*/
	392
	393	static int saa7134_go7007_s_std(struct v4l2_subdev *sd, v4l2_std_id norm)
	394	{
	395	#if 0
	396	struct saa7134_go7007 *saa = to_state(sd);
	397	struct saa7134_dev *dev = saa->dev;
	398
	399	return saa7134_s_std_internal(dev, NULL, norm);
	400	#else
	401	return 0;
	402	#endif
	403	}
	404
	405	static const struct v4l2_subdev_video_ops saa7134_go7007_video_ops = {
	406	.s_std = saa7134_go7007_s_std,
	407	};
	408
	409	static const struct v4l2_subdev_ops saa7134_go7007_sd_ops = {
	410	.video = &saa7134_go7007_video_ops,
	411	};
	412
	413	/* --------------------------------------------------------------------------*/
	414
	415
	416	/******************* Add/remove functions *******************/
	417
	418	static int saa7134_go7007_init(struct saa7134_dev *dev)
	419	{
	420	struct go7007 *go;
	421	struct saa7134_go7007 *saa;
	422	struct v4l2_subdev *sd;
	423
	424	pr_debug("saa7134-go7007: probing new SAA713X board\n");
	425
	426	go = go7007_alloc(&board_voyager, &dev->pci->dev);
	427	if (go == NULL)
	428	return -ENOMEM;
	429
	430	saa = kzalloc(sizeof(struct saa7134_go7007), GFP_KERNEL);
	431	if (saa == NULL) {
	432	kfree(go);
	433	return -ENOMEM;
	434	}
	435
	436	go->board_id = GO7007_BOARDID_PCI_VOYAGER;
	437	snprintf(go->bus_info, sizeof(go->bus_info), "PCI:%s", pci_name(dev->pci));
	438	strlcpy(go->name, saa7134_boards[dev->board].name, sizeof(go->name));
	439	go->hpi_ops = &saa7134_go7007_hpi_ops;
	440	go->hpi_context = saa;
	441	saa->dev = dev;
	442
	443	/* Init the subdevice interface */
	444	sd = &saa->sd;
	445	v4l2_subdev_init(sd, &saa7134_go7007_sd_ops);
446	v4l2_set_subdevdata(sd, saa);
447	strncpy(sd->name, "saa7134-go7007", sizeof(sd->name));
448
449	/* Allocate a couple pages for receiving the compressed stream */
450	saa->top = (u8 *)get_zeroed_page(GFP_KERNEL);
451	if (!saa->top)
452	goto allocfail;
453	saa->bottom = (u8 *)get_zeroed_page(GFP_KERNEL);
454	if (!saa->bottom)
455	goto allocfail;
456
457	/* Boot the GO7007 */
458	if (go7007_boot_encoder(go, go->board_info->flags &
459	GO7007_BOARD_USE_ONBOARD_I2C) < 0)
460	goto allocfail;
461
462	/* Do any final GO7007 initialization, then register the
463	* V4L2 and ALSA interfaces */
464	if (go7007_register_encoder(go, go->board_info->num_i2c_devs) < 0)
465	goto allocfail;
466
467	/* Register the subdevice interface with the go7007 device */
468	if (v4l2_device_register_subdev(&go->v4l2_dev, sd) < 0)
469	pr_info("saa7134-go7007: register subdev failed\n");
470
471	dev->empress_dev = &go->vdev;
472
473	go->status = STATUS_ONLINE;
474	return 0;
475
476	allocfail:
477	if (saa->top)
478	free_page((unsigned long)saa->top);
479	if (saa->bottom)
480	free_page((unsigned long)saa->bottom);
481	kfree(saa);
482	kfree(go);
483	return -ENOMEM;
484	}
485
486	static int saa7134_go7007_fini(struct saa7134_dev *dev)
487	{
488	struct go7007 *go;
489	struct saa7134_go7007 *saa;
490
491	if (NULL == dev->empress_dev)
492	return 0;
493
494	go = video_get_drvdata(dev->empress_dev);
495	if (go->audio_enabled)
496	go7007_snd_remove(go);
497
498	saa = go->hpi_context;
499	go->status = STATUS_SHUTDOWN;
500	free_page((unsigned long)saa->top);
501	free_page((unsigned long)saa->bottom);
502	v4l2_device_unregister_subdev(&saa->sd);
503	kfree(saa);
504	video_unregister_device(&go->vdev);
505
506	v4l2_device_put(&go->v4l2_dev);
507	dev->empress_dev = NULL;
508
509	return 0;
510	}
511
512	static struct saa7134_mpeg_ops saa7134_go7007_ops = {
513	.type = SAA7134_MPEG_GO7007,
514	.init = saa7134_go7007_init,
515	.fini = saa7134_go7007_fini,
516	.irq_ts_done = saa7134_go7007_irq_ts_done,
517	};
518
519	static int __init saa7134_go7007_mod_init(void)
520	{
521	return saa7134_ts_register(&saa7134_go7007_ops);
522	}
523
524	static void __exit saa7134_go7007_mod_cleanup(void)
525	{
526	saa7134_ts_unregister(&saa7134_go7007_ops);
527	}
528
529	module_init(saa7134_go7007_mod_init);
530	module_exit(saa7134_go7007_mod_cleanup);
531
532	MODULE_LICENSE("GPL v2");