217 lines · c
1// SPDX-License-Identifier: GPL-2.0-or-later2/*3 Mantis PCI bridge driver4 5 Copyright (C) Manu Abraham (abraham.manu@gmail.com)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) /* upper limit: 4095 bytes. */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/* MANTIS_BUF_SIZE / MANTIS_DMA_TR_UNITS must not exceed MANTIS_RISC_SIZE (4k RISC cmd buffer) */44#define MANTIS_RISC_SIZE PAGE_SIZE /* RISC program must fit here. */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 dma_free_coherent(&mantis->pdev->dev, 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 dma_free_coherent(&mantis->pdev->dev, 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 = dma_alloc_coherent(&mantis->pdev->dev,81 MANTIS_BUF_SIZE,82 &mantis->buf_dma, GFP_KERNEL);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 = dma_alloc_coherent(&mantis->pdev->dev,96 MANTIS_RISC_SIZE,97 &mantis->risc_dma, GFP_KERNEL);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 /* Stop RISC Engine */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_EN183 | 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(struct work_struct *t)204{205 struct mantis_pci *mantis = from_work(mantis, t, bh_work);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