1
2
3
4
5
6
7
8
9#include <linux/kernel.h>
10#include <asm/page.h>
11#include <linux/vmalloc.h>
12#include <linux/pci.h>
13
14#include <asm/irq.h>
15#include <linux/signal.h>
16#include <linux/sched.h>
17#include <linux/interrupt.h>
18
19#include <media/dmxdev.h>
20#include <media/dvbdev.h>
21#include <media/dvb_demux.h>
22#include <media/dvb_frontend.h>
23#include <media/dvb_net.h>
24
25#include "mantis_common.h"
26#include "mantis_reg.h"
27#include "mantis_dma.h"
28
29#define RISC_WRITE (0x01 << 28)
30#define RISC_JUMP (0x07 << 28)
31#define RISC_IRQ (0x01 << 24)
32
33#define RISC_STATUS(status) ((((~status) & 0x0f) << 20) | ((status & 0x0f) << 16))
34#define RISC_FLUSH(risc_pos) (risc_pos = 0)
35#define RISC_INSTR(risc_pos, opcode) (mantis->risc_cpu[risc_pos++] = cpu_to_le32(opcode))
36
37#define MANTIS_BUF_SIZE (64 * 1024)
38#define MANTIS_BLOCK_BYTES (MANTIS_BUF_SIZE / 4)
39#define MANTIS_DMA_TR_BYTES (2 * 1024)
40#define MANTIS_BLOCK_COUNT (MANTIS_BUF_SIZE / MANTIS_BLOCK_BYTES)
41
42#define MANTIS_DMA_TR_UNITS (MANTIS_BLOCK_BYTES / MANTIS_DMA_TR_BYTES)
43
44#define MANTIS_RISC_SIZE PAGE_SIZE
45
46int mantis_dma_exit(struct mantis_pci *mantis)
47{
48 if (mantis->buf_cpu) {
49 dprintk(MANTIS_ERROR, 1,
50 "DMA=0x%lx cpu=0x%p size=%d",
51 (unsigned long) mantis->buf_dma,
52 mantis->buf_cpu,
53 MANTIS_BUF_SIZE);
54
55 pci_free_consistent(mantis->pdev, MANTIS_BUF_SIZE,
56 mantis->buf_cpu, mantis->buf_dma);
57
58 mantis->buf_cpu = NULL;
59 }
60 if (mantis->risc_cpu) {
61 dprintk(MANTIS_ERROR, 1,
62 "RISC=0x%lx cpu=0x%p size=%lx",
63 (unsigned long) mantis->risc_dma,
64 mantis->risc_cpu,
65 MANTIS_RISC_SIZE);
66
67 pci_free_consistent(mantis->pdev, MANTIS_RISC_SIZE,
68 mantis->risc_cpu, mantis->risc_dma);
69
70 mantis->risc_cpu = NULL;
71 }
72
73 return 0;
74}
75EXPORT_SYMBOL_GPL(mantis_dma_exit);
76
77static inline int mantis_alloc_buffers(struct mantis_pci *mantis)
78{
79 if (!mantis->buf_cpu) {
80 mantis->buf_cpu = pci_alloc_consistent(mantis->pdev,
81 MANTIS_BUF_SIZE,
82 &mantis->buf_dma);
83 if (!mantis->buf_cpu) {
84 dprintk(MANTIS_ERROR, 1,
85 "DMA buffer allocation failed");
86
87 goto err;
88 }
89 dprintk(MANTIS_ERROR, 1,
90 "DMA=0x%lx cpu=0x%p size=%d",
91 (unsigned long) mantis->buf_dma,
92 mantis->buf_cpu, MANTIS_BUF_SIZE);
93 }
94 if (!mantis->risc_cpu) {
95 mantis->risc_cpu = pci_alloc_consistent(mantis->pdev,
96 MANTIS_RISC_SIZE,
97 &mantis->risc_dma);
98
99 if (!mantis->risc_cpu) {
100 dprintk(MANTIS_ERROR, 1,
101 "RISC program allocation failed");
102
103 mantis_dma_exit(mantis);
104
105 goto err;
106 }
107 dprintk(MANTIS_ERROR, 1,
108 "RISC=0x%lx cpu=0x%p size=%lx",
109 (unsigned long) mantis->risc_dma,
110 mantis->risc_cpu, MANTIS_RISC_SIZE);
111 }
112
113 return 0;
114err:
115 dprintk(MANTIS_ERROR, 1, "Out of memory (?) .....");
116 return -ENOMEM;
117}
118
119int mantis_dma_init(struct mantis_pci *mantis)
120{
121 int err;
122
123 dprintk(MANTIS_DEBUG, 1, "Mantis DMA init");
124 err = mantis_alloc_buffers(mantis);
125 if (err < 0) {
126 dprintk(MANTIS_ERROR, 1, "Error allocating DMA buffer");
127
128
129 mmwrite(0, MANTIS_DMA_CTL);
130
131 return err;
132 }
133
134 return 0;
135}
136EXPORT_SYMBOL_GPL(mantis_dma_init);
137
138static inline void mantis_risc_program(struct mantis_pci *mantis)
139{
140 u32 buf_pos = 0;
141 u32 line, step;
142 u32 risc_pos;
143
144 dprintk(MANTIS_DEBUG, 1, "Mantis create RISC program");
145 RISC_FLUSH(risc_pos);
146
147 dprintk(MANTIS_DEBUG, 1, "risc len lines %u, bytes per line %u, bytes per DMA tr %u",
148 MANTIS_BLOCK_COUNT, MANTIS_BLOCK_BYTES, MANTIS_DMA_TR_BYTES);
149
150 for (line = 0; line < MANTIS_BLOCK_COUNT; line++) {
151 for (step = 0; step < MANTIS_DMA_TR_UNITS; step++) {
152 dprintk(MANTIS_DEBUG, 1, "RISC PROG line=[%d], step=[%d]", line, step);
153 if (step == 0) {
154 RISC_INSTR(risc_pos, RISC_WRITE |
155 RISC_IRQ |
156 RISC_STATUS(line) |
157 MANTIS_DMA_TR_BYTES);
158 } else {
159 RISC_INSTR(risc_pos, RISC_WRITE | MANTIS_DMA_TR_BYTES);
160 }
161 RISC_INSTR(risc_pos, mantis->buf_dma + buf_pos);
162 buf_pos += MANTIS_DMA_TR_BYTES;
163 }
164 }
165 RISC_INSTR(risc_pos, RISC_JUMP);
166 RISC_INSTR(risc_pos, mantis->risc_dma);
167}
168
169void mantis_dma_start(struct mantis_pci *mantis)
170{
171 dprintk(MANTIS_DEBUG, 1, "Mantis Start DMA engine");
172
173 mantis_risc_program(mantis);
174 mmwrite(mantis->risc_dma, MANTIS_RISC_START);
175 mmwrite(mmread(MANTIS_GPIF_ADDR) | MANTIS_GPIF_HIFRDWRN, MANTIS_GPIF_ADDR);
176
177 mmwrite(0, MANTIS_DMA_CTL);
178 mantis->last_block = mantis->busy_block = 0;
179
180 mantis_unmask_ints(mantis, MANTIS_INT_RISCI);
181
182 mmwrite(MANTIS_FIFO_EN | MANTIS_DCAP_EN
183 | MANTIS_RISC_EN, MANTIS_DMA_CTL);
184
185}
186
187void mantis_dma_stop(struct mantis_pci *mantis)
188{
189 dprintk(MANTIS_DEBUG, 1, "Mantis Stop DMA engine");
190
191 mmwrite((mmread(MANTIS_GPIF_ADDR) & (~(MANTIS_GPIF_HIFRDWRN))), MANTIS_GPIF_ADDR);
192
193 mmwrite((mmread(MANTIS_DMA_CTL) & ~(MANTIS_FIFO_EN |
194 MANTIS_DCAP_EN |
195 MANTIS_RISC_EN)), MANTIS_DMA_CTL);
196
197 mmwrite(mmread(MANTIS_INT_STAT), MANTIS_INT_STAT);
198
199 mantis_mask_ints(mantis, MANTIS_INT_RISCI | MANTIS_INT_RISCEN);
200}
201
202
203void mantis_dma_xfer(unsigned long data)
204{
205 struct mantis_pci *mantis = (struct mantis_pci *) data;
206 struct mantis_hwconfig *config = mantis->hwconfig;
207
208 while (mantis->last_block != mantis->busy_block) {
209 dprintk(MANTIS_DEBUG, 1, "last block=[%d] finished block=[%d]",
210 mantis->last_block, mantis->busy_block);
211
212 (config->ts_size ? dvb_dmx_swfilter_204 : dvb_dmx_swfilter)
213 (&mantis->demux, &mantis->buf_cpu[mantis->last_block * MANTIS_BLOCK_BYTES], MANTIS_BLOCK_BYTES);
214 mantis->last_block = (mantis->last_block + 1) % MANTIS_BLOCK_COUNT;
215 }
216}
217
