diff options
Diffstat (limited to 'drivers/staging/comedi/drivers/mite.c')
-rw-r--r-- | drivers/staging/comedi/drivers/mite.c | 938 |
1 files changed, 0 insertions, 938 deletions
diff --git a/drivers/staging/comedi/drivers/mite.c b/drivers/staging/comedi/drivers/mite.c deleted file mode 100644 index 70960e3ba878..000000000000 --- a/drivers/staging/comedi/drivers/mite.c +++ /dev/null @@ -1,938 +0,0 @@ -// SPDX-License-Identifier: GPL-2.0+ -/* - * comedi/drivers/mite.c - * Hardware driver for NI Mite PCI interface chip - * - * COMEDI - Linux Control and Measurement Device Interface - * Copyright (C) 1997-2002 David A. Schleef <ds@schleef.org> - */ - -/* - * The PCI-MIO E series driver was originally written by - * Tomasz Motylewski <...>, and ported to comedi by ds. - * - * References for specifications: - * - * 321747b.pdf Register Level Programmer Manual (obsolete) - * 321747c.pdf Register Level Programmer Manual (new) - * DAQ-STC reference manual - * - * Other possibly relevant info: - * - * 320517c.pdf User manual (obsolete) - * 320517f.pdf User manual (new) - * 320889a.pdf delete - * 320906c.pdf maximum signal ratings - * 321066a.pdf about 16x - * 321791a.pdf discontinuation of at-mio-16e-10 rev. c - * 321808a.pdf about at-mio-16e-10 rev P - * 321837a.pdf discontinuation of at-mio-16de-10 rev d - * 321838a.pdf about at-mio-16de-10 rev N - * - * ISSUES: - * - */ - -#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt - -#include <linux/module.h> -#include <linux/slab.h> -#include <linux/log2.h> - -#include "../comedi_pci.h" - -#include "mite.h" - -/* - * Mite registers - */ -#define MITE_UNKNOWN_DMA_BURST_REG 0x28 -#define UNKNOWN_DMA_BURST_ENABLE_BITS 0x600 - -#define MITE_PCI_CONFIG_OFFSET 0x300 -#define MITE_CSIGR 0x460 /* chip signature */ -#define CSIGR_TO_IOWINS(x) (((x) >> 29) & 0x7) -#define CSIGR_TO_WINS(x) (((x) >> 24) & 0x1f) -#define CSIGR_TO_WPDEP(x) (((x) >> 20) & 0x7) -#define CSIGR_TO_DMAC(x) (((x) >> 16) & 0xf) -#define CSIGR_TO_IMODE(x) (((x) >> 12) & 0x3) /* pci=0x3 */ -#define CSIGR_TO_MMODE(x) (((x) >> 8) & 0x3) /* minimite=1 */ -#define CSIGR_TO_TYPE(x) (((x) >> 4) & 0xf) /* mite=0, minimite=1 */ -#define CSIGR_TO_VER(x) (((x) >> 0) & 0xf) - -#define MITE_CHAN(x) (0x500 + 0x100 * (x)) -#define MITE_CHOR(x) (0x00 + MITE_CHAN(x)) /* channel operation */ -#define CHOR_DMARESET BIT(31) -#define CHOR_SET_SEND_TC BIT(11) -#define CHOR_CLR_SEND_TC BIT(10) -#define CHOR_SET_LPAUSE BIT(9) -#define CHOR_CLR_LPAUSE BIT(8) -#define CHOR_CLRDONE BIT(7) -#define CHOR_CLRRB BIT(6) -#define CHOR_CLRLC BIT(5) -#define CHOR_FRESET BIT(4) -#define CHOR_ABORT BIT(3) /* stop without emptying fifo */ -#define CHOR_STOP BIT(2) /* stop after emptying fifo */ -#define CHOR_CONT BIT(1) -#define CHOR_START BIT(0) -#define MITE_CHCR(x) (0x04 + MITE_CHAN(x)) /* channel control */ -#define CHCR_SET_DMA_IE BIT(31) -#define CHCR_CLR_DMA_IE BIT(30) -#define CHCR_SET_LINKP_IE BIT(29) -#define CHCR_CLR_LINKP_IE BIT(28) -#define CHCR_SET_SAR_IE BIT(27) -#define CHCR_CLR_SAR_IE BIT(26) -#define CHCR_SET_DONE_IE BIT(25) -#define CHCR_CLR_DONE_IE BIT(24) -#define CHCR_SET_MRDY_IE BIT(23) -#define CHCR_CLR_MRDY_IE BIT(22) -#define CHCR_SET_DRDY_IE BIT(21) -#define CHCR_CLR_DRDY_IE BIT(20) -#define CHCR_SET_LC_IE BIT(19) -#define CHCR_CLR_LC_IE BIT(18) -#define CHCR_SET_CONT_RB_IE BIT(17) -#define CHCR_CLR_CONT_RB_IE BIT(16) -#define CHCR_FIFO(x) (((x) & 0x1) << 15) -#define CHCR_FIFODIS CHCR_FIFO(1) -#define CHCR_FIFO_ON CHCR_FIFO(0) -#define CHCR_BURST(x) (((x) & 0x1) << 14) -#define CHCR_BURSTEN CHCR_BURST(1) -#define CHCR_NO_BURSTEN CHCR_BURST(0) -#define CHCR_BYTE_SWAP_DEVICE BIT(6) -#define CHCR_BYTE_SWAP_MEMORY BIT(4) -#define CHCR_DIR(x) (((x) & 0x1) << 3) -#define CHCR_DEV_TO_MEM CHCR_DIR(1) -#define CHCR_MEM_TO_DEV CHCR_DIR(0) -#define CHCR_MODE(x) (((x) & 0x7) << 0) -#define CHCR_NORMAL CHCR_MODE(0) -#define CHCR_CONTINUE CHCR_MODE(1) -#define CHCR_RINGBUFF CHCR_MODE(2) -#define CHCR_LINKSHORT CHCR_MODE(4) -#define CHCR_LINKLONG CHCR_MODE(5) -#define MITE_TCR(x) (0x08 + MITE_CHAN(x)) /* transfer count */ -#define MITE_MCR(x) (0x0c + MITE_CHAN(x)) /* memory config */ -#define MITE_MAR(x) (0x10 + MITE_CHAN(x)) /* memory address */ -#define MITE_DCR(x) (0x14 + MITE_CHAN(x)) /* device config */ -#define DCR_NORMAL BIT(29) -#define MITE_DAR(x) (0x18 + MITE_CHAN(x)) /* device address */ -#define MITE_LKCR(x) (0x1c + MITE_CHAN(x)) /* link config */ -#define MITE_LKAR(x) (0x20 + MITE_CHAN(x)) /* link address */ -#define MITE_LLKAR(x) (0x24 + MITE_CHAN(x)) /* see tnt5002 manual */ -#define MITE_BAR(x) (0x28 + MITE_CHAN(x)) /* base address */ -#define MITE_BCR(x) (0x2c + MITE_CHAN(x)) /* base count */ -#define MITE_SAR(x) (0x30 + MITE_CHAN(x)) /* ? address */ -#define MITE_WSCR(x) (0x34 + MITE_CHAN(x)) /* ? */ -#define MITE_WSER(x) (0x38 + MITE_CHAN(x)) /* ? */ -#define MITE_CHSR(x) (0x3c + MITE_CHAN(x)) /* channel status */ -#define CHSR_INT BIT(31) -#define CHSR_LPAUSES BIT(29) -#define CHSR_SARS BIT(27) -#define CHSR_DONE BIT(25) -#define CHSR_MRDY BIT(23) -#define CHSR_DRDY BIT(21) -#define CHSR_LINKC BIT(19) -#define CHSR_CONTS_RB BIT(17) -#define CHSR_ERROR BIT(15) -#define CHSR_SABORT BIT(14) -#define CHSR_HABORT BIT(13) -#define CHSR_STOPS BIT(12) -#define CHSR_OPERR(x) (((x) & 0x3) << 10) -#define CHSR_OPERR_MASK CHSR_OPERR(3) -#define CHSR_OPERR_NOERROR CHSR_OPERR(0) -#define CHSR_OPERR_FIFOERROR CHSR_OPERR(1) -#define CHSR_OPERR_LINKERROR CHSR_OPERR(1) /* ??? */ -#define CHSR_XFERR BIT(9) -#define CHSR_END BIT(8) -#define CHSR_DRQ1 BIT(7) -#define CHSR_DRQ0 BIT(6) -#define CHSR_LERR(x) (((x) & 0x3) << 4) -#define CHSR_LERR_MASK CHSR_LERR(3) -#define CHSR_LBERR CHSR_LERR(1) -#define CHSR_LRERR CHSR_LERR(2) -#define CHSR_LOERR CHSR_LERR(3) -#define CHSR_MERR(x) (((x) & 0x3) << 2) -#define CHSR_MERR_MASK CHSR_MERR(3) -#define CHSR_MBERR CHSR_MERR(1) -#define CHSR_MRERR CHSR_MERR(2) -#define CHSR_MOERR CHSR_MERR(3) -#define CHSR_DERR(x) (((x) & 0x3) << 0) -#define CHSR_DERR_MASK CHSR_DERR(3) -#define CHSR_DBERR CHSR_DERR(1) -#define CHSR_DRERR CHSR_DERR(2) -#define CHSR_DOERR CHSR_DERR(3) -#define MITE_FCR(x) (0x40 + MITE_CHAN(x)) /* fifo count */ - -/* common bits for the memory/device/link config registers */ -#define CR_RL(x) (((x) & 0x7) << 21) -#define CR_REQS(x) (((x) & 0x7) << 16) -#define CR_REQS_MASK CR_REQS(7) -#define CR_ASEQ(x) (((x) & 0x3) << 10) -#define CR_ASEQDONT CR_ASEQ(0) -#define CR_ASEQUP CR_ASEQ(1) -#define CR_ASEQDOWN CR_ASEQ(2) -#define CR_ASEQ_MASK CR_ASEQ(3) -#define CR_PSIZE(x) (((x) & 0x3) << 8) -#define CR_PSIZE8 CR_PSIZE(1) -#define CR_PSIZE16 CR_PSIZE(2) -#define CR_PSIZE32 CR_PSIZE(3) -#define CR_PORT(x) (((x) & 0x3) << 6) -#define CR_PORTCPU CR_PORT(0) -#define CR_PORTIO CR_PORT(1) -#define CR_PORTVXI CR_PORT(2) -#define CR_PORTMXI CR_PORT(3) -#define CR_AMDEVICE BIT(0) - -static unsigned int MITE_IODWBSR_1_WSIZE_bits(unsigned int size) -{ - return (ilog2(size) - 1) & 0x1f; -} - -static unsigned int mite_retry_limit(unsigned int retry_limit) -{ - unsigned int value = 0; - - if (retry_limit) - value = 1 + ilog2(retry_limit); - if (value > 0x7) - value = 0x7; - return CR_RL(value); -} - -static unsigned int mite_drq_reqs(unsigned int drq_line) -{ - /* This also works on m-series when using channels (drq_line) 4 or 5. */ - return CR_REQS((drq_line & 0x3) | 0x4); -} - -static unsigned int mite_fifo_size(struct mite *mite, unsigned int channel) -{ - unsigned int fcr_bits = readl(mite->mmio + MITE_FCR(channel)); - unsigned int empty_count = (fcr_bits >> 16) & 0xff; - unsigned int full_count = fcr_bits & 0xff; - - return empty_count + full_count; -} - -static u32 mite_device_bytes_transferred(struct mite_channel *mite_chan) -{ - struct mite *mite = mite_chan->mite; - - return readl(mite->mmio + MITE_DAR(mite_chan->channel)); -} - -/** - * mite_bytes_in_transit() - Returns the number of unread bytes in the fifo. - * @mite_chan: MITE dma channel. - */ -u32 mite_bytes_in_transit(struct mite_channel *mite_chan) -{ - struct mite *mite = mite_chan->mite; - - return readl(mite->mmio + MITE_FCR(mite_chan->channel)) & 0xff; -} -EXPORT_SYMBOL_GPL(mite_bytes_in_transit); - -/* returns lower bound for number of bytes transferred from device to memory */ -static u32 mite_bytes_written_to_memory_lb(struct mite_channel *mite_chan) -{ - u32 device_byte_count; - - device_byte_count = mite_device_bytes_transferred(mite_chan); - return device_byte_count - mite_bytes_in_transit(mite_chan); -} - -/* returns upper bound for number of bytes transferred from device to memory */ -static u32 mite_bytes_written_to_memory_ub(struct mite_channel *mite_chan) -{ - u32 in_transit_count; - - in_transit_count = mite_bytes_in_transit(mite_chan); - return mite_device_bytes_transferred(mite_chan) - in_transit_count; -} - -/* returns lower bound for number of bytes read from memory to device */ -static u32 mite_bytes_read_from_memory_lb(struct mite_channel *mite_chan) -{ - u32 device_byte_count; - - device_byte_count = mite_device_bytes_transferred(mite_chan); - return device_byte_count + mite_bytes_in_transit(mite_chan); -} - -/* returns upper bound for number of bytes read from memory to device */ -static u32 mite_bytes_read_from_memory_ub(struct mite_channel *mite_chan) -{ - u32 in_transit_count; - - in_transit_count = mite_bytes_in_transit(mite_chan); - return mite_device_bytes_transferred(mite_chan) + in_transit_count; -} - -static void mite_sync_input_dma(struct mite_channel *mite_chan, - struct comedi_subdevice *s) -{ - struct comedi_async *async = s->async; - int count; - unsigned int nbytes, old_alloc_count; - - old_alloc_count = async->buf_write_alloc_count; - /* write alloc as much as we can */ - comedi_buf_write_alloc(s, async->prealloc_bufsz); - - nbytes = mite_bytes_written_to_memory_lb(mite_chan); - if ((int)(mite_bytes_written_to_memory_ub(mite_chan) - - old_alloc_count) > 0) { - dev_warn(s->device->class_dev, - "mite: DMA overwrite of free area\n"); - async->events |= COMEDI_CB_OVERFLOW; - return; - } - - count = nbytes - async->buf_write_count; - /* - * it's possible count will be negative due to conservative value - * returned by mite_bytes_written_to_memory_lb - */ - if (count > 0) { - comedi_buf_write_free(s, count); - comedi_inc_scan_progress(s, count); - async->events |= COMEDI_CB_BLOCK; - } -} - -static void mite_sync_output_dma(struct mite_channel *mite_chan, - struct comedi_subdevice *s) -{ - struct comedi_async *async = s->async; - struct comedi_cmd *cmd = &async->cmd; - u32 stop_count = cmd->stop_arg * comedi_bytes_per_scan(s); - unsigned int old_alloc_count = async->buf_read_alloc_count; - u32 nbytes_ub, nbytes_lb; - int count; - bool finite_regen = (cmd->stop_src == TRIG_NONE && stop_count != 0); - - /* read alloc as much as we can */ - comedi_buf_read_alloc(s, async->prealloc_bufsz); - nbytes_lb = mite_bytes_read_from_memory_lb(mite_chan); - if (cmd->stop_src == TRIG_COUNT && (int)(nbytes_lb - stop_count) > 0) - nbytes_lb = stop_count; - nbytes_ub = mite_bytes_read_from_memory_ub(mite_chan); - if (cmd->stop_src == TRIG_COUNT && (int)(nbytes_ub - stop_count) > 0) - nbytes_ub = stop_count; - - if ((!finite_regen || stop_count > old_alloc_count) && - ((int)(nbytes_ub - old_alloc_count) > 0)) { - dev_warn(s->device->class_dev, "mite: DMA underrun\n"); - async->events |= COMEDI_CB_OVERFLOW; - return; - } - - if (finite_regen) { - /* - * This is a special case where we continuously output a finite - * buffer. In this case, we do not free any of the memory, - * hence we expect that old_alloc_count will reach a maximum of - * stop_count bytes. - */ - return; - } - - count = nbytes_lb - async->buf_read_count; - if (count > 0) { - comedi_buf_read_free(s, count); - async->events |= COMEDI_CB_BLOCK; - } -} - -/** - * mite_sync_dma() - Sync the MITE dma with the COMEDI async buffer. - * @mite_chan: MITE dma channel. - * @s: COMEDI subdevice. - */ -void mite_sync_dma(struct mite_channel *mite_chan, struct comedi_subdevice *s) -{ - if (mite_chan->dir == COMEDI_INPUT) - mite_sync_input_dma(mite_chan, s); - else - mite_sync_output_dma(mite_chan, s); -} -EXPORT_SYMBOL_GPL(mite_sync_dma); - -static unsigned int mite_get_status(struct mite_channel *mite_chan) -{ - struct mite *mite = mite_chan->mite; - unsigned int status; - unsigned long flags; - - spin_lock_irqsave(&mite->lock, flags); - status = readl(mite->mmio + MITE_CHSR(mite_chan->channel)); - if (status & CHSR_DONE) { - mite_chan->done = 1; - writel(CHOR_CLRDONE, - mite->mmio + MITE_CHOR(mite_chan->channel)); - } - spin_unlock_irqrestore(&mite->lock, flags); - return status; -} - -/** - * mite_ack_linkc() - Check and ack the LINKC interrupt, - * @mite_chan: MITE dma channel. - * @s: COMEDI subdevice. - * @sync: flag to force a mite_sync_dma(). - * - * This will also ack the DONE interrupt if active. - */ -void mite_ack_linkc(struct mite_channel *mite_chan, - struct comedi_subdevice *s, - bool sync) -{ - struct mite *mite = mite_chan->mite; - unsigned int status; - - status = mite_get_status(mite_chan); - if (status & CHSR_LINKC) { - writel(CHOR_CLRLC, mite->mmio + MITE_CHOR(mite_chan->channel)); - sync = true; - } - if (sync) - mite_sync_dma(mite_chan, s); - - if (status & CHSR_XFERR) { - dev_err(s->device->class_dev, - "mite: transfer error %08x\n", status); - s->async->events |= COMEDI_CB_ERROR; - } -} -EXPORT_SYMBOL_GPL(mite_ack_linkc); - -/** - * mite_done() - Check is a MITE dma transfer is complete. - * @mite_chan: MITE dma channel. - * - * This will also ack the DONE interrupt if active. - */ -int mite_done(struct mite_channel *mite_chan) -{ - struct mite *mite = mite_chan->mite; - unsigned long flags; - int done; - - mite_get_status(mite_chan); - spin_lock_irqsave(&mite->lock, flags); - done = mite_chan->done; - spin_unlock_irqrestore(&mite->lock, flags); - return done; -} -EXPORT_SYMBOL_GPL(mite_done); - -static void mite_dma_reset(struct mite_channel *mite_chan) -{ - writel(CHOR_DMARESET | CHOR_FRESET, - mite_chan->mite->mmio + MITE_CHOR(mite_chan->channel)); -} - -/** - * mite_dma_arm() - Start a MITE dma transfer. - * @mite_chan: MITE dma channel. - */ -void mite_dma_arm(struct mite_channel *mite_chan) -{ - struct mite *mite = mite_chan->mite; - unsigned long flags; - - /* - * memory barrier is intended to insure any twiddling with the buffer - * is done before writing to the mite to arm dma transfer - */ - smp_mb(); - spin_lock_irqsave(&mite->lock, flags); - mite_chan->done = 0; - /* arm */ - writel(CHOR_START, mite->mmio + MITE_CHOR(mite_chan->channel)); - spin_unlock_irqrestore(&mite->lock, flags); -} -EXPORT_SYMBOL_GPL(mite_dma_arm); - -/** - * mite_dma_disarm() - Stop a MITE dma transfer. - * @mite_chan: MITE dma channel. - */ -void mite_dma_disarm(struct mite_channel *mite_chan) -{ - struct mite *mite = mite_chan->mite; - - /* disarm */ - writel(CHOR_ABORT, mite->mmio + MITE_CHOR(mite_chan->channel)); -} -EXPORT_SYMBOL_GPL(mite_dma_disarm); - -/** - * mite_prep_dma() - Prepare a MITE dma channel for transfers. - * @mite_chan: MITE dma channel. - * @num_device_bits: device transfer size (8, 16, or 32-bits). - * @num_memory_bits: memory transfer size (8, 16, or 32-bits). - */ -void mite_prep_dma(struct mite_channel *mite_chan, - unsigned int num_device_bits, unsigned int num_memory_bits) -{ - struct mite *mite = mite_chan->mite; - unsigned int chcr, mcr, dcr, lkcr; - - mite_dma_reset(mite_chan); - - /* short link chaining mode */ - chcr = CHCR_SET_DMA_IE | CHCR_LINKSHORT | CHCR_SET_DONE_IE | - CHCR_BURSTEN; - /* - * Link Complete Interrupt: interrupt every time a link - * in MITE_RING is completed. This can generate a lot of - * extra interrupts, but right now we update the values - * of buf_int_ptr and buf_int_count at each interrupt. A - * better method is to poll the MITE before each user - * "read()" to calculate the number of bytes available. - */ - chcr |= CHCR_SET_LC_IE; - if (num_memory_bits == 32 && num_device_bits == 16) { - /* - * Doing a combined 32 and 16 bit byteswap gets the 16 bit - * samples into the fifo in the right order. Tested doing 32 bit - * memory to 16 bit device transfers to the analog out of a - * pxi-6281, which has mite version = 1, type = 4. This also - * works for dma reads from the counters on e-series boards. - */ - chcr |= CHCR_BYTE_SWAP_DEVICE | CHCR_BYTE_SWAP_MEMORY; - } - if (mite_chan->dir == COMEDI_INPUT) - chcr |= CHCR_DEV_TO_MEM; - - writel(chcr, mite->mmio + MITE_CHCR(mite_chan->channel)); - - /* to/from memory */ - mcr = mite_retry_limit(64) | CR_ASEQUP; - switch (num_memory_bits) { - case 8: - mcr |= CR_PSIZE8; - break; - case 16: - mcr |= CR_PSIZE16; - break; - case 32: - mcr |= CR_PSIZE32; - break; - default: - pr_warn("bug! invalid mem bit width for dma transfer\n"); - break; - } - writel(mcr, mite->mmio + MITE_MCR(mite_chan->channel)); - - /* from/to device */ - dcr = mite_retry_limit(64) | CR_ASEQUP; - dcr |= CR_PORTIO | CR_AMDEVICE | mite_drq_reqs(mite_chan->channel); - switch (num_device_bits) { - case 8: - dcr |= CR_PSIZE8; - break; - case 16: - dcr |= CR_PSIZE16; - break; - case 32: - dcr |= CR_PSIZE32; - break; - default: - pr_warn("bug! invalid dev bit width for dma transfer\n"); - break; - } - writel(dcr, mite->mmio + MITE_DCR(mite_chan->channel)); - - /* reset the DAR */ - writel(0, mite->mmio + MITE_DAR(mite_chan->channel)); - - /* the link is 32bits */ - lkcr = mite_retry_limit(64) | CR_ASEQUP | CR_PSIZE32; - writel(lkcr, mite->mmio + MITE_LKCR(mite_chan->channel)); - - /* starting address for link chaining */ - writel(mite_chan->ring->dma_addr, - mite->mmio + MITE_LKAR(mite_chan->channel)); -} -EXPORT_SYMBOL_GPL(mite_prep_dma); - -/** - * mite_request_channel_in_range() - Request a MITE dma channel. - * @mite: MITE device. - * @ring: MITE dma ring. - * @min_channel: minimum channel index to use. - * @max_channel: maximum channel index to use. - */ -struct mite_channel *mite_request_channel_in_range(struct mite *mite, - struct mite_ring *ring, - unsigned int min_channel, - unsigned int max_channel) -{ - struct mite_channel *mite_chan = NULL; - unsigned long flags; - int i; - - /* - * spin lock so mite_release_channel can be called safely - * from interrupts - */ - spin_lock_irqsave(&mite->lock, flags); - for (i = min_channel; i <= max_channel; ++i) { - mite_chan = &mite->channels[i]; - if (!mite_chan->ring) { - mite_chan->ring = ring; - break; - } - mite_chan = NULL; - } - spin_unlock_irqrestore(&mite->lock, flags); - return mite_chan; -} -EXPORT_SYMBOL_GPL(mite_request_channel_in_range); - -/** - * mite_request_channel() - Request a MITE dma channel. - * @mite: MITE device. - * @ring: MITE dma ring. - */ -struct mite_channel *mite_request_channel(struct mite *mite, - struct mite_ring *ring) -{ - return mite_request_channel_in_range(mite, ring, 0, - mite->num_channels - 1); -} -EXPORT_SYMBOL_GPL(mite_request_channel); - -/** - * mite_release_channel() - Release a MITE dma channel. - * @mite_chan: MITE dma channel. - */ -void mite_release_channel(struct mite_channel *mite_chan) -{ - struct mite *mite = mite_chan->mite; - unsigned long flags; - - /* spin lock to prevent races with mite_request_channel */ - spin_lock_irqsave(&mite->lock, flags); - if (mite_chan->ring) { - mite_dma_disarm(mite_chan); - mite_dma_reset(mite_chan); - /* - * disable all channel's interrupts (do it after disarm/reset so - * MITE_CHCR reg isn't changed while dma is still active!) - */ - writel(CHCR_CLR_DMA_IE | CHCR_CLR_LINKP_IE | - CHCR_CLR_SAR_IE | CHCR_CLR_DONE_IE | - CHCR_CLR_MRDY_IE | CHCR_CLR_DRDY_IE | - CHCR_CLR_LC_IE | CHCR_CLR_CONT_RB_IE, - mite->mmio + MITE_CHCR(mite_chan->channel)); - mite_chan->ring = NULL; - } - spin_unlock_irqrestore(&mite->lock, flags); -} -EXPORT_SYMBOL_GPL(mite_release_channel); - -/** - * mite_init_ring_descriptors() - Initialize a MITE dma ring descriptors. - * @ring: MITE dma ring. - * @s: COMEDI subdevice. - * @nbytes: the size of the dma ring (in bytes). - * - * Initializes the ring buffer descriptors to provide correct DMA transfer - * links to the exact amount of memory required. When the ring buffer is - * allocated by mite_buf_change(), the default is to initialize the ring - * to refer to the entire DMA data buffer. A command may call this function - * later to re-initialize and shorten the amount of memory that will be - * transferred. - */ -int mite_init_ring_descriptors(struct mite_ring *ring, - struct comedi_subdevice *s, - unsigned int nbytes) -{ - struct comedi_async *async = s->async; - struct mite_dma_desc *desc = NULL; - unsigned int n_full_links = nbytes >> PAGE_SHIFT; - unsigned int remainder = nbytes % PAGE_SIZE; - int i; - - dev_dbg(s->device->class_dev, - "mite: init ring buffer to %u bytes\n", nbytes); - - if ((n_full_links + (remainder > 0 ? 1 : 0)) > ring->n_links) { - dev_err(s->device->class_dev, - "mite: ring buffer too small for requested init\n"); - return -ENOMEM; - } - - /* We set the descriptors for all full links. */ - for (i = 0; i < n_full_links; ++i) { - desc = &ring->descs[i]; - desc->count = cpu_to_le32(PAGE_SIZE); - desc->addr = cpu_to_le32(async->buf_map->page_list[i].dma_addr); - desc->next = cpu_to_le32(ring->dma_addr + - (i + 1) * sizeof(*desc)); - } - - /* the last link is either a remainder or was a full link. */ - if (remainder > 0) { - desc = &ring->descs[i]; - /* set the lesser count for the remainder link */ - desc->count = cpu_to_le32(remainder); - desc->addr = cpu_to_le32(async->buf_map->page_list[i].dma_addr); - } - - /* Assign the last link->next to point back to the head of the list. */ - desc->next = cpu_to_le32(ring->dma_addr); - - /* - * barrier is meant to insure that all the writes to the dma descriptors - * have completed before the dma controller is commanded to read them - */ - smp_wmb(); - return 0; -} -EXPORT_SYMBOL_GPL(mite_init_ring_descriptors); - -static void mite_free_dma_descs(struct mite_ring *ring) -{ - struct mite_dma_desc *descs = ring->descs; - - if (descs) { - dma_free_coherent(ring->hw_dev, - ring->n_links * sizeof(*descs), - descs, ring->dma_addr); - ring->descs = NULL; - ring->dma_addr = 0; - ring->n_links = 0; - } -} - -/** - * mite_buf_change() - COMEDI subdevice (*buf_change) for a MITE dma ring. - * @ring: MITE dma ring. - * @s: COMEDI subdevice. - */ -int mite_buf_change(struct mite_ring *ring, struct comedi_subdevice *s) -{ - struct comedi_async *async = s->async; - struct mite_dma_desc *descs; - unsigned int n_links; - - mite_free_dma_descs(ring); - - if (async->prealloc_bufsz == 0) - return 0; - - n_links = async->prealloc_bufsz >> PAGE_SHIFT; - - descs = dma_alloc_coherent(ring->hw_dev, - n_links * sizeof(*descs), - &ring->dma_addr, GFP_KERNEL); - if (!descs) { - dev_err(s->device->class_dev, - "mite: ring buffer allocation failed\n"); - return -ENOMEM; - } - ring->descs = descs; - ring->n_links = n_links; - - return mite_init_ring_descriptors(ring, s, n_links << PAGE_SHIFT); -} -EXPORT_SYMBOL_GPL(mite_buf_change); - -/** - * mite_alloc_ring() - Allocate a MITE dma ring. - * @mite: MITE device. - */ -struct mite_ring *mite_alloc_ring(struct mite *mite) -{ - struct mite_ring *ring; - - ring = kmalloc(sizeof(*ring), GFP_KERNEL); - if (!ring) - return NULL; - ring->hw_dev = get_device(&mite->pcidev->dev); - if (!ring->hw_dev) { - kfree(ring); - return NULL; - } - ring->n_links = 0; - ring->descs = NULL; - ring->dma_addr = 0; - return ring; -} -EXPORT_SYMBOL_GPL(mite_alloc_ring); - -/** - * mite_free_ring() - Free a MITE dma ring and its descriptors. - * @ring: MITE dma ring. - */ -void mite_free_ring(struct mite_ring *ring) -{ - if (ring) { - mite_free_dma_descs(ring); - put_device(ring->hw_dev); - kfree(ring); - } -} -EXPORT_SYMBOL_GPL(mite_free_ring); - -static int mite_setup(struct comedi_device *dev, struct mite *mite, - bool use_win1) -{ - resource_size_t daq_phys_addr; - unsigned long length; - int i; - u32 csigr_bits; - unsigned int unknown_dma_burst_bits; - unsigned int wpdep; - - pci_set_master(mite->pcidev); - - mite->mmio = pci_ioremap_bar(mite->pcidev, 0); - if (!mite->mmio) - return -ENOMEM; - - dev->mmio = pci_ioremap_bar(mite->pcidev, 1); - if (!dev->mmio) - return -ENOMEM; - daq_phys_addr = pci_resource_start(mite->pcidev, 1); - length = pci_resource_len(mite->pcidev, 1); - - if (use_win1) { - writel(0, mite->mmio + MITE_IODWBSR); - dev_dbg(dev->class_dev, - "mite: using I/O Window Base Size register 1\n"); - writel(daq_phys_addr | WENAB | - MITE_IODWBSR_1_WSIZE_bits(length), - mite->mmio + MITE_IODWBSR_1); - writel(0, mite->mmio + MITE_IODWCR_1); - } else { - writel(daq_phys_addr | WENAB, mite->mmio + MITE_IODWBSR); - } - /* - * Make sure dma bursts work. I got this from running a bus analyzer - * on a pxi-6281 and a pxi-6713. 6713 powered up with register value - * of 0x61f and bursts worked. 6281 powered up with register value of - * 0x1f and bursts didn't work. The NI windows driver reads the - * register, then does a bitwise-or of 0x600 with it and writes it back. - * - * The bits 0x90180700 in MITE_UNKNOWN_DMA_BURST_REG can be - * written and read back. The bits 0x1f always read as 1. - * The rest always read as zero. - */ - unknown_dma_burst_bits = readl(mite->mmio + MITE_UNKNOWN_DMA_BURST_REG); - unknown_dma_burst_bits |= UNKNOWN_DMA_BURST_ENABLE_BITS; - writel(unknown_dma_burst_bits, mite->mmio + MITE_UNKNOWN_DMA_BURST_REG); - - csigr_bits = readl(mite->mmio + MITE_CSIGR); - mite->num_channels = CSIGR_TO_DMAC(csigr_bits); - if (mite->num_channels > MAX_MITE_DMA_CHANNELS) { - dev_warn(dev->class_dev, - "mite: bug? chip claims to have %i dma channels. Setting to %i.\n", - mite->num_channels, MAX_MITE_DMA_CHANNELS); - mite->num_channels = MAX_MITE_DMA_CHANNELS; - } - - /* get the wpdep bits and convert it to the write port fifo depth */ - wpdep = CSIGR_TO_WPDEP(csigr_bits); - if (wpdep) - wpdep = BIT(wpdep); - - dev_dbg(dev->class_dev, - "mite: version = %i, type = %i, mite mode = %i, interface mode = %i\n", - CSIGR_TO_VER(csigr_bits), CSIGR_TO_TYPE(csigr_bits), - CSIGR_TO_MMODE(csigr_bits), CSIGR_TO_IMODE(csigr_bits)); - dev_dbg(dev->class_dev, - "mite: num channels = %i, write post fifo depth = %i, wins = %i, iowins = %i\n", - CSIGR_TO_DMAC(csigr_bits), wpdep, - CSIGR_TO_WINS(csigr_bits), CSIGR_TO_IOWINS(csigr_bits)); - - for (i = 0; i < mite->num_channels; i++) { - writel(CHOR_DMARESET, mite->mmio + MITE_CHOR(i)); - /* disable interrupts */ - writel(CHCR_CLR_DMA_IE | CHCR_CLR_LINKP_IE | CHCR_CLR_SAR_IE | - CHCR_CLR_DONE_IE | CHCR_CLR_MRDY_IE | CHCR_CLR_DRDY_IE | - CHCR_CLR_LC_IE | CHCR_CLR_CONT_RB_IE, - mite->mmio + MITE_CHCR(i)); - } - mite->fifo_size = mite_fifo_size(mite, 0); - dev_dbg(dev->class_dev, "mite: fifo size is %i.\n", mite->fifo_size); - return 0; -} - -/** - * mite_attach() - Allocate and initialize a MITE device for a comedi driver. - * @dev: COMEDI device. - * @use_win1: flag to use I/O Window 1 instead of I/O Window 0. - * - * Called by a COMEDI drivers (*auto_attach). - * - * Returns a pointer to the MITE device on success, or NULL if the MITE cannot - * be allocated or remapped. - */ -struct mite *mite_attach(struct comedi_device *dev, bool use_win1) -{ - struct pci_dev *pcidev = comedi_to_pci_dev(dev); - struct mite *mite; - unsigned int i; - int ret; - - mite = kzalloc(sizeof(*mite), GFP_KERNEL); - if (!mite) - return NULL; - - spin_lock_init(&mite->lock); - mite->pcidev = pcidev; - for (i = 0; i < MAX_MITE_DMA_CHANNELS; ++i) { - mite->channels[i].mite = mite; - mite->channels[i].channel = i; - mite->channels[i].done = 1; - } - - ret = mite_setup(dev, mite, use_win1); - if (ret) { - if (mite->mmio) - iounmap(mite->mmio); - kfree(mite); - return NULL; - } - - return mite; -} -EXPORT_SYMBOL_GPL(mite_attach); - -/** - * mite_detach() - Unmap and free a MITE device for a comedi driver. - * @mite: MITE device. - * - * Called by a COMEDI drivers (*detach). - */ -void mite_detach(struct mite *mite) -{ - if (!mite) - return; - - if (mite->mmio) - iounmap(mite->mmio); - - kfree(mite); -} -EXPORT_SYMBOL_GPL(mite_detach); - -static int __init mite_module_init(void) -{ - return 0; -} -module_init(mite_module_init); - -static void __exit mite_module_exit(void) -{ -} -module_exit(mite_module_exit); - -MODULE_AUTHOR("Comedi https://www.comedi.org"); -MODULE_DESCRIPTION("Comedi helper for NI Mite PCI interface chip"); -MODULE_LICENSE("GPL"); |