1009 строки
24 KiB
C
1009 строки
24 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
// Copyright (C) 2019 Spreadtrum Communications Inc.
|
|
|
|
#include <linux/errno.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/io.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/mutex.h>
|
|
#include <linux/of.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/spinlock.h>
|
|
|
|
#include "sprd-mcdt.h"
|
|
|
|
/* MCDT registers definition */
|
|
#define MCDT_CH0_TXD 0x0
|
|
#define MCDT_CH0_RXD 0x28
|
|
#define MCDT_DAC0_WTMK 0x60
|
|
#define MCDT_ADC0_WTMK 0x88
|
|
#define MCDT_DMA_EN 0xb0
|
|
|
|
#define MCDT_INT_EN0 0xb4
|
|
#define MCDT_INT_EN1 0xb8
|
|
#define MCDT_INT_EN2 0xbc
|
|
|
|
#define MCDT_INT_CLR0 0xc0
|
|
#define MCDT_INT_CLR1 0xc4
|
|
#define MCDT_INT_CLR2 0xc8
|
|
|
|
#define MCDT_INT_RAW1 0xcc
|
|
#define MCDT_INT_RAW2 0xd0
|
|
#define MCDT_INT_RAW3 0xd4
|
|
|
|
#define MCDT_INT_MSK1 0xd8
|
|
#define MCDT_INT_MSK2 0xdc
|
|
#define MCDT_INT_MSK3 0xe0
|
|
|
|
#define MCDT_DAC0_FIFO_ADDR_ST 0xe4
|
|
#define MCDT_ADC0_FIFO_ADDR_ST 0xe8
|
|
|
|
#define MCDT_CH_FIFO_ST0 0x134
|
|
#define MCDT_CH_FIFO_ST1 0x138
|
|
#define MCDT_CH_FIFO_ST2 0x13c
|
|
|
|
#define MCDT_INT_MSK_CFG0 0x140
|
|
#define MCDT_INT_MSK_CFG1 0x144
|
|
|
|
#define MCDT_DMA_CFG0 0x148
|
|
#define MCDT_FIFO_CLR 0x14c
|
|
#define MCDT_DMA_CFG1 0x150
|
|
#define MCDT_DMA_CFG2 0x154
|
|
#define MCDT_DMA_CFG3 0x158
|
|
#define MCDT_DMA_CFG4 0x15c
|
|
#define MCDT_DMA_CFG5 0x160
|
|
|
|
/* Channel water mark definition */
|
|
#define MCDT_CH_FIFO_AE_SHIFT 16
|
|
#define MCDT_CH_FIFO_AE_MASK GENMASK(24, 16)
|
|
#define MCDT_CH_FIFO_AF_MASK GENMASK(8, 0)
|
|
|
|
/* DMA channel select definition */
|
|
#define MCDT_DMA_CH0_SEL_MASK GENMASK(3, 0)
|
|
#define MCDT_DMA_CH0_SEL_SHIFT 0
|
|
#define MCDT_DMA_CH1_SEL_MASK GENMASK(7, 4)
|
|
#define MCDT_DMA_CH1_SEL_SHIFT 4
|
|
#define MCDT_DMA_CH2_SEL_MASK GENMASK(11, 8)
|
|
#define MCDT_DMA_CH2_SEL_SHIFT 8
|
|
#define MCDT_DMA_CH3_SEL_MASK GENMASK(15, 12)
|
|
#define MCDT_DMA_CH3_SEL_SHIFT 12
|
|
#define MCDT_DMA_CH4_SEL_MASK GENMASK(19, 16)
|
|
#define MCDT_DMA_CH4_SEL_SHIFT 16
|
|
#define MCDT_DAC_DMA_SHIFT 16
|
|
|
|
/* DMA channel ACK select definition */
|
|
#define MCDT_DMA_ACK_SEL_MASK GENMASK(3, 0)
|
|
|
|
/* Channel FIFO definition */
|
|
#define MCDT_CH_FIFO_ADDR_SHIFT 16
|
|
#define MCDT_CH_FIFO_ADDR_MASK GENMASK(9, 0)
|
|
#define MCDT_ADC_FIFO_SHIFT 16
|
|
#define MCDT_FIFO_LENGTH 512
|
|
|
|
#define MCDT_ADC_CHANNEL_NUM 10
|
|
#define MCDT_DAC_CHANNEL_NUM 10
|
|
#define MCDT_CHANNEL_NUM (MCDT_ADC_CHANNEL_NUM + MCDT_DAC_CHANNEL_NUM)
|
|
|
|
enum sprd_mcdt_fifo_int {
|
|
MCDT_ADC_FIFO_AE_INT,
|
|
MCDT_ADC_FIFO_AF_INT,
|
|
MCDT_DAC_FIFO_AE_INT,
|
|
MCDT_DAC_FIFO_AF_INT,
|
|
MCDT_ADC_FIFO_OV_INT,
|
|
MCDT_DAC_FIFO_OV_INT
|
|
};
|
|
|
|
enum sprd_mcdt_fifo_sts {
|
|
MCDT_ADC_FIFO_REAL_FULL,
|
|
MCDT_ADC_FIFO_REAL_EMPTY,
|
|
MCDT_ADC_FIFO_AF,
|
|
MCDT_ADC_FIFO_AE,
|
|
MCDT_DAC_FIFO_REAL_FULL,
|
|
MCDT_DAC_FIFO_REAL_EMPTY,
|
|
MCDT_DAC_FIFO_AF,
|
|
MCDT_DAC_FIFO_AE
|
|
};
|
|
|
|
struct sprd_mcdt_dev {
|
|
struct device *dev;
|
|
void __iomem *base;
|
|
spinlock_t lock;
|
|
struct sprd_mcdt_chan chan[MCDT_CHANNEL_NUM];
|
|
};
|
|
|
|
static LIST_HEAD(sprd_mcdt_chan_list);
|
|
static DEFINE_MUTEX(sprd_mcdt_list_mutex);
|
|
|
|
static void sprd_mcdt_update(struct sprd_mcdt_dev *mcdt, u32 reg, u32 val,
|
|
u32 mask)
|
|
{
|
|
u32 orig = readl_relaxed(mcdt->base + reg);
|
|
u32 tmp;
|
|
|
|
tmp = (orig & ~mask) | val;
|
|
writel_relaxed(tmp, mcdt->base + reg);
|
|
}
|
|
|
|
static void sprd_mcdt_dac_set_watermark(struct sprd_mcdt_dev *mcdt, u8 channel,
|
|
u32 full, u32 empty)
|
|
{
|
|
u32 reg = MCDT_DAC0_WTMK + channel * 4;
|
|
u32 water_mark =
|
|
(empty << MCDT_CH_FIFO_AE_SHIFT) & MCDT_CH_FIFO_AE_MASK;
|
|
|
|
water_mark |= full & MCDT_CH_FIFO_AF_MASK;
|
|
sprd_mcdt_update(mcdt, reg, water_mark,
|
|
MCDT_CH_FIFO_AE_MASK | MCDT_CH_FIFO_AF_MASK);
|
|
}
|
|
|
|
static void sprd_mcdt_adc_set_watermark(struct sprd_mcdt_dev *mcdt, u8 channel,
|
|
u32 full, u32 empty)
|
|
{
|
|
u32 reg = MCDT_ADC0_WTMK + channel * 4;
|
|
u32 water_mark =
|
|
(empty << MCDT_CH_FIFO_AE_SHIFT) & MCDT_CH_FIFO_AE_MASK;
|
|
|
|
water_mark |= full & MCDT_CH_FIFO_AF_MASK;
|
|
sprd_mcdt_update(mcdt, reg, water_mark,
|
|
MCDT_CH_FIFO_AE_MASK | MCDT_CH_FIFO_AF_MASK);
|
|
}
|
|
|
|
static void sprd_mcdt_dac_dma_enable(struct sprd_mcdt_dev *mcdt, u8 channel,
|
|
bool enable)
|
|
{
|
|
u32 shift = MCDT_DAC_DMA_SHIFT + channel;
|
|
|
|
if (enable)
|
|
sprd_mcdt_update(mcdt, MCDT_DMA_EN, BIT(shift), BIT(shift));
|
|
else
|
|
sprd_mcdt_update(mcdt, MCDT_DMA_EN, 0, BIT(shift));
|
|
}
|
|
|
|
static void sprd_mcdt_adc_dma_enable(struct sprd_mcdt_dev *mcdt, u8 channel,
|
|
bool enable)
|
|
{
|
|
if (enable)
|
|
sprd_mcdt_update(mcdt, MCDT_DMA_EN, BIT(channel), BIT(channel));
|
|
else
|
|
sprd_mcdt_update(mcdt, MCDT_DMA_EN, 0, BIT(channel));
|
|
}
|
|
|
|
static void sprd_mcdt_ap_int_enable(struct sprd_mcdt_dev *mcdt, u8 channel,
|
|
bool enable)
|
|
{
|
|
if (enable)
|
|
sprd_mcdt_update(mcdt, MCDT_INT_MSK_CFG0, BIT(channel),
|
|
BIT(channel));
|
|
else
|
|
sprd_mcdt_update(mcdt, MCDT_INT_MSK_CFG0, 0, BIT(channel));
|
|
}
|
|
|
|
static void sprd_mcdt_dac_write_fifo(struct sprd_mcdt_dev *mcdt, u8 channel,
|
|
u32 val)
|
|
{
|
|
u32 reg = MCDT_CH0_TXD + channel * 4;
|
|
|
|
writel_relaxed(val, mcdt->base + reg);
|
|
}
|
|
|
|
static void sprd_mcdt_adc_read_fifo(struct sprd_mcdt_dev *mcdt, u8 channel,
|
|
u32 *val)
|
|
{
|
|
u32 reg = MCDT_CH0_RXD + channel * 4;
|
|
|
|
*val = readl_relaxed(mcdt->base + reg);
|
|
}
|
|
|
|
static void sprd_mcdt_dac_dma_chn_select(struct sprd_mcdt_dev *mcdt, u8 channel,
|
|
enum sprd_mcdt_dma_chan dma_chan)
|
|
{
|
|
switch (dma_chan) {
|
|
case SPRD_MCDT_DMA_CH0:
|
|
sprd_mcdt_update(mcdt, MCDT_DMA_CFG0,
|
|
channel << MCDT_DMA_CH0_SEL_SHIFT,
|
|
MCDT_DMA_CH0_SEL_MASK);
|
|
break;
|
|
|
|
case SPRD_MCDT_DMA_CH1:
|
|
sprd_mcdt_update(mcdt, MCDT_DMA_CFG0,
|
|
channel << MCDT_DMA_CH1_SEL_SHIFT,
|
|
MCDT_DMA_CH1_SEL_MASK);
|
|
break;
|
|
|
|
case SPRD_MCDT_DMA_CH2:
|
|
sprd_mcdt_update(mcdt, MCDT_DMA_CFG0,
|
|
channel << MCDT_DMA_CH2_SEL_SHIFT,
|
|
MCDT_DMA_CH2_SEL_MASK);
|
|
break;
|
|
|
|
case SPRD_MCDT_DMA_CH3:
|
|
sprd_mcdt_update(mcdt, MCDT_DMA_CFG0,
|
|
channel << MCDT_DMA_CH3_SEL_SHIFT,
|
|
MCDT_DMA_CH3_SEL_MASK);
|
|
break;
|
|
|
|
case SPRD_MCDT_DMA_CH4:
|
|
sprd_mcdt_update(mcdt, MCDT_DMA_CFG0,
|
|
channel << MCDT_DMA_CH4_SEL_SHIFT,
|
|
MCDT_DMA_CH4_SEL_MASK);
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void sprd_mcdt_adc_dma_chn_select(struct sprd_mcdt_dev *mcdt, u8 channel,
|
|
enum sprd_mcdt_dma_chan dma_chan)
|
|
{
|
|
switch (dma_chan) {
|
|
case SPRD_MCDT_DMA_CH0:
|
|
sprd_mcdt_update(mcdt, MCDT_DMA_CFG1,
|
|
channel << MCDT_DMA_CH0_SEL_SHIFT,
|
|
MCDT_DMA_CH0_SEL_MASK);
|
|
break;
|
|
|
|
case SPRD_MCDT_DMA_CH1:
|
|
sprd_mcdt_update(mcdt, MCDT_DMA_CFG1,
|
|
channel << MCDT_DMA_CH1_SEL_SHIFT,
|
|
MCDT_DMA_CH1_SEL_MASK);
|
|
break;
|
|
|
|
case SPRD_MCDT_DMA_CH2:
|
|
sprd_mcdt_update(mcdt, MCDT_DMA_CFG1,
|
|
channel << MCDT_DMA_CH2_SEL_SHIFT,
|
|
MCDT_DMA_CH2_SEL_MASK);
|
|
break;
|
|
|
|
case SPRD_MCDT_DMA_CH3:
|
|
sprd_mcdt_update(mcdt, MCDT_DMA_CFG1,
|
|
channel << MCDT_DMA_CH3_SEL_SHIFT,
|
|
MCDT_DMA_CH3_SEL_MASK);
|
|
break;
|
|
|
|
case SPRD_MCDT_DMA_CH4:
|
|
sprd_mcdt_update(mcdt, MCDT_DMA_CFG1,
|
|
channel << MCDT_DMA_CH4_SEL_SHIFT,
|
|
MCDT_DMA_CH4_SEL_MASK);
|
|
break;
|
|
}
|
|
}
|
|
|
|
static u32 sprd_mcdt_dma_ack_shift(u8 channel)
|
|
{
|
|
switch (channel) {
|
|
default:
|
|
case 0:
|
|
case 8:
|
|
return 0;
|
|
case 1:
|
|
case 9:
|
|
return 4;
|
|
case 2:
|
|
return 8;
|
|
case 3:
|
|
return 12;
|
|
case 4:
|
|
return 16;
|
|
case 5:
|
|
return 20;
|
|
case 6:
|
|
return 24;
|
|
case 7:
|
|
return 28;
|
|
}
|
|
}
|
|
|
|
static void sprd_mcdt_dac_dma_ack_select(struct sprd_mcdt_dev *mcdt, u8 channel,
|
|
enum sprd_mcdt_dma_chan dma_chan)
|
|
{
|
|
u32 reg, shift = sprd_mcdt_dma_ack_shift(channel), ack = dma_chan;
|
|
|
|
switch (channel) {
|
|
case 0 ... 7:
|
|
reg = MCDT_DMA_CFG2;
|
|
break;
|
|
|
|
case 8 ... 9:
|
|
reg = MCDT_DMA_CFG3;
|
|
break;
|
|
|
|
default:
|
|
return;
|
|
}
|
|
|
|
sprd_mcdt_update(mcdt, reg, ack << shift,
|
|
MCDT_DMA_ACK_SEL_MASK << shift);
|
|
}
|
|
|
|
static void sprd_mcdt_adc_dma_ack_select(struct sprd_mcdt_dev *mcdt, u8 channel,
|
|
enum sprd_mcdt_dma_chan dma_chan)
|
|
{
|
|
u32 reg, shift = sprd_mcdt_dma_ack_shift(channel), ack = dma_chan;
|
|
|
|
switch (channel) {
|
|
case 0 ... 7:
|
|
reg = MCDT_DMA_CFG4;
|
|
break;
|
|
|
|
case 8 ... 9:
|
|
reg = MCDT_DMA_CFG5;
|
|
break;
|
|
|
|
default:
|
|
return;
|
|
}
|
|
|
|
sprd_mcdt_update(mcdt, reg, ack << shift,
|
|
MCDT_DMA_ACK_SEL_MASK << shift);
|
|
}
|
|
|
|
static bool sprd_mcdt_chan_fifo_sts(struct sprd_mcdt_dev *mcdt, u8 channel,
|
|
enum sprd_mcdt_fifo_sts fifo_sts)
|
|
{
|
|
u32 reg, shift;
|
|
|
|
switch (channel) {
|
|
case 0 ... 3:
|
|
reg = MCDT_CH_FIFO_ST0;
|
|
break;
|
|
case 4 ... 7:
|
|
reg = MCDT_CH_FIFO_ST1;
|
|
break;
|
|
case 8 ... 9:
|
|
reg = MCDT_CH_FIFO_ST2;
|
|
break;
|
|
default:
|
|
return false;
|
|
}
|
|
|
|
switch (channel) {
|
|
case 0:
|
|
case 4:
|
|
case 8:
|
|
shift = fifo_sts;
|
|
break;
|
|
|
|
case 1:
|
|
case 5:
|
|
case 9:
|
|
shift = 8 + fifo_sts;
|
|
break;
|
|
|
|
case 2:
|
|
case 6:
|
|
shift = 16 + fifo_sts;
|
|
break;
|
|
|
|
case 3:
|
|
case 7:
|
|
shift = 24 + fifo_sts;
|
|
break;
|
|
|
|
default:
|
|
return false;
|
|
}
|
|
|
|
return !!(readl_relaxed(mcdt->base + reg) & BIT(shift));
|
|
}
|
|
|
|
static void sprd_mcdt_dac_fifo_clear(struct sprd_mcdt_dev *mcdt, u8 channel)
|
|
{
|
|
sprd_mcdt_update(mcdt, MCDT_FIFO_CLR, BIT(channel), BIT(channel));
|
|
}
|
|
|
|
static void sprd_mcdt_adc_fifo_clear(struct sprd_mcdt_dev *mcdt, u8 channel)
|
|
{
|
|
u32 shift = MCDT_ADC_FIFO_SHIFT + channel;
|
|
|
|
sprd_mcdt_update(mcdt, MCDT_FIFO_CLR, BIT(shift), BIT(shift));
|
|
}
|
|
|
|
static u32 sprd_mcdt_dac_fifo_avail(struct sprd_mcdt_dev *mcdt, u8 channel)
|
|
{
|
|
u32 reg = MCDT_DAC0_FIFO_ADDR_ST + channel * 8;
|
|
u32 r_addr = (readl_relaxed(mcdt->base + reg) >>
|
|
MCDT_CH_FIFO_ADDR_SHIFT) & MCDT_CH_FIFO_ADDR_MASK;
|
|
u32 w_addr = readl_relaxed(mcdt->base + reg) & MCDT_CH_FIFO_ADDR_MASK;
|
|
|
|
if (w_addr >= r_addr)
|
|
return 4 * (MCDT_FIFO_LENGTH - w_addr + r_addr);
|
|
else
|
|
return 4 * (r_addr - w_addr);
|
|
}
|
|
|
|
static u32 sprd_mcdt_adc_fifo_avail(struct sprd_mcdt_dev *mcdt, u8 channel)
|
|
{
|
|
u32 reg = MCDT_ADC0_FIFO_ADDR_ST + channel * 8;
|
|
u32 r_addr = (readl_relaxed(mcdt->base + reg) >>
|
|
MCDT_CH_FIFO_ADDR_SHIFT) & MCDT_CH_FIFO_ADDR_MASK;
|
|
u32 w_addr = readl_relaxed(mcdt->base + reg) & MCDT_CH_FIFO_ADDR_MASK;
|
|
|
|
if (w_addr >= r_addr)
|
|
return 4 * (w_addr - r_addr);
|
|
else
|
|
return 4 * (MCDT_FIFO_LENGTH - r_addr + w_addr);
|
|
}
|
|
|
|
static u32 sprd_mcdt_int_type_shift(u8 channel,
|
|
enum sprd_mcdt_fifo_int int_type)
|
|
{
|
|
switch (channel) {
|
|
case 0:
|
|
case 4:
|
|
case 8:
|
|
return int_type;
|
|
|
|
case 1:
|
|
case 5:
|
|
case 9:
|
|
return 8 + int_type;
|
|
|
|
case 2:
|
|
case 6:
|
|
return 16 + int_type;
|
|
|
|
case 3:
|
|
case 7:
|
|
return 24 + int_type;
|
|
|
|
default:
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
static void sprd_mcdt_chan_int_en(struct sprd_mcdt_dev *mcdt, u8 channel,
|
|
enum sprd_mcdt_fifo_int int_type, bool enable)
|
|
{
|
|
u32 reg, shift = sprd_mcdt_int_type_shift(channel, int_type);
|
|
|
|
switch (channel) {
|
|
case 0 ... 3:
|
|
reg = MCDT_INT_EN0;
|
|
break;
|
|
case 4 ... 7:
|
|
reg = MCDT_INT_EN1;
|
|
break;
|
|
case 8 ... 9:
|
|
reg = MCDT_INT_EN2;
|
|
break;
|
|
default:
|
|
return;
|
|
}
|
|
|
|
if (enable)
|
|
sprd_mcdt_update(mcdt, reg, BIT(shift), BIT(shift));
|
|
else
|
|
sprd_mcdt_update(mcdt, reg, 0, BIT(shift));
|
|
}
|
|
|
|
static void sprd_mcdt_chan_int_clear(struct sprd_mcdt_dev *mcdt, u8 channel,
|
|
enum sprd_mcdt_fifo_int int_type)
|
|
{
|
|
u32 reg, shift = sprd_mcdt_int_type_shift(channel, int_type);
|
|
|
|
switch (channel) {
|
|
case 0 ... 3:
|
|
reg = MCDT_INT_CLR0;
|
|
break;
|
|
case 4 ... 7:
|
|
reg = MCDT_INT_CLR1;
|
|
break;
|
|
case 8 ... 9:
|
|
reg = MCDT_INT_CLR2;
|
|
break;
|
|
default:
|
|
return;
|
|
}
|
|
|
|
sprd_mcdt_update(mcdt, reg, BIT(shift), BIT(shift));
|
|
}
|
|
|
|
static bool sprd_mcdt_chan_int_sts(struct sprd_mcdt_dev *mcdt, u8 channel,
|
|
enum sprd_mcdt_fifo_int int_type)
|
|
{
|
|
u32 reg, shift = sprd_mcdt_int_type_shift(channel, int_type);
|
|
|
|
switch (channel) {
|
|
case 0 ... 3:
|
|
reg = MCDT_INT_MSK1;
|
|
break;
|
|
case 4 ... 7:
|
|
reg = MCDT_INT_MSK2;
|
|
break;
|
|
case 8 ... 9:
|
|
reg = MCDT_INT_MSK3;
|
|
break;
|
|
default:
|
|
return false;
|
|
}
|
|
|
|
return !!(readl_relaxed(mcdt->base + reg) & BIT(shift));
|
|
}
|
|
|
|
static irqreturn_t sprd_mcdt_irq_handler(int irq, void *dev_id)
|
|
{
|
|
struct sprd_mcdt_dev *mcdt = (struct sprd_mcdt_dev *)dev_id;
|
|
int i;
|
|
|
|
spin_lock(&mcdt->lock);
|
|
|
|
for (i = 0; i < MCDT_ADC_CHANNEL_NUM; i++) {
|
|
if (sprd_mcdt_chan_int_sts(mcdt, i, MCDT_ADC_FIFO_AF_INT)) {
|
|
struct sprd_mcdt_chan *chan = &mcdt->chan[i];
|
|
|
|
sprd_mcdt_chan_int_clear(mcdt, i, MCDT_ADC_FIFO_AF_INT);
|
|
if (chan->cb)
|
|
chan->cb->notify(chan->cb->data);
|
|
}
|
|
}
|
|
|
|
for (i = 0; i < MCDT_DAC_CHANNEL_NUM; i++) {
|
|
if (sprd_mcdt_chan_int_sts(mcdt, i, MCDT_DAC_FIFO_AE_INT)) {
|
|
struct sprd_mcdt_chan *chan =
|
|
&mcdt->chan[i + MCDT_ADC_CHANNEL_NUM];
|
|
|
|
sprd_mcdt_chan_int_clear(mcdt, i, MCDT_DAC_FIFO_AE_INT);
|
|
if (chan->cb)
|
|
chan->cb->notify(chan->cb->data);
|
|
}
|
|
}
|
|
|
|
spin_unlock(&mcdt->lock);
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
/**
|
|
* sprd_mcdt_chan_write - write data to the MCDT channel's fifo
|
|
* @chan: the MCDT channel
|
|
* @tx_buf: send buffer
|
|
* @size: data size
|
|
*
|
|
* Note: We can not write data to the channel fifo when enabling the DMA mode,
|
|
* otherwise the channel fifo data will be invalid.
|
|
*
|
|
* If there are not enough space of the channel fifo, it will return errors
|
|
* to users.
|
|
*
|
|
* Returns 0 on success, or an appropriate error code on failure.
|
|
*/
|
|
int sprd_mcdt_chan_write(struct sprd_mcdt_chan *chan, char *tx_buf, u32 size)
|
|
{
|
|
struct sprd_mcdt_dev *mcdt = chan->mcdt;
|
|
unsigned long flags;
|
|
int avail, i = 0, words = size / 4;
|
|
u32 *buf = (u32 *)tx_buf;
|
|
|
|
spin_lock_irqsave(&mcdt->lock, flags);
|
|
|
|
if (chan->dma_enable) {
|
|
dev_err(mcdt->dev,
|
|
"Can not write data when DMA mode enabled\n");
|
|
spin_unlock_irqrestore(&mcdt->lock, flags);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (sprd_mcdt_chan_fifo_sts(mcdt, chan->id, MCDT_DAC_FIFO_REAL_FULL)) {
|
|
dev_err(mcdt->dev, "Channel fifo is full now\n");
|
|
spin_unlock_irqrestore(&mcdt->lock, flags);
|
|
return -EBUSY;
|
|
}
|
|
|
|
avail = sprd_mcdt_dac_fifo_avail(mcdt, chan->id);
|
|
if (size > avail) {
|
|
dev_err(mcdt->dev,
|
|
"Data size is larger than the available fifo size\n");
|
|
spin_unlock_irqrestore(&mcdt->lock, flags);
|
|
return -EBUSY;
|
|
}
|
|
|
|
while (i++ < words)
|
|
sprd_mcdt_dac_write_fifo(mcdt, chan->id, *buf++);
|
|
|
|
spin_unlock_irqrestore(&mcdt->lock, flags);
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(sprd_mcdt_chan_write);
|
|
|
|
/**
|
|
* sprd_mcdt_chan_read - read data from the MCDT channel's fifo
|
|
* @chan: the MCDT channel
|
|
* @rx_buf: receive buffer
|
|
* @size: data size
|
|
*
|
|
* Note: We can not read data from the channel fifo when enabling the DMA mode,
|
|
* otherwise the reading data will be invalid.
|
|
*
|
|
* Usually user need start to read data once receiving the fifo full interrupt.
|
|
*
|
|
* Returns data size of reading successfully, or an error code on failure.
|
|
*/
|
|
int sprd_mcdt_chan_read(struct sprd_mcdt_chan *chan, char *rx_buf, u32 size)
|
|
{
|
|
struct sprd_mcdt_dev *mcdt = chan->mcdt;
|
|
unsigned long flags;
|
|
int i = 0, avail, words = size / 4;
|
|
u32 *buf = (u32 *)rx_buf;
|
|
|
|
spin_lock_irqsave(&mcdt->lock, flags);
|
|
|
|
if (chan->dma_enable) {
|
|
dev_err(mcdt->dev, "Can not read data when DMA mode enabled\n");
|
|
spin_unlock_irqrestore(&mcdt->lock, flags);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (sprd_mcdt_chan_fifo_sts(mcdt, chan->id, MCDT_ADC_FIFO_REAL_EMPTY)) {
|
|
dev_err(mcdt->dev, "Channel fifo is empty\n");
|
|
spin_unlock_irqrestore(&mcdt->lock, flags);
|
|
return -EBUSY;
|
|
}
|
|
|
|
avail = sprd_mcdt_adc_fifo_avail(mcdt, chan->id);
|
|
if (size > avail)
|
|
words = avail / 4;
|
|
|
|
while (i++ < words)
|
|
sprd_mcdt_adc_read_fifo(mcdt, chan->id, buf++);
|
|
|
|
spin_unlock_irqrestore(&mcdt->lock, flags);
|
|
return words * 4;
|
|
}
|
|
EXPORT_SYMBOL_GPL(sprd_mcdt_chan_read);
|
|
|
|
/**
|
|
* sprd_mcdt_chan_int_enable - enable the interrupt mode for the MCDT channel
|
|
* @chan: the MCDT channel
|
|
* @water_mark: water mark to trigger a interrupt
|
|
* @cb: callback when a interrupt happened
|
|
*
|
|
* Now it only can enable fifo almost full interrupt for ADC channel and fifo
|
|
* almost empty interrupt for DAC channel. Morevoer for interrupt mode, user
|
|
* should use sprd_mcdt_chan_read() or sprd_mcdt_chan_write() to read or write
|
|
* data manually.
|
|
*
|
|
* For ADC channel, user can start to read data once receiving one fifo full
|
|
* interrupt. For DAC channel, user can start to write data once receiving one
|
|
* fifo empty interrupt or just call sprd_mcdt_chan_write() to write data
|
|
* directly.
|
|
*
|
|
* Returns 0 on success, or an error code on failure.
|
|
*/
|
|
int sprd_mcdt_chan_int_enable(struct sprd_mcdt_chan *chan, u32 water_mark,
|
|
struct sprd_mcdt_chan_callback *cb)
|
|
{
|
|
struct sprd_mcdt_dev *mcdt = chan->mcdt;
|
|
unsigned long flags;
|
|
int ret = 0;
|
|
|
|
spin_lock_irqsave(&mcdt->lock, flags);
|
|
|
|
if (chan->dma_enable || chan->int_enable) {
|
|
dev_err(mcdt->dev, "Failed to set interrupt mode.\n");
|
|
spin_unlock_irqrestore(&mcdt->lock, flags);
|
|
return -EINVAL;
|
|
}
|
|
|
|
switch (chan->type) {
|
|
case SPRD_MCDT_ADC_CHAN:
|
|
sprd_mcdt_adc_fifo_clear(mcdt, chan->id);
|
|
sprd_mcdt_adc_set_watermark(mcdt, chan->id, water_mark,
|
|
MCDT_FIFO_LENGTH - 1);
|
|
sprd_mcdt_chan_int_en(mcdt, chan->id,
|
|
MCDT_ADC_FIFO_AF_INT, true);
|
|
sprd_mcdt_ap_int_enable(mcdt, chan->id, true);
|
|
break;
|
|
|
|
case SPRD_MCDT_DAC_CHAN:
|
|
sprd_mcdt_dac_fifo_clear(mcdt, chan->id);
|
|
sprd_mcdt_dac_set_watermark(mcdt, chan->id,
|
|
MCDT_FIFO_LENGTH - 1, water_mark);
|
|
sprd_mcdt_chan_int_en(mcdt, chan->id,
|
|
MCDT_DAC_FIFO_AE_INT, true);
|
|
sprd_mcdt_ap_int_enable(mcdt, chan->id, true);
|
|
break;
|
|
|
|
default:
|
|
dev_err(mcdt->dev, "Unsupported channel type\n");
|
|
ret = -EINVAL;
|
|
}
|
|
|
|
if (!ret) {
|
|
chan->cb = cb;
|
|
chan->int_enable = true;
|
|
}
|
|
|
|
spin_unlock_irqrestore(&mcdt->lock, flags);
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(sprd_mcdt_chan_int_enable);
|
|
|
|
/**
|
|
* sprd_mcdt_chan_int_disable - disable the interrupt mode for the MCDT channel
|
|
* @chan: the MCDT channel
|
|
*/
|
|
void sprd_mcdt_chan_int_disable(struct sprd_mcdt_chan *chan)
|
|
{
|
|
struct sprd_mcdt_dev *mcdt = chan->mcdt;
|
|
unsigned long flags;
|
|
|
|
spin_lock_irqsave(&mcdt->lock, flags);
|
|
|
|
if (!chan->int_enable) {
|
|
spin_unlock_irqrestore(&mcdt->lock, flags);
|
|
return;
|
|
}
|
|
|
|
switch (chan->type) {
|
|
case SPRD_MCDT_ADC_CHAN:
|
|
sprd_mcdt_chan_int_en(mcdt, chan->id,
|
|
MCDT_ADC_FIFO_AF_INT, false);
|
|
sprd_mcdt_chan_int_clear(mcdt, chan->id, MCDT_ADC_FIFO_AF_INT);
|
|
sprd_mcdt_ap_int_enable(mcdt, chan->id, false);
|
|
break;
|
|
|
|
case SPRD_MCDT_DAC_CHAN:
|
|
sprd_mcdt_chan_int_en(mcdt, chan->id,
|
|
MCDT_DAC_FIFO_AE_INT, false);
|
|
sprd_mcdt_chan_int_clear(mcdt, chan->id, MCDT_DAC_FIFO_AE_INT);
|
|
sprd_mcdt_ap_int_enable(mcdt, chan->id, false);
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
|
|
chan->int_enable = false;
|
|
spin_unlock_irqrestore(&mcdt->lock, flags);
|
|
}
|
|
EXPORT_SYMBOL_GPL(sprd_mcdt_chan_int_disable);
|
|
|
|
/**
|
|
* sprd_mcdt_chan_dma_enable - enable the DMA mode for the MCDT channel
|
|
* @chan: the MCDT channel
|
|
* @dma_chan: specify which DMA channel will be used for this MCDT channel
|
|
* @water_mark: water mark to trigger a DMA request
|
|
*
|
|
* Enable the DMA mode for the MCDT channel, that means we can use DMA to
|
|
* transfer data to the channel fifo and do not need reading/writing data
|
|
* manually.
|
|
*
|
|
* Returns 0 on success, or an error code on failure.
|
|
*/
|
|
int sprd_mcdt_chan_dma_enable(struct sprd_mcdt_chan *chan,
|
|
enum sprd_mcdt_dma_chan dma_chan,
|
|
u32 water_mark)
|
|
{
|
|
struct sprd_mcdt_dev *mcdt = chan->mcdt;
|
|
unsigned long flags;
|
|
int ret = 0;
|
|
|
|
spin_lock_irqsave(&mcdt->lock, flags);
|
|
|
|
if (chan->dma_enable || chan->int_enable ||
|
|
dma_chan > SPRD_MCDT_DMA_CH4) {
|
|
dev_err(mcdt->dev, "Failed to set DMA mode\n");
|
|
spin_unlock_irqrestore(&mcdt->lock, flags);
|
|
return -EINVAL;
|
|
}
|
|
|
|
switch (chan->type) {
|
|
case SPRD_MCDT_ADC_CHAN:
|
|
sprd_mcdt_adc_fifo_clear(mcdt, chan->id);
|
|
sprd_mcdt_adc_set_watermark(mcdt, chan->id,
|
|
water_mark, MCDT_FIFO_LENGTH - 1);
|
|
sprd_mcdt_adc_dma_enable(mcdt, chan->id, true);
|
|
sprd_mcdt_adc_dma_chn_select(mcdt, chan->id, dma_chan);
|
|
sprd_mcdt_adc_dma_ack_select(mcdt, chan->id, dma_chan);
|
|
break;
|
|
|
|
case SPRD_MCDT_DAC_CHAN:
|
|
sprd_mcdt_dac_fifo_clear(mcdt, chan->id);
|
|
sprd_mcdt_dac_set_watermark(mcdt, chan->id,
|
|
MCDT_FIFO_LENGTH - 1, water_mark);
|
|
sprd_mcdt_dac_dma_enable(mcdt, chan->id, true);
|
|
sprd_mcdt_dac_dma_chn_select(mcdt, chan->id, dma_chan);
|
|
sprd_mcdt_dac_dma_ack_select(mcdt, chan->id, dma_chan);
|
|
break;
|
|
|
|
default:
|
|
dev_err(mcdt->dev, "Unsupported channel type\n");
|
|
ret = -EINVAL;
|
|
}
|
|
|
|
if (!ret)
|
|
chan->dma_enable = true;
|
|
|
|
spin_unlock_irqrestore(&mcdt->lock, flags);
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(sprd_mcdt_chan_dma_enable);
|
|
|
|
/**
|
|
* sprd_mcdt_chan_dma_disable - disable the DMA mode for the MCDT channel
|
|
* @chan: the MCDT channel
|
|
*/
|
|
void sprd_mcdt_chan_dma_disable(struct sprd_mcdt_chan *chan)
|
|
{
|
|
struct sprd_mcdt_dev *mcdt = chan->mcdt;
|
|
unsigned long flags;
|
|
|
|
spin_lock_irqsave(&mcdt->lock, flags);
|
|
|
|
if (!chan->dma_enable) {
|
|
spin_unlock_irqrestore(&mcdt->lock, flags);
|
|
return;
|
|
}
|
|
|
|
switch (chan->type) {
|
|
case SPRD_MCDT_ADC_CHAN:
|
|
sprd_mcdt_adc_dma_enable(mcdt, chan->id, false);
|
|
sprd_mcdt_adc_fifo_clear(mcdt, chan->id);
|
|
break;
|
|
|
|
case SPRD_MCDT_DAC_CHAN:
|
|
sprd_mcdt_dac_dma_enable(mcdt, chan->id, false);
|
|
sprd_mcdt_dac_fifo_clear(mcdt, chan->id);
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
|
|
chan->dma_enable = false;
|
|
spin_unlock_irqrestore(&mcdt->lock, flags);
|
|
}
|
|
EXPORT_SYMBOL_GPL(sprd_mcdt_chan_dma_disable);
|
|
|
|
/**
|
|
* sprd_mcdt_request_chan - request one MCDT channel
|
|
* @channel: channel id
|
|
* @type: channel type, it can be one ADC channel or DAC channel
|
|
*
|
|
* Rreturn NULL if no available channel.
|
|
*/
|
|
struct sprd_mcdt_chan *sprd_mcdt_request_chan(u8 channel,
|
|
enum sprd_mcdt_channel_type type)
|
|
{
|
|
struct sprd_mcdt_chan *temp;
|
|
|
|
mutex_lock(&sprd_mcdt_list_mutex);
|
|
|
|
list_for_each_entry(temp, &sprd_mcdt_chan_list, list) {
|
|
if (temp->type == type && temp->id == channel) {
|
|
list_del_init(&temp->list);
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (list_entry_is_head(temp, &sprd_mcdt_chan_list, list))
|
|
temp = NULL;
|
|
|
|
mutex_unlock(&sprd_mcdt_list_mutex);
|
|
|
|
return temp;
|
|
}
|
|
EXPORT_SYMBOL_GPL(sprd_mcdt_request_chan);
|
|
|
|
/**
|
|
* sprd_mcdt_free_chan - free one MCDT channel
|
|
* @chan: the channel to be freed
|
|
*/
|
|
void sprd_mcdt_free_chan(struct sprd_mcdt_chan *chan)
|
|
{
|
|
struct sprd_mcdt_chan *temp;
|
|
|
|
sprd_mcdt_chan_dma_disable(chan);
|
|
sprd_mcdt_chan_int_disable(chan);
|
|
|
|
mutex_lock(&sprd_mcdt_list_mutex);
|
|
|
|
list_for_each_entry(temp, &sprd_mcdt_chan_list, list) {
|
|
if (temp == chan) {
|
|
mutex_unlock(&sprd_mcdt_list_mutex);
|
|
return;
|
|
}
|
|
}
|
|
|
|
list_add_tail(&chan->list, &sprd_mcdt_chan_list);
|
|
mutex_unlock(&sprd_mcdt_list_mutex);
|
|
}
|
|
EXPORT_SYMBOL_GPL(sprd_mcdt_free_chan);
|
|
|
|
static void sprd_mcdt_init_chans(struct sprd_mcdt_dev *mcdt,
|
|
struct resource *res)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < MCDT_CHANNEL_NUM; i++) {
|
|
struct sprd_mcdt_chan *chan = &mcdt->chan[i];
|
|
|
|
if (i < MCDT_ADC_CHANNEL_NUM) {
|
|
chan->id = i;
|
|
chan->type = SPRD_MCDT_ADC_CHAN;
|
|
chan->fifo_phys = res->start + MCDT_CH0_RXD + i * 4;
|
|
} else {
|
|
chan->id = i - MCDT_ADC_CHANNEL_NUM;
|
|
chan->type = SPRD_MCDT_DAC_CHAN;
|
|
chan->fifo_phys = res->start + MCDT_CH0_TXD +
|
|
(i - MCDT_ADC_CHANNEL_NUM) * 4;
|
|
}
|
|
|
|
chan->mcdt = mcdt;
|
|
INIT_LIST_HEAD(&chan->list);
|
|
|
|
mutex_lock(&sprd_mcdt_list_mutex);
|
|
list_add_tail(&chan->list, &sprd_mcdt_chan_list);
|
|
mutex_unlock(&sprd_mcdt_list_mutex);
|
|
}
|
|
}
|
|
|
|
static int sprd_mcdt_probe(struct platform_device *pdev)
|
|
{
|
|
struct sprd_mcdt_dev *mcdt;
|
|
struct resource *res;
|
|
int ret, irq;
|
|
|
|
mcdt = devm_kzalloc(&pdev->dev, sizeof(*mcdt), GFP_KERNEL);
|
|
if (!mcdt)
|
|
return -ENOMEM;
|
|
|
|
mcdt->base = devm_platform_get_and_ioremap_resource(pdev, 0, &res);
|
|
if (IS_ERR(mcdt->base))
|
|
return PTR_ERR(mcdt->base);
|
|
|
|
mcdt->dev = &pdev->dev;
|
|
spin_lock_init(&mcdt->lock);
|
|
platform_set_drvdata(pdev, mcdt);
|
|
|
|
irq = platform_get_irq(pdev, 0);
|
|
if (irq < 0)
|
|
return irq;
|
|
|
|
ret = devm_request_irq(&pdev->dev, irq, sprd_mcdt_irq_handler,
|
|
0, "sprd-mcdt", mcdt);
|
|
if (ret) {
|
|
dev_err(&pdev->dev, "Failed to request MCDT IRQ\n");
|
|
return ret;
|
|
}
|
|
|
|
sprd_mcdt_init_chans(mcdt, res);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sprd_mcdt_remove(struct platform_device *pdev)
|
|
{
|
|
struct sprd_mcdt_chan *chan, *temp;
|
|
|
|
mutex_lock(&sprd_mcdt_list_mutex);
|
|
|
|
list_for_each_entry_safe(chan, temp, &sprd_mcdt_chan_list, list)
|
|
list_del(&chan->list);
|
|
|
|
mutex_unlock(&sprd_mcdt_list_mutex);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct of_device_id sprd_mcdt_of_match[] = {
|
|
{ .compatible = "sprd,sc9860-mcdt", },
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(of, sprd_mcdt_of_match);
|
|
|
|
static struct platform_driver sprd_mcdt_driver = {
|
|
.probe = sprd_mcdt_probe,
|
|
.remove = sprd_mcdt_remove,
|
|
.driver = {
|
|
.name = "sprd-mcdt",
|
|
.of_match_table = sprd_mcdt_of_match,
|
|
},
|
|
};
|
|
|
|
module_platform_driver(sprd_mcdt_driver);
|
|
|
|
MODULE_DESCRIPTION("Spreadtrum Multi-Channel Data Transfer Driver");
|
|
MODULE_LICENSE("GPL v2");
|