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