18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 28c2ecf20Sopenharmony_ci// Copyright (C) 2019 Spreadtrum Communications Inc. 38c2ecf20Sopenharmony_ci 48c2ecf20Sopenharmony_ci#include <linux/errno.h> 58c2ecf20Sopenharmony_ci#include <linux/interrupt.h> 68c2ecf20Sopenharmony_ci#include <linux/io.h> 78c2ecf20Sopenharmony_ci#include <linux/kernel.h> 88c2ecf20Sopenharmony_ci#include <linux/module.h> 98c2ecf20Sopenharmony_ci#include <linux/mutex.h> 108c2ecf20Sopenharmony_ci#include <linux/of.h> 118c2ecf20Sopenharmony_ci#include <linux/platform_device.h> 128c2ecf20Sopenharmony_ci#include <linux/spinlock.h> 138c2ecf20Sopenharmony_ci 148c2ecf20Sopenharmony_ci#include "sprd-mcdt.h" 158c2ecf20Sopenharmony_ci 168c2ecf20Sopenharmony_ci/* MCDT registers definition */ 178c2ecf20Sopenharmony_ci#define MCDT_CH0_TXD 0x0 188c2ecf20Sopenharmony_ci#define MCDT_CH0_RXD 0x28 198c2ecf20Sopenharmony_ci#define MCDT_DAC0_WTMK 0x60 208c2ecf20Sopenharmony_ci#define MCDT_ADC0_WTMK 0x88 218c2ecf20Sopenharmony_ci#define MCDT_DMA_EN 0xb0 228c2ecf20Sopenharmony_ci 238c2ecf20Sopenharmony_ci#define MCDT_INT_EN0 0xb4 248c2ecf20Sopenharmony_ci#define MCDT_INT_EN1 0xb8 258c2ecf20Sopenharmony_ci#define MCDT_INT_EN2 0xbc 268c2ecf20Sopenharmony_ci 278c2ecf20Sopenharmony_ci#define MCDT_INT_CLR0 0xc0 288c2ecf20Sopenharmony_ci#define MCDT_INT_CLR1 0xc4 298c2ecf20Sopenharmony_ci#define MCDT_INT_CLR2 0xc8 308c2ecf20Sopenharmony_ci 318c2ecf20Sopenharmony_ci#define MCDT_INT_RAW1 0xcc 328c2ecf20Sopenharmony_ci#define MCDT_INT_RAW2 0xd0 338c2ecf20Sopenharmony_ci#define MCDT_INT_RAW3 0xd4 348c2ecf20Sopenharmony_ci 358c2ecf20Sopenharmony_ci#define MCDT_INT_MSK1 0xd8 368c2ecf20Sopenharmony_ci#define MCDT_INT_MSK2 0xdc 378c2ecf20Sopenharmony_ci#define MCDT_INT_MSK3 0xe0 388c2ecf20Sopenharmony_ci 398c2ecf20Sopenharmony_ci#define MCDT_DAC0_FIFO_ADDR_ST 0xe4 408c2ecf20Sopenharmony_ci#define MCDT_ADC0_FIFO_ADDR_ST 0xe8 418c2ecf20Sopenharmony_ci 428c2ecf20Sopenharmony_ci#define MCDT_CH_FIFO_ST0 0x134 438c2ecf20Sopenharmony_ci#define MCDT_CH_FIFO_ST1 0x138 448c2ecf20Sopenharmony_ci#define MCDT_CH_FIFO_ST2 0x13c 458c2ecf20Sopenharmony_ci 468c2ecf20Sopenharmony_ci#define MCDT_INT_MSK_CFG0 0x140 478c2ecf20Sopenharmony_ci#define MCDT_INT_MSK_CFG1 0x144 488c2ecf20Sopenharmony_ci 498c2ecf20Sopenharmony_ci#define MCDT_DMA_CFG0 0x148 508c2ecf20Sopenharmony_ci#define MCDT_FIFO_CLR 0x14c 518c2ecf20Sopenharmony_ci#define MCDT_DMA_CFG1 0x150 528c2ecf20Sopenharmony_ci#define MCDT_DMA_CFG2 0x154 538c2ecf20Sopenharmony_ci#define MCDT_DMA_CFG3 0x158 548c2ecf20Sopenharmony_ci#define MCDT_DMA_CFG4 0x15c 558c2ecf20Sopenharmony_ci#define MCDT_DMA_CFG5 0x160 568c2ecf20Sopenharmony_ci 578c2ecf20Sopenharmony_ci/* Channel water mark definition */ 588c2ecf20Sopenharmony_ci#define MCDT_CH_FIFO_AE_SHIFT 16 598c2ecf20Sopenharmony_ci#define MCDT_CH_FIFO_AE_MASK GENMASK(24, 16) 608c2ecf20Sopenharmony_ci#define MCDT_CH_FIFO_AF_MASK GENMASK(8, 0) 618c2ecf20Sopenharmony_ci 628c2ecf20Sopenharmony_ci/* DMA channel select definition */ 638c2ecf20Sopenharmony_ci#define MCDT_DMA_CH0_SEL_MASK GENMASK(3, 0) 648c2ecf20Sopenharmony_ci#define MCDT_DMA_CH0_SEL_SHIFT 0 658c2ecf20Sopenharmony_ci#define MCDT_DMA_CH1_SEL_MASK GENMASK(7, 4) 668c2ecf20Sopenharmony_ci#define MCDT_DMA_CH1_SEL_SHIFT 4 678c2ecf20Sopenharmony_ci#define MCDT_DMA_CH2_SEL_MASK GENMASK(11, 8) 688c2ecf20Sopenharmony_ci#define MCDT_DMA_CH2_SEL_SHIFT 8 698c2ecf20Sopenharmony_ci#define MCDT_DMA_CH3_SEL_MASK GENMASK(15, 12) 708c2ecf20Sopenharmony_ci#define MCDT_DMA_CH3_SEL_SHIFT 12 718c2ecf20Sopenharmony_ci#define MCDT_DMA_CH4_SEL_MASK GENMASK(19, 16) 728c2ecf20Sopenharmony_ci#define MCDT_DMA_CH4_SEL_SHIFT 16 738c2ecf20Sopenharmony_ci#define MCDT_DAC_DMA_SHIFT 16 748c2ecf20Sopenharmony_ci 758c2ecf20Sopenharmony_ci/* DMA channel ACK select definition */ 768c2ecf20Sopenharmony_ci#define MCDT_DMA_ACK_SEL_MASK GENMASK(3, 0) 778c2ecf20Sopenharmony_ci 788c2ecf20Sopenharmony_ci/* Channel FIFO definition */ 798c2ecf20Sopenharmony_ci#define MCDT_CH_FIFO_ADDR_SHIFT 16 808c2ecf20Sopenharmony_ci#define MCDT_CH_FIFO_ADDR_MASK GENMASK(9, 0) 818c2ecf20Sopenharmony_ci#define MCDT_ADC_FIFO_SHIFT 16 828c2ecf20Sopenharmony_ci#define MCDT_FIFO_LENGTH 512 838c2ecf20Sopenharmony_ci 848c2ecf20Sopenharmony_ci#define MCDT_ADC_CHANNEL_NUM 10 858c2ecf20Sopenharmony_ci#define MCDT_DAC_CHANNEL_NUM 10 868c2ecf20Sopenharmony_ci#define MCDT_CHANNEL_NUM (MCDT_ADC_CHANNEL_NUM + MCDT_DAC_CHANNEL_NUM) 878c2ecf20Sopenharmony_ci 888c2ecf20Sopenharmony_cienum sprd_mcdt_fifo_int { 898c2ecf20Sopenharmony_ci MCDT_ADC_FIFO_AE_INT, 908c2ecf20Sopenharmony_ci MCDT_ADC_FIFO_AF_INT, 918c2ecf20Sopenharmony_ci MCDT_DAC_FIFO_AE_INT, 928c2ecf20Sopenharmony_ci MCDT_DAC_FIFO_AF_INT, 938c2ecf20Sopenharmony_ci MCDT_ADC_FIFO_OV_INT, 948c2ecf20Sopenharmony_ci MCDT_DAC_FIFO_OV_INT 958c2ecf20Sopenharmony_ci}; 968c2ecf20Sopenharmony_ci 978c2ecf20Sopenharmony_cienum sprd_mcdt_fifo_sts { 988c2ecf20Sopenharmony_ci MCDT_ADC_FIFO_REAL_FULL, 998c2ecf20Sopenharmony_ci MCDT_ADC_FIFO_REAL_EMPTY, 1008c2ecf20Sopenharmony_ci MCDT_ADC_FIFO_AF, 1018c2ecf20Sopenharmony_ci MCDT_ADC_FIFO_AE, 1028c2ecf20Sopenharmony_ci MCDT_DAC_FIFO_REAL_FULL, 1038c2ecf20Sopenharmony_ci MCDT_DAC_FIFO_REAL_EMPTY, 1048c2ecf20Sopenharmony_ci MCDT_DAC_FIFO_AF, 1058c2ecf20Sopenharmony_ci MCDT_DAC_FIFO_AE 1068c2ecf20Sopenharmony_ci}; 1078c2ecf20Sopenharmony_ci 1088c2ecf20Sopenharmony_cistruct sprd_mcdt_dev { 1098c2ecf20Sopenharmony_ci struct device *dev; 1108c2ecf20Sopenharmony_ci void __iomem *base; 1118c2ecf20Sopenharmony_ci spinlock_t lock; 1128c2ecf20Sopenharmony_ci struct sprd_mcdt_chan chan[MCDT_CHANNEL_NUM]; 1138c2ecf20Sopenharmony_ci}; 1148c2ecf20Sopenharmony_ci 1158c2ecf20Sopenharmony_cistatic LIST_HEAD(sprd_mcdt_chan_list); 1168c2ecf20Sopenharmony_cistatic DEFINE_MUTEX(sprd_mcdt_list_mutex); 1178c2ecf20Sopenharmony_ci 1188c2ecf20Sopenharmony_cistatic void sprd_mcdt_update(struct sprd_mcdt_dev *mcdt, u32 reg, u32 val, 1198c2ecf20Sopenharmony_ci u32 mask) 1208c2ecf20Sopenharmony_ci{ 1218c2ecf20Sopenharmony_ci u32 orig = readl_relaxed(mcdt->base + reg); 1228c2ecf20Sopenharmony_ci u32 tmp; 1238c2ecf20Sopenharmony_ci 1248c2ecf20Sopenharmony_ci tmp = (orig & ~mask) | val; 1258c2ecf20Sopenharmony_ci writel_relaxed(tmp, mcdt->base + reg); 1268c2ecf20Sopenharmony_ci} 1278c2ecf20Sopenharmony_ci 1288c2ecf20Sopenharmony_cistatic void sprd_mcdt_dac_set_watermark(struct sprd_mcdt_dev *mcdt, u8 channel, 1298c2ecf20Sopenharmony_ci u32 full, u32 empty) 1308c2ecf20Sopenharmony_ci{ 1318c2ecf20Sopenharmony_ci u32 reg = MCDT_DAC0_WTMK + channel * 4; 1328c2ecf20Sopenharmony_ci u32 water_mark = 1338c2ecf20Sopenharmony_ci (empty << MCDT_CH_FIFO_AE_SHIFT) & MCDT_CH_FIFO_AE_MASK; 1348c2ecf20Sopenharmony_ci 1358c2ecf20Sopenharmony_ci water_mark |= full & MCDT_CH_FIFO_AF_MASK; 1368c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, reg, water_mark, 1378c2ecf20Sopenharmony_ci MCDT_CH_FIFO_AE_MASK | MCDT_CH_FIFO_AF_MASK); 1388c2ecf20Sopenharmony_ci} 1398c2ecf20Sopenharmony_ci 1408c2ecf20Sopenharmony_cistatic void sprd_mcdt_adc_set_watermark(struct sprd_mcdt_dev *mcdt, u8 channel, 1418c2ecf20Sopenharmony_ci u32 full, u32 empty) 1428c2ecf20Sopenharmony_ci{ 1438c2ecf20Sopenharmony_ci u32 reg = MCDT_ADC0_WTMK + channel * 4; 1448c2ecf20Sopenharmony_ci u32 water_mark = 1458c2ecf20Sopenharmony_ci (empty << MCDT_CH_FIFO_AE_SHIFT) & MCDT_CH_FIFO_AE_MASK; 1468c2ecf20Sopenharmony_ci 1478c2ecf20Sopenharmony_ci water_mark |= full & MCDT_CH_FIFO_AF_MASK; 1488c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, reg, water_mark, 1498c2ecf20Sopenharmony_ci MCDT_CH_FIFO_AE_MASK | MCDT_CH_FIFO_AF_MASK); 1508c2ecf20Sopenharmony_ci} 1518c2ecf20Sopenharmony_ci 1528c2ecf20Sopenharmony_cistatic void sprd_mcdt_dac_dma_enable(struct sprd_mcdt_dev *mcdt, u8 channel, 1538c2ecf20Sopenharmony_ci bool enable) 1548c2ecf20Sopenharmony_ci{ 1558c2ecf20Sopenharmony_ci u32 shift = MCDT_DAC_DMA_SHIFT + channel; 1568c2ecf20Sopenharmony_ci 1578c2ecf20Sopenharmony_ci if (enable) 1588c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, MCDT_DMA_EN, BIT(shift), BIT(shift)); 1598c2ecf20Sopenharmony_ci else 1608c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, MCDT_DMA_EN, 0, BIT(shift)); 1618c2ecf20Sopenharmony_ci} 1628c2ecf20Sopenharmony_ci 1638c2ecf20Sopenharmony_cistatic void sprd_mcdt_adc_dma_enable(struct sprd_mcdt_dev *mcdt, u8 channel, 1648c2ecf20Sopenharmony_ci bool enable) 1658c2ecf20Sopenharmony_ci{ 1668c2ecf20Sopenharmony_ci if (enable) 1678c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, MCDT_DMA_EN, BIT(channel), BIT(channel)); 1688c2ecf20Sopenharmony_ci else 1698c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, MCDT_DMA_EN, 0, BIT(channel)); 1708c2ecf20Sopenharmony_ci} 1718c2ecf20Sopenharmony_ci 1728c2ecf20Sopenharmony_cistatic void sprd_mcdt_ap_int_enable(struct sprd_mcdt_dev *mcdt, u8 channel, 1738c2ecf20Sopenharmony_ci bool enable) 1748c2ecf20Sopenharmony_ci{ 1758c2ecf20Sopenharmony_ci if (enable) 1768c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, MCDT_INT_MSK_CFG0, BIT(channel), 1778c2ecf20Sopenharmony_ci BIT(channel)); 1788c2ecf20Sopenharmony_ci else 1798c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, MCDT_INT_MSK_CFG0, 0, BIT(channel)); 1808c2ecf20Sopenharmony_ci} 1818c2ecf20Sopenharmony_ci 1828c2ecf20Sopenharmony_cistatic void sprd_mcdt_dac_write_fifo(struct sprd_mcdt_dev *mcdt, u8 channel, 1838c2ecf20Sopenharmony_ci u32 val) 1848c2ecf20Sopenharmony_ci{ 1858c2ecf20Sopenharmony_ci u32 reg = MCDT_CH0_TXD + channel * 4; 1868c2ecf20Sopenharmony_ci 1878c2ecf20Sopenharmony_ci writel_relaxed(val, mcdt->base + reg); 1888c2ecf20Sopenharmony_ci} 1898c2ecf20Sopenharmony_ci 1908c2ecf20Sopenharmony_cistatic void sprd_mcdt_adc_read_fifo(struct sprd_mcdt_dev *mcdt, u8 channel, 1918c2ecf20Sopenharmony_ci u32 *val) 1928c2ecf20Sopenharmony_ci{ 1938c2ecf20Sopenharmony_ci u32 reg = MCDT_CH0_RXD + channel * 4; 1948c2ecf20Sopenharmony_ci 1958c2ecf20Sopenharmony_ci *val = readl_relaxed(mcdt->base + reg); 1968c2ecf20Sopenharmony_ci} 1978c2ecf20Sopenharmony_ci 1988c2ecf20Sopenharmony_cistatic void sprd_mcdt_dac_dma_chn_select(struct sprd_mcdt_dev *mcdt, u8 channel, 1998c2ecf20Sopenharmony_ci enum sprd_mcdt_dma_chan dma_chan) 2008c2ecf20Sopenharmony_ci{ 2018c2ecf20Sopenharmony_ci switch (dma_chan) { 2028c2ecf20Sopenharmony_ci case SPRD_MCDT_DMA_CH0: 2038c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, MCDT_DMA_CFG0, 2048c2ecf20Sopenharmony_ci channel << MCDT_DMA_CH0_SEL_SHIFT, 2058c2ecf20Sopenharmony_ci MCDT_DMA_CH0_SEL_MASK); 2068c2ecf20Sopenharmony_ci break; 2078c2ecf20Sopenharmony_ci 2088c2ecf20Sopenharmony_ci case SPRD_MCDT_DMA_CH1: 2098c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, MCDT_DMA_CFG0, 2108c2ecf20Sopenharmony_ci channel << MCDT_DMA_CH1_SEL_SHIFT, 2118c2ecf20Sopenharmony_ci MCDT_DMA_CH1_SEL_MASK); 2128c2ecf20Sopenharmony_ci break; 2138c2ecf20Sopenharmony_ci 2148c2ecf20Sopenharmony_ci case SPRD_MCDT_DMA_CH2: 2158c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, MCDT_DMA_CFG0, 2168c2ecf20Sopenharmony_ci channel << MCDT_DMA_CH2_SEL_SHIFT, 2178c2ecf20Sopenharmony_ci MCDT_DMA_CH2_SEL_MASK); 2188c2ecf20Sopenharmony_ci break; 2198c2ecf20Sopenharmony_ci 2208c2ecf20Sopenharmony_ci case SPRD_MCDT_DMA_CH3: 2218c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, MCDT_DMA_CFG0, 2228c2ecf20Sopenharmony_ci channel << MCDT_DMA_CH3_SEL_SHIFT, 2238c2ecf20Sopenharmony_ci MCDT_DMA_CH3_SEL_MASK); 2248c2ecf20Sopenharmony_ci break; 2258c2ecf20Sopenharmony_ci 2268c2ecf20Sopenharmony_ci case SPRD_MCDT_DMA_CH4: 2278c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, MCDT_DMA_CFG0, 2288c2ecf20Sopenharmony_ci channel << MCDT_DMA_CH4_SEL_SHIFT, 2298c2ecf20Sopenharmony_ci MCDT_DMA_CH4_SEL_MASK); 2308c2ecf20Sopenharmony_ci break; 2318c2ecf20Sopenharmony_ci } 2328c2ecf20Sopenharmony_ci} 2338c2ecf20Sopenharmony_ci 2348c2ecf20Sopenharmony_cistatic void sprd_mcdt_adc_dma_chn_select(struct sprd_mcdt_dev *mcdt, u8 channel, 2358c2ecf20Sopenharmony_ci enum sprd_mcdt_dma_chan dma_chan) 2368c2ecf20Sopenharmony_ci{ 2378c2ecf20Sopenharmony_ci switch (dma_chan) { 2388c2ecf20Sopenharmony_ci case SPRD_MCDT_DMA_CH0: 2398c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, MCDT_DMA_CFG1, 2408c2ecf20Sopenharmony_ci channel << MCDT_DMA_CH0_SEL_SHIFT, 2418c2ecf20Sopenharmony_ci MCDT_DMA_CH0_SEL_MASK); 2428c2ecf20Sopenharmony_ci break; 2438c2ecf20Sopenharmony_ci 2448c2ecf20Sopenharmony_ci case SPRD_MCDT_DMA_CH1: 2458c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, MCDT_DMA_CFG1, 2468c2ecf20Sopenharmony_ci channel << MCDT_DMA_CH1_SEL_SHIFT, 2478c2ecf20Sopenharmony_ci MCDT_DMA_CH1_SEL_MASK); 2488c2ecf20Sopenharmony_ci break; 2498c2ecf20Sopenharmony_ci 2508c2ecf20Sopenharmony_ci case SPRD_MCDT_DMA_CH2: 2518c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, MCDT_DMA_CFG1, 2528c2ecf20Sopenharmony_ci channel << MCDT_DMA_CH2_SEL_SHIFT, 2538c2ecf20Sopenharmony_ci MCDT_DMA_CH2_SEL_MASK); 2548c2ecf20Sopenharmony_ci break; 2558c2ecf20Sopenharmony_ci 2568c2ecf20Sopenharmony_ci case SPRD_MCDT_DMA_CH3: 2578c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, MCDT_DMA_CFG1, 2588c2ecf20Sopenharmony_ci channel << MCDT_DMA_CH3_SEL_SHIFT, 2598c2ecf20Sopenharmony_ci MCDT_DMA_CH3_SEL_MASK); 2608c2ecf20Sopenharmony_ci break; 2618c2ecf20Sopenharmony_ci 2628c2ecf20Sopenharmony_ci case SPRD_MCDT_DMA_CH4: 2638c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, MCDT_DMA_CFG1, 2648c2ecf20Sopenharmony_ci channel << MCDT_DMA_CH4_SEL_SHIFT, 2658c2ecf20Sopenharmony_ci MCDT_DMA_CH4_SEL_MASK); 2668c2ecf20Sopenharmony_ci break; 2678c2ecf20Sopenharmony_ci } 2688c2ecf20Sopenharmony_ci} 2698c2ecf20Sopenharmony_ci 2708c2ecf20Sopenharmony_cistatic u32 sprd_mcdt_dma_ack_shift(u8 channel) 2718c2ecf20Sopenharmony_ci{ 2728c2ecf20Sopenharmony_ci switch (channel) { 2738c2ecf20Sopenharmony_ci default: 2748c2ecf20Sopenharmony_ci case 0: 2758c2ecf20Sopenharmony_ci case 8: 2768c2ecf20Sopenharmony_ci return 0; 2778c2ecf20Sopenharmony_ci case 1: 2788c2ecf20Sopenharmony_ci case 9: 2798c2ecf20Sopenharmony_ci return 4; 2808c2ecf20Sopenharmony_ci case 2: 2818c2ecf20Sopenharmony_ci return 8; 2828c2ecf20Sopenharmony_ci case 3: 2838c2ecf20Sopenharmony_ci return 12; 2848c2ecf20Sopenharmony_ci case 4: 2858c2ecf20Sopenharmony_ci return 16; 2868c2ecf20Sopenharmony_ci case 5: 2878c2ecf20Sopenharmony_ci return 20; 2888c2ecf20Sopenharmony_ci case 6: 2898c2ecf20Sopenharmony_ci return 24; 2908c2ecf20Sopenharmony_ci case 7: 2918c2ecf20Sopenharmony_ci return 28; 2928c2ecf20Sopenharmony_ci } 2938c2ecf20Sopenharmony_ci} 2948c2ecf20Sopenharmony_ci 2958c2ecf20Sopenharmony_cistatic void sprd_mcdt_dac_dma_ack_select(struct sprd_mcdt_dev *mcdt, u8 channel, 2968c2ecf20Sopenharmony_ci enum sprd_mcdt_dma_chan dma_chan) 2978c2ecf20Sopenharmony_ci{ 2988c2ecf20Sopenharmony_ci u32 reg, shift = sprd_mcdt_dma_ack_shift(channel), ack = dma_chan; 2998c2ecf20Sopenharmony_ci 3008c2ecf20Sopenharmony_ci switch (channel) { 3018c2ecf20Sopenharmony_ci case 0 ... 7: 3028c2ecf20Sopenharmony_ci reg = MCDT_DMA_CFG2; 3038c2ecf20Sopenharmony_ci break; 3048c2ecf20Sopenharmony_ci 3058c2ecf20Sopenharmony_ci case 8 ... 9: 3068c2ecf20Sopenharmony_ci reg = MCDT_DMA_CFG3; 3078c2ecf20Sopenharmony_ci break; 3088c2ecf20Sopenharmony_ci 3098c2ecf20Sopenharmony_ci default: 3108c2ecf20Sopenharmony_ci return; 3118c2ecf20Sopenharmony_ci } 3128c2ecf20Sopenharmony_ci 3138c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, reg, ack << shift, 3148c2ecf20Sopenharmony_ci MCDT_DMA_ACK_SEL_MASK << shift); 3158c2ecf20Sopenharmony_ci} 3168c2ecf20Sopenharmony_ci 3178c2ecf20Sopenharmony_cistatic void sprd_mcdt_adc_dma_ack_select(struct sprd_mcdt_dev *mcdt, u8 channel, 3188c2ecf20Sopenharmony_ci enum sprd_mcdt_dma_chan dma_chan) 3198c2ecf20Sopenharmony_ci{ 3208c2ecf20Sopenharmony_ci u32 reg, shift = sprd_mcdt_dma_ack_shift(channel), ack = dma_chan; 3218c2ecf20Sopenharmony_ci 3228c2ecf20Sopenharmony_ci switch (channel) { 3238c2ecf20Sopenharmony_ci case 0 ... 7: 3248c2ecf20Sopenharmony_ci reg = MCDT_DMA_CFG4; 3258c2ecf20Sopenharmony_ci break; 3268c2ecf20Sopenharmony_ci 3278c2ecf20Sopenharmony_ci case 8 ... 9: 3288c2ecf20Sopenharmony_ci reg = MCDT_DMA_CFG5; 3298c2ecf20Sopenharmony_ci break; 3308c2ecf20Sopenharmony_ci 3318c2ecf20Sopenharmony_ci default: 3328c2ecf20Sopenharmony_ci return; 3338c2ecf20Sopenharmony_ci } 3348c2ecf20Sopenharmony_ci 3358c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, reg, ack << shift, 3368c2ecf20Sopenharmony_ci MCDT_DMA_ACK_SEL_MASK << shift); 3378c2ecf20Sopenharmony_ci} 3388c2ecf20Sopenharmony_ci 3398c2ecf20Sopenharmony_cistatic bool sprd_mcdt_chan_fifo_sts(struct sprd_mcdt_dev *mcdt, u8 channel, 3408c2ecf20Sopenharmony_ci enum sprd_mcdt_fifo_sts fifo_sts) 3418c2ecf20Sopenharmony_ci{ 3428c2ecf20Sopenharmony_ci u32 reg, shift; 3438c2ecf20Sopenharmony_ci 3448c2ecf20Sopenharmony_ci switch (channel) { 3458c2ecf20Sopenharmony_ci case 0 ... 3: 3468c2ecf20Sopenharmony_ci reg = MCDT_CH_FIFO_ST0; 3478c2ecf20Sopenharmony_ci break; 3488c2ecf20Sopenharmony_ci case 4 ... 7: 3498c2ecf20Sopenharmony_ci reg = MCDT_CH_FIFO_ST1; 3508c2ecf20Sopenharmony_ci break; 3518c2ecf20Sopenharmony_ci case 8 ... 9: 3528c2ecf20Sopenharmony_ci reg = MCDT_CH_FIFO_ST2; 3538c2ecf20Sopenharmony_ci break; 3548c2ecf20Sopenharmony_ci default: 3558c2ecf20Sopenharmony_ci return false; 3568c2ecf20Sopenharmony_ci } 3578c2ecf20Sopenharmony_ci 3588c2ecf20Sopenharmony_ci switch (channel) { 3598c2ecf20Sopenharmony_ci case 0: 3608c2ecf20Sopenharmony_ci case 4: 3618c2ecf20Sopenharmony_ci case 8: 3628c2ecf20Sopenharmony_ci shift = fifo_sts; 3638c2ecf20Sopenharmony_ci break; 3648c2ecf20Sopenharmony_ci 3658c2ecf20Sopenharmony_ci case 1: 3668c2ecf20Sopenharmony_ci case 5: 3678c2ecf20Sopenharmony_ci case 9: 3688c2ecf20Sopenharmony_ci shift = 8 + fifo_sts; 3698c2ecf20Sopenharmony_ci break; 3708c2ecf20Sopenharmony_ci 3718c2ecf20Sopenharmony_ci case 2: 3728c2ecf20Sopenharmony_ci case 6: 3738c2ecf20Sopenharmony_ci shift = 16 + fifo_sts; 3748c2ecf20Sopenharmony_ci break; 3758c2ecf20Sopenharmony_ci 3768c2ecf20Sopenharmony_ci case 3: 3778c2ecf20Sopenharmony_ci case 7: 3788c2ecf20Sopenharmony_ci shift = 24 + fifo_sts; 3798c2ecf20Sopenharmony_ci break; 3808c2ecf20Sopenharmony_ci 3818c2ecf20Sopenharmony_ci default: 3828c2ecf20Sopenharmony_ci return false; 3838c2ecf20Sopenharmony_ci } 3848c2ecf20Sopenharmony_ci 3858c2ecf20Sopenharmony_ci return !!(readl_relaxed(mcdt->base + reg) & BIT(shift)); 3868c2ecf20Sopenharmony_ci} 3878c2ecf20Sopenharmony_ci 3888c2ecf20Sopenharmony_cistatic void sprd_mcdt_dac_fifo_clear(struct sprd_mcdt_dev *mcdt, u8 channel) 3898c2ecf20Sopenharmony_ci{ 3908c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, MCDT_FIFO_CLR, BIT(channel), BIT(channel)); 3918c2ecf20Sopenharmony_ci} 3928c2ecf20Sopenharmony_ci 3938c2ecf20Sopenharmony_cistatic void sprd_mcdt_adc_fifo_clear(struct sprd_mcdt_dev *mcdt, u8 channel) 3948c2ecf20Sopenharmony_ci{ 3958c2ecf20Sopenharmony_ci u32 shift = MCDT_ADC_FIFO_SHIFT + channel; 3968c2ecf20Sopenharmony_ci 3978c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, MCDT_FIFO_CLR, BIT(shift), BIT(shift)); 3988c2ecf20Sopenharmony_ci} 3998c2ecf20Sopenharmony_ci 4008c2ecf20Sopenharmony_cistatic u32 sprd_mcdt_dac_fifo_avail(struct sprd_mcdt_dev *mcdt, u8 channel) 4018c2ecf20Sopenharmony_ci{ 4028c2ecf20Sopenharmony_ci u32 reg = MCDT_DAC0_FIFO_ADDR_ST + channel * 8; 4038c2ecf20Sopenharmony_ci u32 r_addr = (readl_relaxed(mcdt->base + reg) >> 4048c2ecf20Sopenharmony_ci MCDT_CH_FIFO_ADDR_SHIFT) & MCDT_CH_FIFO_ADDR_MASK; 4058c2ecf20Sopenharmony_ci u32 w_addr = readl_relaxed(mcdt->base + reg) & MCDT_CH_FIFO_ADDR_MASK; 4068c2ecf20Sopenharmony_ci 4078c2ecf20Sopenharmony_ci if (w_addr >= r_addr) 4088c2ecf20Sopenharmony_ci return 4 * (MCDT_FIFO_LENGTH - w_addr + r_addr); 4098c2ecf20Sopenharmony_ci else 4108c2ecf20Sopenharmony_ci return 4 * (r_addr - w_addr); 4118c2ecf20Sopenharmony_ci} 4128c2ecf20Sopenharmony_ci 4138c2ecf20Sopenharmony_cistatic u32 sprd_mcdt_adc_fifo_avail(struct sprd_mcdt_dev *mcdt, u8 channel) 4148c2ecf20Sopenharmony_ci{ 4158c2ecf20Sopenharmony_ci u32 reg = MCDT_ADC0_FIFO_ADDR_ST + channel * 8; 4168c2ecf20Sopenharmony_ci u32 r_addr = (readl_relaxed(mcdt->base + reg) >> 4178c2ecf20Sopenharmony_ci MCDT_CH_FIFO_ADDR_SHIFT) & MCDT_CH_FIFO_ADDR_MASK; 4188c2ecf20Sopenharmony_ci u32 w_addr = readl_relaxed(mcdt->base + reg) & MCDT_CH_FIFO_ADDR_MASK; 4198c2ecf20Sopenharmony_ci 4208c2ecf20Sopenharmony_ci if (w_addr >= r_addr) 4218c2ecf20Sopenharmony_ci return 4 * (w_addr - r_addr); 4228c2ecf20Sopenharmony_ci else 4238c2ecf20Sopenharmony_ci return 4 * (MCDT_FIFO_LENGTH - r_addr + w_addr); 4248c2ecf20Sopenharmony_ci} 4258c2ecf20Sopenharmony_ci 4268c2ecf20Sopenharmony_cistatic u32 sprd_mcdt_int_type_shift(u8 channel, 4278c2ecf20Sopenharmony_ci enum sprd_mcdt_fifo_int int_type) 4288c2ecf20Sopenharmony_ci{ 4298c2ecf20Sopenharmony_ci switch (channel) { 4308c2ecf20Sopenharmony_ci case 0: 4318c2ecf20Sopenharmony_ci case 4: 4328c2ecf20Sopenharmony_ci case 8: 4338c2ecf20Sopenharmony_ci return int_type; 4348c2ecf20Sopenharmony_ci 4358c2ecf20Sopenharmony_ci case 1: 4368c2ecf20Sopenharmony_ci case 5: 4378c2ecf20Sopenharmony_ci case 9: 4388c2ecf20Sopenharmony_ci return 8 + int_type; 4398c2ecf20Sopenharmony_ci 4408c2ecf20Sopenharmony_ci case 2: 4418c2ecf20Sopenharmony_ci case 6: 4428c2ecf20Sopenharmony_ci return 16 + int_type; 4438c2ecf20Sopenharmony_ci 4448c2ecf20Sopenharmony_ci case 3: 4458c2ecf20Sopenharmony_ci case 7: 4468c2ecf20Sopenharmony_ci return 24 + int_type; 4478c2ecf20Sopenharmony_ci 4488c2ecf20Sopenharmony_ci default: 4498c2ecf20Sopenharmony_ci return 0; 4508c2ecf20Sopenharmony_ci } 4518c2ecf20Sopenharmony_ci} 4528c2ecf20Sopenharmony_ci 4538c2ecf20Sopenharmony_cistatic void sprd_mcdt_chan_int_en(struct sprd_mcdt_dev *mcdt, u8 channel, 4548c2ecf20Sopenharmony_ci enum sprd_mcdt_fifo_int int_type, bool enable) 4558c2ecf20Sopenharmony_ci{ 4568c2ecf20Sopenharmony_ci u32 reg, shift = sprd_mcdt_int_type_shift(channel, int_type); 4578c2ecf20Sopenharmony_ci 4588c2ecf20Sopenharmony_ci switch (channel) { 4598c2ecf20Sopenharmony_ci case 0 ... 3: 4608c2ecf20Sopenharmony_ci reg = MCDT_INT_EN0; 4618c2ecf20Sopenharmony_ci break; 4628c2ecf20Sopenharmony_ci case 4 ... 7: 4638c2ecf20Sopenharmony_ci reg = MCDT_INT_EN1; 4648c2ecf20Sopenharmony_ci break; 4658c2ecf20Sopenharmony_ci case 8 ... 9: 4668c2ecf20Sopenharmony_ci reg = MCDT_INT_EN2; 4678c2ecf20Sopenharmony_ci break; 4688c2ecf20Sopenharmony_ci default: 4698c2ecf20Sopenharmony_ci return; 4708c2ecf20Sopenharmony_ci } 4718c2ecf20Sopenharmony_ci 4728c2ecf20Sopenharmony_ci if (enable) 4738c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, reg, BIT(shift), BIT(shift)); 4748c2ecf20Sopenharmony_ci else 4758c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, reg, 0, BIT(shift)); 4768c2ecf20Sopenharmony_ci} 4778c2ecf20Sopenharmony_ci 4788c2ecf20Sopenharmony_cistatic void sprd_mcdt_chan_int_clear(struct sprd_mcdt_dev *mcdt, u8 channel, 4798c2ecf20Sopenharmony_ci enum sprd_mcdt_fifo_int int_type) 4808c2ecf20Sopenharmony_ci{ 4818c2ecf20Sopenharmony_ci u32 reg, shift = sprd_mcdt_int_type_shift(channel, int_type); 4828c2ecf20Sopenharmony_ci 4838c2ecf20Sopenharmony_ci switch (channel) { 4848c2ecf20Sopenharmony_ci case 0 ... 3: 4858c2ecf20Sopenharmony_ci reg = MCDT_INT_CLR0; 4868c2ecf20Sopenharmony_ci break; 4878c2ecf20Sopenharmony_ci case 4 ... 7: 4888c2ecf20Sopenharmony_ci reg = MCDT_INT_CLR1; 4898c2ecf20Sopenharmony_ci break; 4908c2ecf20Sopenharmony_ci case 8 ... 9: 4918c2ecf20Sopenharmony_ci reg = MCDT_INT_CLR2; 4928c2ecf20Sopenharmony_ci break; 4938c2ecf20Sopenharmony_ci default: 4948c2ecf20Sopenharmony_ci return; 4958c2ecf20Sopenharmony_ci } 4968c2ecf20Sopenharmony_ci 4978c2ecf20Sopenharmony_ci sprd_mcdt_update(mcdt, reg, BIT(shift), BIT(shift)); 4988c2ecf20Sopenharmony_ci} 4998c2ecf20Sopenharmony_ci 5008c2ecf20Sopenharmony_cistatic bool sprd_mcdt_chan_int_sts(struct sprd_mcdt_dev *mcdt, u8 channel, 5018c2ecf20Sopenharmony_ci enum sprd_mcdt_fifo_int int_type) 5028c2ecf20Sopenharmony_ci{ 5038c2ecf20Sopenharmony_ci u32 reg, shift = sprd_mcdt_int_type_shift(channel, int_type); 5048c2ecf20Sopenharmony_ci 5058c2ecf20Sopenharmony_ci switch (channel) { 5068c2ecf20Sopenharmony_ci case 0 ... 3: 5078c2ecf20Sopenharmony_ci reg = MCDT_INT_MSK1; 5088c2ecf20Sopenharmony_ci break; 5098c2ecf20Sopenharmony_ci case 4 ... 7: 5108c2ecf20Sopenharmony_ci reg = MCDT_INT_MSK2; 5118c2ecf20Sopenharmony_ci break; 5128c2ecf20Sopenharmony_ci case 8 ... 9: 5138c2ecf20Sopenharmony_ci reg = MCDT_INT_MSK3; 5148c2ecf20Sopenharmony_ci break; 5158c2ecf20Sopenharmony_ci default: 5168c2ecf20Sopenharmony_ci return false; 5178c2ecf20Sopenharmony_ci } 5188c2ecf20Sopenharmony_ci 5198c2ecf20Sopenharmony_ci return !!(readl_relaxed(mcdt->base + reg) & BIT(shift)); 5208c2ecf20Sopenharmony_ci} 5218c2ecf20Sopenharmony_ci 5228c2ecf20Sopenharmony_cistatic irqreturn_t sprd_mcdt_irq_handler(int irq, void *dev_id) 5238c2ecf20Sopenharmony_ci{ 5248c2ecf20Sopenharmony_ci struct sprd_mcdt_dev *mcdt = (struct sprd_mcdt_dev *)dev_id; 5258c2ecf20Sopenharmony_ci int i; 5268c2ecf20Sopenharmony_ci 5278c2ecf20Sopenharmony_ci spin_lock(&mcdt->lock); 5288c2ecf20Sopenharmony_ci 5298c2ecf20Sopenharmony_ci for (i = 0; i < MCDT_ADC_CHANNEL_NUM; i++) { 5308c2ecf20Sopenharmony_ci if (sprd_mcdt_chan_int_sts(mcdt, i, MCDT_ADC_FIFO_AF_INT)) { 5318c2ecf20Sopenharmony_ci struct sprd_mcdt_chan *chan = &mcdt->chan[i]; 5328c2ecf20Sopenharmony_ci 5338c2ecf20Sopenharmony_ci sprd_mcdt_chan_int_clear(mcdt, i, MCDT_ADC_FIFO_AF_INT); 5348c2ecf20Sopenharmony_ci if (chan->cb) 5358c2ecf20Sopenharmony_ci chan->cb->notify(chan->cb->data); 5368c2ecf20Sopenharmony_ci } 5378c2ecf20Sopenharmony_ci } 5388c2ecf20Sopenharmony_ci 5398c2ecf20Sopenharmony_ci for (i = 0; i < MCDT_DAC_CHANNEL_NUM; i++) { 5408c2ecf20Sopenharmony_ci if (sprd_mcdt_chan_int_sts(mcdt, i, MCDT_DAC_FIFO_AE_INT)) { 5418c2ecf20Sopenharmony_ci struct sprd_mcdt_chan *chan = 5428c2ecf20Sopenharmony_ci &mcdt->chan[i + MCDT_ADC_CHANNEL_NUM]; 5438c2ecf20Sopenharmony_ci 5448c2ecf20Sopenharmony_ci sprd_mcdt_chan_int_clear(mcdt, i, MCDT_DAC_FIFO_AE_INT); 5458c2ecf20Sopenharmony_ci if (chan->cb) 5468c2ecf20Sopenharmony_ci chan->cb->notify(chan->cb->data); 5478c2ecf20Sopenharmony_ci } 5488c2ecf20Sopenharmony_ci } 5498c2ecf20Sopenharmony_ci 5508c2ecf20Sopenharmony_ci spin_unlock(&mcdt->lock); 5518c2ecf20Sopenharmony_ci 5528c2ecf20Sopenharmony_ci return IRQ_HANDLED; 5538c2ecf20Sopenharmony_ci} 5548c2ecf20Sopenharmony_ci 5558c2ecf20Sopenharmony_ci/** 5568c2ecf20Sopenharmony_ci * sprd_mcdt_chan_write - write data to the MCDT channel's fifo 5578c2ecf20Sopenharmony_ci * @chan: the MCDT channel 5588c2ecf20Sopenharmony_ci * @tx_buf: send buffer 5598c2ecf20Sopenharmony_ci * @size: data size 5608c2ecf20Sopenharmony_ci * 5618c2ecf20Sopenharmony_ci * Note: We can not write data to the channel fifo when enabling the DMA mode, 5628c2ecf20Sopenharmony_ci * otherwise the channel fifo data will be invalid. 5638c2ecf20Sopenharmony_ci * 5648c2ecf20Sopenharmony_ci * If there are not enough space of the channel fifo, it will return errors 5658c2ecf20Sopenharmony_ci * to users. 5668c2ecf20Sopenharmony_ci * 5678c2ecf20Sopenharmony_ci * Returns 0 on success, or an appropriate error code on failure. 5688c2ecf20Sopenharmony_ci */ 5698c2ecf20Sopenharmony_ciint sprd_mcdt_chan_write(struct sprd_mcdt_chan *chan, char *tx_buf, u32 size) 5708c2ecf20Sopenharmony_ci{ 5718c2ecf20Sopenharmony_ci struct sprd_mcdt_dev *mcdt = chan->mcdt; 5728c2ecf20Sopenharmony_ci unsigned long flags; 5738c2ecf20Sopenharmony_ci int avail, i = 0, words = size / 4; 5748c2ecf20Sopenharmony_ci u32 *buf = (u32 *)tx_buf; 5758c2ecf20Sopenharmony_ci 5768c2ecf20Sopenharmony_ci spin_lock_irqsave(&mcdt->lock, flags); 5778c2ecf20Sopenharmony_ci 5788c2ecf20Sopenharmony_ci if (chan->dma_enable) { 5798c2ecf20Sopenharmony_ci dev_err(mcdt->dev, 5808c2ecf20Sopenharmony_ci "Can not write data when DMA mode enabled\n"); 5818c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&mcdt->lock, flags); 5828c2ecf20Sopenharmony_ci return -EINVAL; 5838c2ecf20Sopenharmony_ci } 5848c2ecf20Sopenharmony_ci 5858c2ecf20Sopenharmony_ci if (sprd_mcdt_chan_fifo_sts(mcdt, chan->id, MCDT_DAC_FIFO_REAL_FULL)) { 5868c2ecf20Sopenharmony_ci dev_err(mcdt->dev, "Channel fifo is full now\n"); 5878c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&mcdt->lock, flags); 5888c2ecf20Sopenharmony_ci return -EBUSY; 5898c2ecf20Sopenharmony_ci } 5908c2ecf20Sopenharmony_ci 5918c2ecf20Sopenharmony_ci avail = sprd_mcdt_dac_fifo_avail(mcdt, chan->id); 5928c2ecf20Sopenharmony_ci if (size > avail) { 5938c2ecf20Sopenharmony_ci dev_err(mcdt->dev, 5948c2ecf20Sopenharmony_ci "Data size is larger than the available fifo size\n"); 5958c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&mcdt->lock, flags); 5968c2ecf20Sopenharmony_ci return -EBUSY; 5978c2ecf20Sopenharmony_ci } 5988c2ecf20Sopenharmony_ci 5998c2ecf20Sopenharmony_ci while (i++ < words) 6008c2ecf20Sopenharmony_ci sprd_mcdt_dac_write_fifo(mcdt, chan->id, *buf++); 6018c2ecf20Sopenharmony_ci 6028c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&mcdt->lock, flags); 6038c2ecf20Sopenharmony_ci return 0; 6048c2ecf20Sopenharmony_ci} 6058c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(sprd_mcdt_chan_write); 6068c2ecf20Sopenharmony_ci 6078c2ecf20Sopenharmony_ci/** 6088c2ecf20Sopenharmony_ci * sprd_mcdt_chan_read - read data from the MCDT channel's fifo 6098c2ecf20Sopenharmony_ci * @chan: the MCDT channel 6108c2ecf20Sopenharmony_ci * @rx_buf: receive buffer 6118c2ecf20Sopenharmony_ci * @size: data size 6128c2ecf20Sopenharmony_ci * 6138c2ecf20Sopenharmony_ci * Note: We can not read data from the channel fifo when enabling the DMA mode, 6148c2ecf20Sopenharmony_ci * otherwise the reading data will be invalid. 6158c2ecf20Sopenharmony_ci * 6168c2ecf20Sopenharmony_ci * Usually user need start to read data once receiving the fifo full interrupt. 6178c2ecf20Sopenharmony_ci * 6188c2ecf20Sopenharmony_ci * Returns data size of reading successfully, or an error code on failure. 6198c2ecf20Sopenharmony_ci */ 6208c2ecf20Sopenharmony_ciint sprd_mcdt_chan_read(struct sprd_mcdt_chan *chan, char *rx_buf, u32 size) 6218c2ecf20Sopenharmony_ci{ 6228c2ecf20Sopenharmony_ci struct sprd_mcdt_dev *mcdt = chan->mcdt; 6238c2ecf20Sopenharmony_ci unsigned long flags; 6248c2ecf20Sopenharmony_ci int i = 0, avail, words = size / 4; 6258c2ecf20Sopenharmony_ci u32 *buf = (u32 *)rx_buf; 6268c2ecf20Sopenharmony_ci 6278c2ecf20Sopenharmony_ci spin_lock_irqsave(&mcdt->lock, flags); 6288c2ecf20Sopenharmony_ci 6298c2ecf20Sopenharmony_ci if (chan->dma_enable) { 6308c2ecf20Sopenharmony_ci dev_err(mcdt->dev, "Can not read data when DMA mode enabled\n"); 6318c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&mcdt->lock, flags); 6328c2ecf20Sopenharmony_ci return -EINVAL; 6338c2ecf20Sopenharmony_ci } 6348c2ecf20Sopenharmony_ci 6358c2ecf20Sopenharmony_ci if (sprd_mcdt_chan_fifo_sts(mcdt, chan->id, MCDT_ADC_FIFO_REAL_EMPTY)) { 6368c2ecf20Sopenharmony_ci dev_err(mcdt->dev, "Channel fifo is empty\n"); 6378c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&mcdt->lock, flags); 6388c2ecf20Sopenharmony_ci return -EBUSY; 6398c2ecf20Sopenharmony_ci } 6408c2ecf20Sopenharmony_ci 6418c2ecf20Sopenharmony_ci avail = sprd_mcdt_adc_fifo_avail(mcdt, chan->id); 6428c2ecf20Sopenharmony_ci if (size > avail) 6438c2ecf20Sopenharmony_ci words = avail / 4; 6448c2ecf20Sopenharmony_ci 6458c2ecf20Sopenharmony_ci while (i++ < words) 6468c2ecf20Sopenharmony_ci sprd_mcdt_adc_read_fifo(mcdt, chan->id, buf++); 6478c2ecf20Sopenharmony_ci 6488c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&mcdt->lock, flags); 6498c2ecf20Sopenharmony_ci return words * 4; 6508c2ecf20Sopenharmony_ci} 6518c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(sprd_mcdt_chan_read); 6528c2ecf20Sopenharmony_ci 6538c2ecf20Sopenharmony_ci/** 6548c2ecf20Sopenharmony_ci * sprd_mcdt_chan_int_enable - enable the interrupt mode for the MCDT channel 6558c2ecf20Sopenharmony_ci * @chan: the MCDT channel 6568c2ecf20Sopenharmony_ci * @water_mark: water mark to trigger a interrupt 6578c2ecf20Sopenharmony_ci * @cb: callback when a interrupt happened 6588c2ecf20Sopenharmony_ci * 6598c2ecf20Sopenharmony_ci * Now it only can enable fifo almost full interrupt for ADC channel and fifo 6608c2ecf20Sopenharmony_ci * almost empty interrupt for DAC channel. Morevoer for interrupt mode, user 6618c2ecf20Sopenharmony_ci * should use sprd_mcdt_chan_read() or sprd_mcdt_chan_write() to read or write 6628c2ecf20Sopenharmony_ci * data manually. 6638c2ecf20Sopenharmony_ci * 6648c2ecf20Sopenharmony_ci * For ADC channel, user can start to read data once receiving one fifo full 6658c2ecf20Sopenharmony_ci * interrupt. For DAC channel, user can start to write data once receiving one 6668c2ecf20Sopenharmony_ci * fifo empty interrupt or just call sprd_mcdt_chan_write() to write data 6678c2ecf20Sopenharmony_ci * directly. 6688c2ecf20Sopenharmony_ci * 6698c2ecf20Sopenharmony_ci * Returns 0 on success, or an error code on failure. 6708c2ecf20Sopenharmony_ci */ 6718c2ecf20Sopenharmony_ciint sprd_mcdt_chan_int_enable(struct sprd_mcdt_chan *chan, u32 water_mark, 6728c2ecf20Sopenharmony_ci struct sprd_mcdt_chan_callback *cb) 6738c2ecf20Sopenharmony_ci{ 6748c2ecf20Sopenharmony_ci struct sprd_mcdt_dev *mcdt = chan->mcdt; 6758c2ecf20Sopenharmony_ci unsigned long flags; 6768c2ecf20Sopenharmony_ci int ret = 0; 6778c2ecf20Sopenharmony_ci 6788c2ecf20Sopenharmony_ci spin_lock_irqsave(&mcdt->lock, flags); 6798c2ecf20Sopenharmony_ci 6808c2ecf20Sopenharmony_ci if (chan->dma_enable || chan->int_enable) { 6818c2ecf20Sopenharmony_ci dev_err(mcdt->dev, "Failed to set interrupt mode.\n"); 6828c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&mcdt->lock, flags); 6838c2ecf20Sopenharmony_ci return -EINVAL; 6848c2ecf20Sopenharmony_ci } 6858c2ecf20Sopenharmony_ci 6868c2ecf20Sopenharmony_ci switch (chan->type) { 6878c2ecf20Sopenharmony_ci case SPRD_MCDT_ADC_CHAN: 6888c2ecf20Sopenharmony_ci sprd_mcdt_adc_fifo_clear(mcdt, chan->id); 6898c2ecf20Sopenharmony_ci sprd_mcdt_adc_set_watermark(mcdt, chan->id, water_mark, 6908c2ecf20Sopenharmony_ci MCDT_FIFO_LENGTH - 1); 6918c2ecf20Sopenharmony_ci sprd_mcdt_chan_int_en(mcdt, chan->id, 6928c2ecf20Sopenharmony_ci MCDT_ADC_FIFO_AF_INT, true); 6938c2ecf20Sopenharmony_ci sprd_mcdt_ap_int_enable(mcdt, chan->id, true); 6948c2ecf20Sopenharmony_ci break; 6958c2ecf20Sopenharmony_ci 6968c2ecf20Sopenharmony_ci case SPRD_MCDT_DAC_CHAN: 6978c2ecf20Sopenharmony_ci sprd_mcdt_dac_fifo_clear(mcdt, chan->id); 6988c2ecf20Sopenharmony_ci sprd_mcdt_dac_set_watermark(mcdt, chan->id, 6998c2ecf20Sopenharmony_ci MCDT_FIFO_LENGTH - 1, water_mark); 7008c2ecf20Sopenharmony_ci sprd_mcdt_chan_int_en(mcdt, chan->id, 7018c2ecf20Sopenharmony_ci MCDT_DAC_FIFO_AE_INT, true); 7028c2ecf20Sopenharmony_ci sprd_mcdt_ap_int_enable(mcdt, chan->id, true); 7038c2ecf20Sopenharmony_ci break; 7048c2ecf20Sopenharmony_ci 7058c2ecf20Sopenharmony_ci default: 7068c2ecf20Sopenharmony_ci dev_err(mcdt->dev, "Unsupported channel type\n"); 7078c2ecf20Sopenharmony_ci ret = -EINVAL; 7088c2ecf20Sopenharmony_ci } 7098c2ecf20Sopenharmony_ci 7108c2ecf20Sopenharmony_ci if (!ret) { 7118c2ecf20Sopenharmony_ci chan->cb = cb; 7128c2ecf20Sopenharmony_ci chan->int_enable = true; 7138c2ecf20Sopenharmony_ci } 7148c2ecf20Sopenharmony_ci 7158c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&mcdt->lock, flags); 7168c2ecf20Sopenharmony_ci 7178c2ecf20Sopenharmony_ci return ret; 7188c2ecf20Sopenharmony_ci} 7198c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(sprd_mcdt_chan_int_enable); 7208c2ecf20Sopenharmony_ci 7218c2ecf20Sopenharmony_ci/** 7228c2ecf20Sopenharmony_ci * sprd_mcdt_chan_int_disable - disable the interrupt mode for the MCDT channel 7238c2ecf20Sopenharmony_ci * @chan: the MCDT channel 7248c2ecf20Sopenharmony_ci */ 7258c2ecf20Sopenharmony_civoid sprd_mcdt_chan_int_disable(struct sprd_mcdt_chan *chan) 7268c2ecf20Sopenharmony_ci{ 7278c2ecf20Sopenharmony_ci struct sprd_mcdt_dev *mcdt = chan->mcdt; 7288c2ecf20Sopenharmony_ci unsigned long flags; 7298c2ecf20Sopenharmony_ci 7308c2ecf20Sopenharmony_ci spin_lock_irqsave(&mcdt->lock, flags); 7318c2ecf20Sopenharmony_ci 7328c2ecf20Sopenharmony_ci if (!chan->int_enable) { 7338c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&mcdt->lock, flags); 7348c2ecf20Sopenharmony_ci return; 7358c2ecf20Sopenharmony_ci } 7368c2ecf20Sopenharmony_ci 7378c2ecf20Sopenharmony_ci switch (chan->type) { 7388c2ecf20Sopenharmony_ci case SPRD_MCDT_ADC_CHAN: 7398c2ecf20Sopenharmony_ci sprd_mcdt_chan_int_en(mcdt, chan->id, 7408c2ecf20Sopenharmony_ci MCDT_ADC_FIFO_AF_INT, false); 7418c2ecf20Sopenharmony_ci sprd_mcdt_chan_int_clear(mcdt, chan->id, MCDT_ADC_FIFO_AF_INT); 7428c2ecf20Sopenharmony_ci sprd_mcdt_ap_int_enable(mcdt, chan->id, false); 7438c2ecf20Sopenharmony_ci break; 7448c2ecf20Sopenharmony_ci 7458c2ecf20Sopenharmony_ci case SPRD_MCDT_DAC_CHAN: 7468c2ecf20Sopenharmony_ci sprd_mcdt_chan_int_en(mcdt, chan->id, 7478c2ecf20Sopenharmony_ci MCDT_DAC_FIFO_AE_INT, false); 7488c2ecf20Sopenharmony_ci sprd_mcdt_chan_int_clear(mcdt, chan->id, MCDT_DAC_FIFO_AE_INT); 7498c2ecf20Sopenharmony_ci sprd_mcdt_ap_int_enable(mcdt, chan->id, false); 7508c2ecf20Sopenharmony_ci break; 7518c2ecf20Sopenharmony_ci 7528c2ecf20Sopenharmony_ci default: 7538c2ecf20Sopenharmony_ci break; 7548c2ecf20Sopenharmony_ci } 7558c2ecf20Sopenharmony_ci 7568c2ecf20Sopenharmony_ci chan->int_enable = false; 7578c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&mcdt->lock, flags); 7588c2ecf20Sopenharmony_ci} 7598c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(sprd_mcdt_chan_int_disable); 7608c2ecf20Sopenharmony_ci 7618c2ecf20Sopenharmony_ci/** 7628c2ecf20Sopenharmony_ci * sprd_mcdt_chan_dma_enable - enable the DMA mode for the MCDT channel 7638c2ecf20Sopenharmony_ci * @chan: the MCDT channel 7648c2ecf20Sopenharmony_ci * @dma_chan: specify which DMA channel will be used for this MCDT channel 7658c2ecf20Sopenharmony_ci * @water_mark: water mark to trigger a DMA request 7668c2ecf20Sopenharmony_ci * 7678c2ecf20Sopenharmony_ci * Enable the DMA mode for the MCDT channel, that means we can use DMA to 7688c2ecf20Sopenharmony_ci * transfer data to the channel fifo and do not need reading/writing data 7698c2ecf20Sopenharmony_ci * manually. 7708c2ecf20Sopenharmony_ci * 7718c2ecf20Sopenharmony_ci * Returns 0 on success, or an error code on failure. 7728c2ecf20Sopenharmony_ci */ 7738c2ecf20Sopenharmony_ciint sprd_mcdt_chan_dma_enable(struct sprd_mcdt_chan *chan, 7748c2ecf20Sopenharmony_ci enum sprd_mcdt_dma_chan dma_chan, 7758c2ecf20Sopenharmony_ci u32 water_mark) 7768c2ecf20Sopenharmony_ci{ 7778c2ecf20Sopenharmony_ci struct sprd_mcdt_dev *mcdt = chan->mcdt; 7788c2ecf20Sopenharmony_ci unsigned long flags; 7798c2ecf20Sopenharmony_ci int ret = 0; 7808c2ecf20Sopenharmony_ci 7818c2ecf20Sopenharmony_ci spin_lock_irqsave(&mcdt->lock, flags); 7828c2ecf20Sopenharmony_ci 7838c2ecf20Sopenharmony_ci if (chan->dma_enable || chan->int_enable || 7848c2ecf20Sopenharmony_ci dma_chan > SPRD_MCDT_DMA_CH4) { 7858c2ecf20Sopenharmony_ci dev_err(mcdt->dev, "Failed to set DMA mode\n"); 7868c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&mcdt->lock, flags); 7878c2ecf20Sopenharmony_ci return -EINVAL; 7888c2ecf20Sopenharmony_ci } 7898c2ecf20Sopenharmony_ci 7908c2ecf20Sopenharmony_ci switch (chan->type) { 7918c2ecf20Sopenharmony_ci case SPRD_MCDT_ADC_CHAN: 7928c2ecf20Sopenharmony_ci sprd_mcdt_adc_fifo_clear(mcdt, chan->id); 7938c2ecf20Sopenharmony_ci sprd_mcdt_adc_set_watermark(mcdt, chan->id, 7948c2ecf20Sopenharmony_ci water_mark, MCDT_FIFO_LENGTH - 1); 7958c2ecf20Sopenharmony_ci sprd_mcdt_adc_dma_enable(mcdt, chan->id, true); 7968c2ecf20Sopenharmony_ci sprd_mcdt_adc_dma_chn_select(mcdt, chan->id, dma_chan); 7978c2ecf20Sopenharmony_ci sprd_mcdt_adc_dma_ack_select(mcdt, chan->id, dma_chan); 7988c2ecf20Sopenharmony_ci break; 7998c2ecf20Sopenharmony_ci 8008c2ecf20Sopenharmony_ci case SPRD_MCDT_DAC_CHAN: 8018c2ecf20Sopenharmony_ci sprd_mcdt_dac_fifo_clear(mcdt, chan->id); 8028c2ecf20Sopenharmony_ci sprd_mcdt_dac_set_watermark(mcdt, chan->id, 8038c2ecf20Sopenharmony_ci MCDT_FIFO_LENGTH - 1, water_mark); 8048c2ecf20Sopenharmony_ci sprd_mcdt_dac_dma_enable(mcdt, chan->id, true); 8058c2ecf20Sopenharmony_ci sprd_mcdt_dac_dma_chn_select(mcdt, chan->id, dma_chan); 8068c2ecf20Sopenharmony_ci sprd_mcdt_dac_dma_ack_select(mcdt, chan->id, dma_chan); 8078c2ecf20Sopenharmony_ci break; 8088c2ecf20Sopenharmony_ci 8098c2ecf20Sopenharmony_ci default: 8108c2ecf20Sopenharmony_ci dev_err(mcdt->dev, "Unsupported channel type\n"); 8118c2ecf20Sopenharmony_ci ret = -EINVAL; 8128c2ecf20Sopenharmony_ci } 8138c2ecf20Sopenharmony_ci 8148c2ecf20Sopenharmony_ci if (!ret) 8158c2ecf20Sopenharmony_ci chan->dma_enable = true; 8168c2ecf20Sopenharmony_ci 8178c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&mcdt->lock, flags); 8188c2ecf20Sopenharmony_ci 8198c2ecf20Sopenharmony_ci return ret; 8208c2ecf20Sopenharmony_ci} 8218c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(sprd_mcdt_chan_dma_enable); 8228c2ecf20Sopenharmony_ci 8238c2ecf20Sopenharmony_ci/** 8248c2ecf20Sopenharmony_ci * sprd_mcdt_chan_dma_disable - disable the DMA mode for the MCDT channel 8258c2ecf20Sopenharmony_ci * @chan: the MCDT channel 8268c2ecf20Sopenharmony_ci */ 8278c2ecf20Sopenharmony_civoid sprd_mcdt_chan_dma_disable(struct sprd_mcdt_chan *chan) 8288c2ecf20Sopenharmony_ci{ 8298c2ecf20Sopenharmony_ci struct sprd_mcdt_dev *mcdt = chan->mcdt; 8308c2ecf20Sopenharmony_ci unsigned long flags; 8318c2ecf20Sopenharmony_ci 8328c2ecf20Sopenharmony_ci spin_lock_irqsave(&mcdt->lock, flags); 8338c2ecf20Sopenharmony_ci 8348c2ecf20Sopenharmony_ci if (!chan->dma_enable) { 8358c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&mcdt->lock, flags); 8368c2ecf20Sopenharmony_ci return; 8378c2ecf20Sopenharmony_ci } 8388c2ecf20Sopenharmony_ci 8398c2ecf20Sopenharmony_ci switch (chan->type) { 8408c2ecf20Sopenharmony_ci case SPRD_MCDT_ADC_CHAN: 8418c2ecf20Sopenharmony_ci sprd_mcdt_adc_dma_enable(mcdt, chan->id, false); 8428c2ecf20Sopenharmony_ci sprd_mcdt_adc_fifo_clear(mcdt, chan->id); 8438c2ecf20Sopenharmony_ci break; 8448c2ecf20Sopenharmony_ci 8458c2ecf20Sopenharmony_ci case SPRD_MCDT_DAC_CHAN: 8468c2ecf20Sopenharmony_ci sprd_mcdt_dac_dma_enable(mcdt, chan->id, false); 8478c2ecf20Sopenharmony_ci sprd_mcdt_dac_fifo_clear(mcdt, chan->id); 8488c2ecf20Sopenharmony_ci break; 8498c2ecf20Sopenharmony_ci 8508c2ecf20Sopenharmony_ci default: 8518c2ecf20Sopenharmony_ci break; 8528c2ecf20Sopenharmony_ci } 8538c2ecf20Sopenharmony_ci 8548c2ecf20Sopenharmony_ci chan->dma_enable = false; 8558c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&mcdt->lock, flags); 8568c2ecf20Sopenharmony_ci} 8578c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(sprd_mcdt_chan_dma_disable); 8588c2ecf20Sopenharmony_ci 8598c2ecf20Sopenharmony_ci/** 8608c2ecf20Sopenharmony_ci * sprd_mcdt_request_chan - request one MCDT channel 8618c2ecf20Sopenharmony_ci * @channel: channel id 8628c2ecf20Sopenharmony_ci * @type: channel type, it can be one ADC channel or DAC channel 8638c2ecf20Sopenharmony_ci * 8648c2ecf20Sopenharmony_ci * Rreturn NULL if no available channel. 8658c2ecf20Sopenharmony_ci */ 8668c2ecf20Sopenharmony_cistruct sprd_mcdt_chan *sprd_mcdt_request_chan(u8 channel, 8678c2ecf20Sopenharmony_ci enum sprd_mcdt_channel_type type) 8688c2ecf20Sopenharmony_ci{ 8698c2ecf20Sopenharmony_ci struct sprd_mcdt_chan *temp, *chan = NULL; 8708c2ecf20Sopenharmony_ci 8718c2ecf20Sopenharmony_ci mutex_lock(&sprd_mcdt_list_mutex); 8728c2ecf20Sopenharmony_ci 8738c2ecf20Sopenharmony_ci list_for_each_entry(temp, &sprd_mcdt_chan_list, list) { 8748c2ecf20Sopenharmony_ci if (temp->type == type && temp->id == channel) { 8758c2ecf20Sopenharmony_ci chan = temp; 8768c2ecf20Sopenharmony_ci break; 8778c2ecf20Sopenharmony_ci } 8788c2ecf20Sopenharmony_ci } 8798c2ecf20Sopenharmony_ci 8808c2ecf20Sopenharmony_ci if (chan) 8818c2ecf20Sopenharmony_ci list_del(&chan->list); 8828c2ecf20Sopenharmony_ci 8838c2ecf20Sopenharmony_ci mutex_unlock(&sprd_mcdt_list_mutex); 8848c2ecf20Sopenharmony_ci 8858c2ecf20Sopenharmony_ci return chan; 8868c2ecf20Sopenharmony_ci} 8878c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(sprd_mcdt_request_chan); 8888c2ecf20Sopenharmony_ci 8898c2ecf20Sopenharmony_ci/** 8908c2ecf20Sopenharmony_ci * sprd_mcdt_free_chan - free one MCDT channel 8918c2ecf20Sopenharmony_ci * @chan: the channel to be freed 8928c2ecf20Sopenharmony_ci */ 8938c2ecf20Sopenharmony_civoid sprd_mcdt_free_chan(struct sprd_mcdt_chan *chan) 8948c2ecf20Sopenharmony_ci{ 8958c2ecf20Sopenharmony_ci struct sprd_mcdt_chan *temp; 8968c2ecf20Sopenharmony_ci 8978c2ecf20Sopenharmony_ci sprd_mcdt_chan_dma_disable(chan); 8988c2ecf20Sopenharmony_ci sprd_mcdt_chan_int_disable(chan); 8998c2ecf20Sopenharmony_ci 9008c2ecf20Sopenharmony_ci mutex_lock(&sprd_mcdt_list_mutex); 9018c2ecf20Sopenharmony_ci 9028c2ecf20Sopenharmony_ci list_for_each_entry(temp, &sprd_mcdt_chan_list, list) { 9038c2ecf20Sopenharmony_ci if (temp == chan) { 9048c2ecf20Sopenharmony_ci mutex_unlock(&sprd_mcdt_list_mutex); 9058c2ecf20Sopenharmony_ci return; 9068c2ecf20Sopenharmony_ci } 9078c2ecf20Sopenharmony_ci } 9088c2ecf20Sopenharmony_ci 9098c2ecf20Sopenharmony_ci list_add_tail(&chan->list, &sprd_mcdt_chan_list); 9108c2ecf20Sopenharmony_ci mutex_unlock(&sprd_mcdt_list_mutex); 9118c2ecf20Sopenharmony_ci} 9128c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(sprd_mcdt_free_chan); 9138c2ecf20Sopenharmony_ci 9148c2ecf20Sopenharmony_cistatic void sprd_mcdt_init_chans(struct sprd_mcdt_dev *mcdt, 9158c2ecf20Sopenharmony_ci struct resource *res) 9168c2ecf20Sopenharmony_ci{ 9178c2ecf20Sopenharmony_ci int i; 9188c2ecf20Sopenharmony_ci 9198c2ecf20Sopenharmony_ci for (i = 0; i < MCDT_CHANNEL_NUM; i++) { 9208c2ecf20Sopenharmony_ci struct sprd_mcdt_chan *chan = &mcdt->chan[i]; 9218c2ecf20Sopenharmony_ci 9228c2ecf20Sopenharmony_ci if (i < MCDT_ADC_CHANNEL_NUM) { 9238c2ecf20Sopenharmony_ci chan->id = i; 9248c2ecf20Sopenharmony_ci chan->type = SPRD_MCDT_ADC_CHAN; 9258c2ecf20Sopenharmony_ci chan->fifo_phys = res->start + MCDT_CH0_RXD + i * 4; 9268c2ecf20Sopenharmony_ci } else { 9278c2ecf20Sopenharmony_ci chan->id = i - MCDT_ADC_CHANNEL_NUM; 9288c2ecf20Sopenharmony_ci chan->type = SPRD_MCDT_DAC_CHAN; 9298c2ecf20Sopenharmony_ci chan->fifo_phys = res->start + MCDT_CH0_TXD + 9308c2ecf20Sopenharmony_ci (i - MCDT_ADC_CHANNEL_NUM) * 4; 9318c2ecf20Sopenharmony_ci } 9328c2ecf20Sopenharmony_ci 9338c2ecf20Sopenharmony_ci chan->mcdt = mcdt; 9348c2ecf20Sopenharmony_ci INIT_LIST_HEAD(&chan->list); 9358c2ecf20Sopenharmony_ci 9368c2ecf20Sopenharmony_ci mutex_lock(&sprd_mcdt_list_mutex); 9378c2ecf20Sopenharmony_ci list_add_tail(&chan->list, &sprd_mcdt_chan_list); 9388c2ecf20Sopenharmony_ci mutex_unlock(&sprd_mcdt_list_mutex); 9398c2ecf20Sopenharmony_ci } 9408c2ecf20Sopenharmony_ci} 9418c2ecf20Sopenharmony_ci 9428c2ecf20Sopenharmony_cistatic int sprd_mcdt_probe(struct platform_device *pdev) 9438c2ecf20Sopenharmony_ci{ 9448c2ecf20Sopenharmony_ci struct sprd_mcdt_dev *mcdt; 9458c2ecf20Sopenharmony_ci struct resource *res; 9468c2ecf20Sopenharmony_ci int ret, irq; 9478c2ecf20Sopenharmony_ci 9488c2ecf20Sopenharmony_ci mcdt = devm_kzalloc(&pdev->dev, sizeof(*mcdt), GFP_KERNEL); 9498c2ecf20Sopenharmony_ci if (!mcdt) 9508c2ecf20Sopenharmony_ci return -ENOMEM; 9518c2ecf20Sopenharmony_ci 9528c2ecf20Sopenharmony_ci res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 9538c2ecf20Sopenharmony_ci mcdt->base = devm_ioremap_resource(&pdev->dev, res); 9548c2ecf20Sopenharmony_ci if (IS_ERR(mcdt->base)) 9558c2ecf20Sopenharmony_ci return PTR_ERR(mcdt->base); 9568c2ecf20Sopenharmony_ci 9578c2ecf20Sopenharmony_ci mcdt->dev = &pdev->dev; 9588c2ecf20Sopenharmony_ci spin_lock_init(&mcdt->lock); 9598c2ecf20Sopenharmony_ci platform_set_drvdata(pdev, mcdt); 9608c2ecf20Sopenharmony_ci 9618c2ecf20Sopenharmony_ci irq = platform_get_irq(pdev, 0); 9628c2ecf20Sopenharmony_ci if (irq < 0) 9638c2ecf20Sopenharmony_ci return irq; 9648c2ecf20Sopenharmony_ci 9658c2ecf20Sopenharmony_ci ret = devm_request_irq(&pdev->dev, irq, sprd_mcdt_irq_handler, 9668c2ecf20Sopenharmony_ci 0, "sprd-mcdt", mcdt); 9678c2ecf20Sopenharmony_ci if (ret) { 9688c2ecf20Sopenharmony_ci dev_err(&pdev->dev, "Failed to request MCDT IRQ\n"); 9698c2ecf20Sopenharmony_ci return ret; 9708c2ecf20Sopenharmony_ci } 9718c2ecf20Sopenharmony_ci 9728c2ecf20Sopenharmony_ci sprd_mcdt_init_chans(mcdt, res); 9738c2ecf20Sopenharmony_ci 9748c2ecf20Sopenharmony_ci return 0; 9758c2ecf20Sopenharmony_ci} 9768c2ecf20Sopenharmony_ci 9778c2ecf20Sopenharmony_cistatic int sprd_mcdt_remove(struct platform_device *pdev) 9788c2ecf20Sopenharmony_ci{ 9798c2ecf20Sopenharmony_ci struct sprd_mcdt_chan *chan, *temp; 9808c2ecf20Sopenharmony_ci 9818c2ecf20Sopenharmony_ci mutex_lock(&sprd_mcdt_list_mutex); 9828c2ecf20Sopenharmony_ci 9838c2ecf20Sopenharmony_ci list_for_each_entry_safe(chan, temp, &sprd_mcdt_chan_list, list) 9848c2ecf20Sopenharmony_ci list_del(&chan->list); 9858c2ecf20Sopenharmony_ci 9868c2ecf20Sopenharmony_ci mutex_unlock(&sprd_mcdt_list_mutex); 9878c2ecf20Sopenharmony_ci 9888c2ecf20Sopenharmony_ci return 0; 9898c2ecf20Sopenharmony_ci} 9908c2ecf20Sopenharmony_ci 9918c2ecf20Sopenharmony_cistatic const struct of_device_id sprd_mcdt_of_match[] = { 9928c2ecf20Sopenharmony_ci { .compatible = "sprd,sc9860-mcdt", }, 9938c2ecf20Sopenharmony_ci { } 9948c2ecf20Sopenharmony_ci}; 9958c2ecf20Sopenharmony_ciMODULE_DEVICE_TABLE(of, sprd_mcdt_of_match); 9968c2ecf20Sopenharmony_ci 9978c2ecf20Sopenharmony_cistatic struct platform_driver sprd_mcdt_driver = { 9988c2ecf20Sopenharmony_ci .probe = sprd_mcdt_probe, 9998c2ecf20Sopenharmony_ci .remove = sprd_mcdt_remove, 10008c2ecf20Sopenharmony_ci .driver = { 10018c2ecf20Sopenharmony_ci .name = "sprd-mcdt", 10028c2ecf20Sopenharmony_ci .of_match_table = sprd_mcdt_of_match, 10038c2ecf20Sopenharmony_ci }, 10048c2ecf20Sopenharmony_ci}; 10058c2ecf20Sopenharmony_ci 10068c2ecf20Sopenharmony_cimodule_platform_driver(sprd_mcdt_driver); 10078c2ecf20Sopenharmony_ci 10088c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("Spreadtrum Multi-Channel Data Transfer Driver"); 10098c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL v2"); 1010