[deliverable/linux.git] / drivers / media / dvb / mantis / mantis_dma.c

/*
	Mantis PCI bridge driver

	Copyright (C) 2005, 2006 Manu Abraham (abraham.manu@gmail.com)

	This program is free software; you can redistribute it and/or modify
	it under the terms of the GNU General Public License as published by
	the Free Software Foundation; either version 2 of the License, or
	(at your option) any later version.

	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.

	You should have received a copy of the GNU General Public License
	along with this program; if not, write to the Free Software
	Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*/

#include <asm/page.h>
#include <linux/vmalloc.h>
#include "mantis_common.h"

#define RISC_WRITE		(0x01 << 28)
#define RISC_JUMP		(0x07 << 28)
#define RISC_IRQ		(0x01 << 24)

#define RISC_STATUS(status)	((((~status) & 0x0f) << 20) | ((status & 0x0f) << 16))
#define RISC_FLUSH()		mantis->risc_pos = 0
#define RISC_INSTR(opcode)	mantis->risc_cpu[mantis->risc_pos++] = cpu_to_le32(opcode)

#define MANTIS_BUF_SIZE		64 * 1024
#define MANTIS_BLOCK_BYTES	(MANTIS_BUF_SIZE >> 4)
#define MANTIS_BLOCK_COUNT	(1 << 4)
#define MANTIS_RISC_SIZE	PAGE_SIZE

int mantis_dma_exit(struct mantis_pci *mantis)
{
	if (mantis->buf_cpu) {
		dprintk(verbose, MANTIS_ERROR, 1,
			"DMA=0x%lx cpu=0x%p size=%d",
			(unsigned long) mantis->buf_dma,
			 mantis->buf_cpu,
			 MANTIS_BUF_SIZE);

		pci_free_consistent(mantis->pdev, MANTIS_BUF_SIZE,
				    mantis->buf_cpu, mantis->buf_dma);

		mantis->buf_cpu = NULL;
	}
	if (mantis->risc_cpu) {
		dprintk(verbose, MANTIS_ERROR, 1,
			"RISC=0x%lx cpu=0x%p size=%lx",
			(unsigned long) mantis->risc_dma,
			mantis->risc_cpu,
			MANTIS_RISC_SIZE);

		pci_free_consistent(mantis->pdev, MANTIS_RISC_SIZE,
				    mantis->risc_cpu, mantis->risc_dma);

		mantis->risc_cpu = NULL;
	}

	return 0;
}

static inline int mantis_alloc_buffers(struct mantis_pci *mantis)
{
	if (!mantis->buf_cpu) {
		mantis->buf_cpu = pci_alloc_consistent(mantis->pdev,
						       MANTIS_BUF_SIZE,
						       &mantis->buf_dma);
		if (!mantis->buf_cpu) {
			dprintk(verbose, MANTIS_ERROR, 1,
				"DMA buffer allocation failed");

			goto err;
		}
		dprintk(verbose, MANTIS_ERROR, 1,
			"DMA=0x%lx cpu=0x%p size=%d",
			(unsigned long) mantis->buf_dma,
			mantis->buf_cpu, MANTIS_BUF_SIZE);
	}
	if (!mantis->risc_cpu) {
		mantis->risc_cpu = pci_alloc_consistent(mantis->pdev,
							MANTIS_RISC_SIZE,
							&mantis->risc_dma);

		if (!mantis->risc_cpu) {
			dprintk(verbose, MANTIS_ERROR, 1,
				"RISC program allocation failed");

			mantis_dma_exit(mantis);

			goto err;
		}
		dprintk(verbose, MANTIS_ERROR, 1,
			"RISC=0x%lx cpu=0x%p size=%lx",
			(unsigned long) mantis->risc_dma,
			mantis->risc_cpu, MANTIS_RISC_SIZE);
	}

	return 0;
err:
	dprintk(verbose, MANTIS_ERROR, 1, "Out of memory (?) .....");
	return -ENOMEM;
}

static inline int mantis_calc_lines(struct mantis_pci *mantis)
{
	mantis->line_bytes = MANTIS_BLOCK_BYTES;
	mantis->line_count = MANTIS_BLOCK_COUNT;

	while (mantis->line_bytes > 4095) {
		mantis->line_bytes >>= 1;
		mantis->line_count <<= 1;
	}

	dprintk(verbose, MANTIS_DEBUG, 1,
		"Mantis RISC block bytes=[%d], line bytes=[%d], line count=[%d]",
		MANTIS_BLOCK_BYTES, mantis->line_bytes, mantis->line_count);

	if (mantis->line_count > 255) {
		dprintk(verbose, MANTIS_ERROR, 1, "Buffer size error");
		return -EINVAL;
	}

	return 0;
}

int mantis_dma_init(struct mantis_pci *mantis)
{
	int err = 0;

	dprintk(verbose, MANTIS_DEBUG, 1, "Mantis DMA init");
	if (mantis_alloc_buffers(mantis) < 0) {
		dprintk(verbose, MANTIS_ERROR, 1, "Error allocating DMA buffer");

		// Stop RISC Engine
//		mmwrite(mmread(MANTIS_DMA_CTL) & ~MANTIS_RISC_EN, MANTIS_DMA_CTL);
		mmwrite(0, MANTIS_DMA_CTL);

		goto err;
	}
	if ((err = mantis_calc_lines(mantis)) < 0) {
		dprintk(verbose, MANTIS_ERROR, 1, "Mantis calc lines failed");

		goto err;
	}

	return 0;
err:
	return err;
}

static inline void mantis_risc_program(struct mantis_pci *mantis)
{
	u32 buf_pos = 0;
	u32 line;

	dprintk(verbose, MANTIS_DEBUG, 1, "Mantis create RISC program");
	RISC_FLUSH();

	dprintk(verbose, MANTIS_DEBUG, 1, "risc len lines %u, bytes per line %u",
		mantis->line_count, mantis->line_bytes);

	for (line = 0; line < mantis->line_count; line++) {
		dprintk(verbose, MANTIS_DEBUG, 1, "RISC PROG line=[%d]", line);
		if (!(buf_pos % MANTIS_BLOCK_BYTES)) {
			RISC_INSTR(RISC_WRITE	|
				   RISC_IRQ	|
				   RISC_STATUS(((buf_pos / MANTIS_BLOCK_BYTES) +
				   (MANTIS_BLOCK_COUNT - 1)) %
				    MANTIS_BLOCK_COUNT) |
				    mantis->line_bytes);
		} else {
			RISC_INSTR(RISC_WRITE	| mantis->line_bytes);
		}
		RISC_INSTR(mantis->buf_dma + buf_pos);
		buf_pos += mantis->line_bytes;
	}
	RISC_INSTR(RISC_JUMP);
	RISC_INSTR(mantis->risc_dma);
}

void mantis_dma_start(struct mantis_pci *mantis)
{
	dprintk(verbose, MANTIS_DEBUG, 1, "Mantis Start DMA engine");

	mantis_risc_program(mantis);
	mmwrite(mantis->risc_dma, MANTIS_RISC_START);
	mmwrite(mmread(MANTIS_GPIF_HIFADDR) | MANTIS_GPIF_HIFRDWRN, MANTIS_GPIF_HIFADDR);

	mmwrite(0, MANTIS_DMA_CTL);
	mantis->last_block = mantis->finished_block = 0;

	mmwrite(mmread(MANTIS_INT_MASK) | MANTIS_INT_RISCI, MANTIS_INT_MASK);

	mmwrite(MANTIS_FIFO_EN | MANTIS_DCAP_EN
			       | MANTIS_RISC_EN, MANTIS_DMA_CTL);

}

void mantis_dma_stop(struct mantis_pci *mantis)
{
	u32 stat = 0, mask = 0;

	stat = mmread(MANTIS_INT_STAT);
	mask = mmread(MANTIS_INT_MASK);
	dprintk(verbose, MANTIS_DEBUG, 1, "Mantis Stop DMA engine");

	mmwrite((mmread(MANTIS_GPIF_HIFADDR) & (~(MANTIS_GPIF_HIFRDWRN))), MANTIS_GPIF_HIFADDR);

	mmwrite((mmread(MANTIS_DMA_CTL) & ~(MANTIS_FIFO_EN |
					    MANTIS_DCAP_EN |
					    MANTIS_RISC_EN)), MANTIS_DMA_CTL);

	mmwrite(mmread(MANTIS_INT_STAT), MANTIS_INT_STAT);

	mmwrite(mmread(MANTIS_INT_MASK) & ~(MANTIS_INT_RISCI |
					    MANTIS_INT_RISCEN), MANTIS_INT_MASK);
}


void mantis_dma_xfer(unsigned long data)
{
	struct mantis_pci *mantis = (struct mantis_pci *) data;
	struct mantis_hwconfig *config = mantis->hwconfig;

	while (mantis->last_block != mantis->finished_block) {
		dprintk(verbose, MANTIS_DEBUG, 1, "last block=[%d] finished block=[%d]",
			mantis->last_block, mantis->finished_block);

		(config->ts_size ? dvb_dmx_swfilter_204: dvb_dmx_swfilter)
		(&mantis->demux, &mantis->buf_cpu[mantis->last_block * MANTIS_BLOCK_BYTES], MANTIS_BLOCK_BYTES);
		mantis->last_block = (mantis->last_block + 1) % MANTIS_BLOCK_COUNT;
	}
}
Commit	Line	Data
41e840b1 MA	1	/*
	2	Mantis PCI bridge driver
	3
	4	Copyright (C) 2005, 2006 Manu Abraham (abraham.manu@gmail.com)
	5
	6	This program is free software; you can redistribute it and/or modify
	7	it under the terms of the GNU General Public License as published by
	8	the Free Software Foundation; either version 2 of the License, or
	9	(at your option) any later version.
	10
	11	This program is distributed in the hope that it will be useful,
	12	but WITHOUT ANY WARRANTY; without even the implied warranty of
	13	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	14	GNU General Public License for more details.
	15
	16	You should have received a copy of the GNU General Public License
	17	along with this program; if not, write to the Free Software
	18	Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
	19	*/
	20
	21	#include <asm/page.h>
	22	#include <linux/vmalloc.h>
	23	#include "mantis_common.h"
	24
	25	#define RISC_WRITE (0x01 << 28)
	26	#define RISC_JUMP (0x07 << 28)
	27	#define RISC_IRQ (0x01 << 24)
	28
	29	#define RISC_STATUS(status) ((((~status) & 0x0f) << 20) \| ((status & 0x0f) << 16))
	30	#define RISC_FLUSH() mantis->risc_pos = 0
	31	#define RISC_INSTR(opcode) mantis->risc_cpu[mantis->risc_pos++] = cpu_to_le32(opcode)
	32
	33	#define MANTIS_BUF_SIZE 64 * 1024
	34	#define MANTIS_BLOCK_BYTES (MANTIS_BUF_SIZE >> 4)
	35	#define MANTIS_BLOCK_COUNT (1 << 4)
	36	#define MANTIS_RISC_SIZE PAGE_SIZE
	37
	38	int mantis_dma_exit(struct mantis_pci *mantis)
	39	{
	40	if (mantis->buf_cpu) {
	41	dprintk(verbose, MANTIS_ERROR, 1,
	42	"DMA=0x%lx cpu=0x%p size=%d",
	43	(unsigned long) mantis->buf_dma,
	44	mantis->buf_cpu,
	45	MANTIS_BUF_SIZE);
	46
	47	pci_free_consistent(mantis->pdev, MANTIS_BUF_SIZE,
	48	mantis->buf_cpu, mantis->buf_dma);
	49
	50	mantis->buf_cpu = NULL;
	51	}
	52	if (mantis->risc_cpu) {
	53	dprintk(verbose, MANTIS_ERROR, 1,
	54	"RISC=0x%lx cpu=0x%p size=%lx",
	55	(unsigned long) mantis->risc_dma,
	56	mantis->risc_cpu,
	57	MANTIS_RISC_SIZE);
	58
	59	pci_free_consistent(mantis->pdev, MANTIS_RISC_SIZE,
	60	mantis->risc_cpu, mantis->risc_dma);
	61
	62	mantis->risc_cpu = NULL;
	63	}
	64
65	return 0;
66	}
67
68	static inline int mantis_alloc_buffers(struct mantis_pci *mantis)
69	{
70	if (!mantis->buf_cpu) {
71	mantis->buf_cpu = pci_alloc_consistent(mantis->pdev,
72	MANTIS_BUF_SIZE,
73	&mantis->buf_dma);
74	if (!mantis->buf_cpu) {
75	dprintk(verbose, MANTIS_ERROR, 1,
76	"DMA buffer allocation failed");
77
78	goto err;
79	}
80	dprintk(verbose, MANTIS_ERROR, 1,
81	"DMA=0x%lx cpu=0x%p size=%d",
82	(unsigned long) mantis->buf_dma,
83	mantis->buf_cpu, MANTIS_BUF_SIZE);
84	}
85	if (!mantis->risc_cpu) {
86	mantis->risc_cpu = pci_alloc_consistent(mantis->pdev,
87	MANTIS_RISC_SIZE,
88	&mantis->risc_dma);
89
90	if (!mantis->risc_cpu) {
91	dprintk(verbose, MANTIS_ERROR, 1,
92	"RISC program allocation failed");
93
94	mantis_dma_exit(mantis);
95
96	goto err;
97	}
98	dprintk(verbose, MANTIS_ERROR, 1,
99	"RISC=0x%lx cpu=0x%p size=%lx",
100	(unsigned long) mantis->risc_dma,
101	mantis->risc_cpu, MANTIS_RISC_SIZE);
102	}
103
104	return 0;
105	err:
106	dprintk(verbose, MANTIS_ERROR, 1, "Out of memory (?) .....");
107	return -ENOMEM;
108	}
109
110	static inline int mantis_calc_lines(struct mantis_pci *mantis)
111	{
112	mantis->line_bytes = MANTIS_BLOCK_BYTES;
113	mantis->line_count = MANTIS_BLOCK_COUNT;
114
115	while (mantis->line_bytes > 4095) {
116	mantis->line_bytes >>= 1;
117	mantis->line_count <<= 1;
118	}
119
120	dprintk(verbose, MANTIS_DEBUG, 1,
121	"Mantis RISC block bytes=[%d], line bytes=[%d], line count=[%d]",
122	MANTIS_BLOCK_BYTES, mantis->line_bytes, mantis->line_count);
123
124	if (mantis->line_count > 255) {
125	dprintk(verbose, MANTIS_ERROR, 1, "Buffer size error");
126	return -EINVAL;
127	}
128
129	return 0;
130	}
131
132	int mantis_dma_init(struct mantis_pci *mantis)
133	{
134	int err = 0;
135
136	dprintk(verbose, MANTIS_DEBUG, 1, "Mantis DMA init");
137	if (mantis_alloc_buffers(mantis) < 0) {
138	dprintk(verbose, MANTIS_ERROR, 1, "Error allocating DMA buffer");
139
140	// Stop RISC Engine
141	// mmwrite(mmread(MANTIS_DMA_CTL) & ~MANTIS_RISC_EN, MANTIS_DMA_CTL);
142	mmwrite(0, MANTIS_DMA_CTL);
143
144	goto err;
145	}
146	if ((err = mantis_calc_lines(mantis)) < 0) {
147	dprintk(verbose, MANTIS_ERROR, 1, "Mantis calc lines failed");
148
149	goto err;
150	}
151
152	return 0;
153	err:
154	return err;
155	}
156
41e840b1 MA	157	static inline void mantis_risc_program(struct mantis_pci *mantis)
	158	{
	159	u32 buf_pos = 0;
	160	u32 line;
	161
	162	dprintk(verbose, MANTIS_DEBUG, 1, "Mantis create RISC program");
	163	RISC_FLUSH();
	164
	165	dprintk(verbose, MANTIS_DEBUG, 1, "risc len lines %u, bytes per line %u",
	166	mantis->line_count, mantis->line_bytes);
	167
	168	for (line = 0; line < mantis->line_count; line++) {
	169	dprintk(verbose, MANTIS_DEBUG, 1, "RISC PROG line=[%d]", line);
	170	if (!(buf_pos % MANTIS_BLOCK_BYTES)) {
	171	RISC_INSTR(RISC_WRITE \|
	172	RISC_IRQ \|
	173	RISC_STATUS(((buf_pos / MANTIS_BLOCK_BYTES) +
	174	(MANTIS_BLOCK_COUNT - 1)) %
	175	MANTIS_BLOCK_COUNT) \|
	176	mantis->line_bytes);
	177	} else {
	178	RISC_INSTR(RISC_WRITE \| mantis->line_bytes);
	179	}
	180	RISC_INSTR(mantis->buf_dma + buf_pos);
	181	buf_pos += mantis->line_bytes;
	182	}
	183	RISC_INSTR(RISC_JUMP);
	184	RISC_INSTR(mantis->risc_dma);
	185	}
	186
	187	void mantis_dma_start(struct mantis_pci *mantis)
	188	{
	189	dprintk(verbose, MANTIS_DEBUG, 1, "Mantis Start DMA engine");
	190
	191	mantis_risc_program(mantis);
41703684	192	mmwrite(mantis->risc_dma, MANTIS_RISC_START);
d8b14f8a	193	mmwrite(mmread(MANTIS_GPIF_HIFADDR) \| MANTIS_GPIF_HIFRDWRN, MANTIS_GPIF_HIFADDR);
41e840b1 MA	194
	195	mmwrite(0, MANTIS_DMA_CTL);
	196	mantis->last_block = mantis->finished_block = 0;
	197
	198	mmwrite(mmread(MANTIS_INT_MASK) \| MANTIS_INT_RISCI, MANTIS_INT_MASK);
	199
	200	mmwrite(MANTIS_FIFO_EN \| MANTIS_DCAP_EN
	201	\| MANTIS_RISC_EN, MANTIS_DMA_CTL);
	202
	203	}
	204
	205	void mantis_dma_stop(struct mantis_pci *mantis)
	206	{
	207	u32 stat = 0, mask = 0;
	208
	209	stat = mmread(MANTIS_INT_STAT);
	210	mask = mmread(MANTIS_INT_MASK);
	211	dprintk(verbose, MANTIS_DEBUG, 1, "Mantis Stop DMA engine");
	212
d8b14f8a	213	mmwrite((mmread(MANTIS_GPIF_HIFADDR) & (~(MANTIS_GPIF_HIFRDWRN))), MANTIS_GPIF_HIFADDR);
e4deee04	214
41e840b1 MA	215	mmwrite((mmread(MANTIS_DMA_CTL) & ~(MANTIS_FIFO_EN \|
	216	MANTIS_DCAP_EN \|
	217	MANTIS_RISC_EN)), MANTIS_DMA_CTL);
	218
	219	mmwrite(mmread(MANTIS_INT_STAT), MANTIS_INT_STAT);
	220
	221	mmwrite(mmread(MANTIS_INT_MASK) & ~(MANTIS_INT_RISCI \|
	222	MANTIS_INT_RISCEN), MANTIS_INT_MASK);
	223	}
	224
	225
	226	void mantis_dma_xfer(unsigned long data)
	227	{
	228	struct mantis_pci mantis = (struct mantis_pci ) data;
33c79630	229	struct mantis_hwconfig *config = mantis->hwconfig;
41e840b1 MA	230
	231	while (mantis->last_block != mantis->finished_block) {
	232	dprintk(verbose, MANTIS_DEBUG, 1, "last block=[%d] finished block=[%d]",
	233	mantis->last_block, mantis->finished_block);
	234
33c79630	235	(config->ts_size ? dvb_dmx_swfilter_204: dvb_dmx_swfilter)
41e840b1 MA	236	(&mantis->demux, &mantis->buf_cpu[mantis->last_block * MANTIS_BLOCK_BYTES], MANTIS_BLOCK_BYTES);
	237	mantis->last_block = (mantis->last_block + 1) % MANTIS_BLOCK_COUNT;
	238	}
	239	}