Files

2510 lines
68 KiB
C

/*
* Driver for Amlogic Meson SPI communication controller (SPICC)
*
* Copyright (C) BayLibre, SAS
* Author: Neil Armstrong <[email protected]>
*
* SPDX-License-Identifier: GPL-2.0+
*/
#include <linux/bitfield.h>
#include <linux/clk.h>
#include <linux/device.h>
#include <linux/io.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/of.h>
#ifdef CONFIG_AMLOGIC_MODIFY
#include <linux/of_device.h>
#include <linux/clk-provider.h>
#include <linux/dma-mapping.h>
#include <linux/amlogic/power_domain.h>
#include <linux/pm_runtime.h>
#include <linux/pm_domain.h>
#endif
#include <linux/platform_device.h>
#include <linux/spi/spi.h>
#include <linux/types.h>
#include <linux/interrupt.h>
#include <linux/reset.h>
#include <linux/gpio.h>
#include <linux/delay.h>
#include <linux/pinctrl/consumer.h>
#include <linux/pinctrl/devinfo.h>
#include <linux/amlogic/aml_spi.h>
#ifdef CONFIG_SPICC_TEST
#include "spicc_test.h"
#endif
/*
* The Meson SPICC controller could support DMA based transfers, but is not
* implemented by the vendor code, and while having the registers documentation
* it has never worked on the GXL Hardware.
* The PIO mode is the only mode implemented, and due to badly designed HW :
* - all transfers are cutted in 16 words burst because the FIFO hangs on
* TX underflow, and there is no TX "Half-Empty" interrupt, so we go by
* FIFO max size chunk only
* - CS management is dumb, and goes UP between every burst, so is really a
* "Data Valid" signal than a Chip Select, GPIO link should be used instead
* to have a CS go down over the full transfer
* G12 change list:
* - add a independent async clk for divider to raise the speed rate
* - incapable of half-full and overflow interrupts because of the async clk
* - burst max change from 16 to 15 because of the async clk
* DMA support:
* - use bits_per_word of xfer to distinguish what mode the protocol driver
requested, 64 indicates DMA mode while the others indicate PIO.
*/
#ifndef CONFIG_AMLOGIC_MODIFY
#define SPICC_MAX_FREQ 30000000
#endif
#define SPICC_MAX_BURST 128
/* Register Map */
#define SPICC_RXDATA 0x00
#define SPICC_TXDATA 0x04
#define SPICC_CONREG 0x08
#define SPICC_ENABLE BIT(0)
#define SPICC_MODE_MASTER BIT(1)
#define SPICC_XCH BIT(2)
#define SPICC_SMC BIT(3)
#define SPICC_POL BIT(4)
#define SPICC_PHA BIT(5)
#define SPICC_SSCTL BIT(6)
#define SPICC_SSPOL BIT(7)
#define SPICC_DRCTL_MASK GENMASK(9, 8)
#define SPICC_DRCTL_IGNORE 0
#define SPICC_DRCTL_FALLING 1
#define SPICC_DRCTL_LOWLEVEL 2
#define SPICC_CS_MASK GENMASK(13, 12)
#define SPICC_DATARATE_MASK GENMASK(18, 16)
#ifdef CONFIG_AMLOGIC_MODIFY
#define SPICC_DATARATE_SHIFT 16
#define SPICC_DATARATE_WIDTH 3
#endif
#define SPICC_DATARATE_DIV4 0
#define SPICC_DATARATE_DIV8 1
#define SPICC_DATARATE_DIV16 2
#define SPICC_DATARATE_DIV32 3
#define SPICC_BITLENGTH_MASK GENMASK(24, 19)
#define SPICC_BURSTLENGTH_MASK GENMASK(31, 25)
#define SPICC_INTREG 0x0c
#define SPICC_TE_EN BIT(0) /* TX FIFO Empty Interrupt */
#define SPICC_TH_EN BIT(1) /* TX FIFO Half-Full Interrupt */
#define SPICC_TF_EN BIT(2) /* TX FIFO Full Interrupt */
#define SPICC_RR_EN BIT(3) /* RX FIFO Ready Interrupt */
#define SPICC_RH_EN BIT(4) /* RX FIFO Half-Full Interrupt */
#define SPICC_RF_EN BIT(5) /* RX FIFO Full Interrupt */
#define SPICC_RO_EN BIT(6) /* RX FIFO Overflow Interrupt */
#define SPICC_TC_EN BIT(7) /* Transfer Complete Interrupt */
#define SPICC_TXFIFO_THRESHOLD_EN BIT(8) /* TX FIFO threshold */
#define SPICC_RXFIFO_THRESHOLD_EN BIT(9) /* RX FIFO threshold */
#define SPICC_RECV_TOTAL_EN BIT(10)/* total data received */
#define SPICC_SEND_TOTAL_EN BIT(11)/* total data send */
#define SPICC_DMA_DONE_EN BIT(12) /* DMA done */
#define SPICC_RE_EN BIT(13) /* RX FIFO empty */
#define SPICC_DMAREG 0x10
#define SPICC_DMA_ENABLE BIT(0)
#define SPICC_TXFIFO_THRESHOLD_MASK GENMASK(5, 1)
#define SPICC_TXFIFO_THRESHOLD_DEFAULT 10
#define SPICC_RXFIFO_THRESHOLD_MASK GENMASK(10, 6)
#define SPICC_READ_BURST_MASK GENMASK(14, 11)
#define SPICC_WRITE_BURST_MASK GENMASK(18, 15)
#define DMA_REQ_DEFAULT 8
#define SPICC_DMA_URGENT BIT(19)
#define SPICC_DMA_THREADID_MASK GENMASK(25, 20)
#define SPICC_DMA_BURSTNUM_MASK GENMASK(31, 26)
#define SPICC_STATREG 0x14
#define SPICC_TE BIT(0) /* TX FIFO Empty Interrupt */
#define SPICC_TH BIT(1) /* TX FIFO Half-Full Interrupt */
#define SPICC_TF BIT(2) /* TX FIFO Full Interrupt */
#define SPICC_RR BIT(3) /* RX FIFO Ready Interrupt */
#define SPICC_RH BIT(4) /* RX FIFO Half-Full Interrupt */
#define SPICC_RF BIT(5) /* RX FIFO Full Interrupt */
#define SPICC_RO BIT(6) /* RX FIFO Overflow Interrupt */
#define SPICC_TC BIT(7) /* Transfer Complete Interrupt */
#define SPICC_TXFIFO_THRESHOLD BIT(8) /* TX FIFO threshold */
#define SPICC_RXFIFO_THRESHOLD BIT(9) /* RX FIFO threshold */
#define SPICC_RECV_TOTAL_TRIG BIT(10)/* total data received */
#define SPICC_SEND_TOTAL_TRIG BIT(11)/* total data send */
#define SPICC_DMA_DONE BIT(12) /* DMA done */
#define SPICC_RE BIT(13) /* RX FIFO empty */
#define SPICC_PERIODREG 0x18
#define SPICC_PERIOD GENMASK(14, 0) /* Wait cycles */
#define SPICC_TESTREG 0x1c
#define SPICC_TXCNT_MASK GENMASK(4, 0) /* TX FIFO Counter */
#define SPICC_RXCNT_MASK GENMASK(9, 5) /* RX FIFO Counter */
#define SPICC_SMSTATUS_MASK GENMASK(12, 10) /* State Machine Status */
#ifdef CONFIG_AMLOGIC_MODIFY
#define SPICC_LBC BIT(14) /* Loop Back Control */
#define SPICC_SWAP BIT(15) /* RX FIFO Data Swap */
#define SPICC_MO_DELAY_MASK GENMASK(17, 16) /* Master Output Delay */
#define SPICC_MO_NO_DELAY 0
#define SPICC_MO_DELAY_1_CYCLE 1
#define SPICC_MO_DELAY_2_CYCLE 2
#define SPICC_MO_DELAY_3_CYCLE 3
#define SPICC_MI_DELAY_MASK GENMASK(19, 18) /* Master Input Delay */
#define SPICC_MI_NO_DELAY 0
#define SPICC_MI_DELAY_1_CYCLE 1
#define SPICC_MI_DELAY_2_CYCLE 2
#define SPICC_MI_DELAY_3_CYCLE 3
#define SPICC_MI_DELAY_MIN SPICC_MI_NO_DELAY
#define SPICC_MI_DELAY_MAX SPICC_MI_DELAY_3_CYCLE
#define SPICC_MI_CAP_DELAY_MASK GENMASK(21, 20) /* Master Capture Delay */
#define SPICC_CAP_AHEAD_2_CYCLE 0
#define SPICC_CAP_AHEAD_1_CYCLE 1
#define SPICC_CAP_NO_DELAY 2
#define SPICC_CAP_DELAY_1_CYCLE 3
#define SPICC_CAP_DELAY_MIN (-2)
#define SPICC_CAP_DELAY_MAX 1
#define SPICC_DELAY_MASK GENMASK(21, 16)
#define SPICC_FIFORST_MASK GENMASK(23, 22) /* FIFO Softreset */
#else
#define SPICC_LBC_RO BIT(13) /* Loop Back Control Read-Only */
#define SPICC_LBC_W1 BIT(14) /* Loop Back Control Write-Only */
#define SPICC_SWAP_RO BIT(14) /* RX FIFO Data Swap Read-Only */
#define SPICC_SWAP_W1 BIT(15) /* RX FIFO Data Swap Write-Only */
#define SPICC_DLYCTL_RO_MASK GENMASK(20, 15) /* Delay Control Read-Only */
#define SPICC_DLYCTL_W1_MASK GENMASK(21, 16) /* Delay Control Write-Only */
#define SPICC_FIFORST_RO_MASK GENMASK(22, 21) /* FIFO Softreset Read-Only */
#define SPICC_FIFORST_W1_MASK GENMASK(23, 22) /* FIFO Softreset Write-Only */
#endif
#define SPICC_DRADDR 0x20 /* Read Address of DMA */
#define SPICC_DWADDR 0x24 /* Write Address of DMA */
#ifdef CONFIG_AMLOGIC_MODIFY
#define SPICC_LD_CNTL0 0x28
#define VSYNC_IRQ_SRC_SELECT BIT(0)
#define DMA_EN_SET_BY_VSYNC BIT(2)
#define XCH_EN_SET_BY_VSYNC BIT(3)
#define DMA_READ_COUNTER_EN BIT(4)
#define DMA_WRITE_COUNTER_EN BIT(5)
#define DMA_RADDR_LOAD_BY_VSYNC BIT(6)
#define DMA_WADDR_LOAD_BY_VSYNC BIT(7)
#define DMA_ADDR_LOAD_FROM_LD_ADDR BIT(8)
#define SPICC_LD_CNTL1 0x2c
#define DMA_READ_COUNTER GENMASK(15, 0)
#define DMA_WRITE_COUNTER GENMASK(31, 16)
#define SMC_REQ_CNT_MAX 0xffff
#define DMA_BURST_MAX (DMA_REQ_DEFAULT * SMC_REQ_CNT_MAX)
#define SPICC_DMA_BYTES_PER_WORD 8
#define SPICC_LD_RADDR 0x30
#define SPICC_LD_WADDR 0x34
#define SPICC_ENH_CTL0 0x38 /* Enhanced Feature */
#define SPICC_ENH_CLK_CS_DELAY_MASK GENMASK(15, 0)
#define SPICC_ENH_DATARATE_MASK GENMASK(23, 16)
#define SPICC_ENH_DATARATE_SHIFT 16
#define SPICC_ENH_DATARATE_WIDTH 8
#define SPICC_ENH_DATARATE_EN BIT(24)
#define SPICC_ENH_MOSI_OEN BIT(25)
#define SPICC_ENH_CLK_OEN BIT(26)
#define SPICC_ENH_CS_OEN BIT(27)
#define SPICC_ENH_CLK_CS_DELAY_EN BIT(28)
#define SPICC_ENH_MAIN_CLK_AO BIT(29)
#define SPICC_ENH_CTL1 0x3c /* Enhanced Feature 1 */
#define SPICC_ENH_MI_CAP_DELAY_EN BIT(0)
#define SPICC_ENH_MI_CAP_DELAY_MASK GENMASK(9, 1)
#define SPICC_ENH_SI_CAP_DELAY_EN BIT(14) /* slave mode */
#define SPICC_ENH_DELAY_EN BIT(15)
#define SPICC_ENH_SI_DELAY_EN BIT(16) /* slave mode */
#define SPICC_ENH_SI_DELAY_MASK GENMASK(19, 17) /* slave mode */
#define SPICC_ENH_MI_DELAY_EN BIT(20)
#define SPICC_ENH_MI_DELAY_MASK GENMASK(23, 21)
#define SPICC_ENH_MO_DELAY_EN BIT(24)
#define SPICC_ENH_MO_DELAY_MASK GENMASK(27, 25)
#define SPICC_ENH_MO_OEN_DELAY_EN BIT(28)
#define SPICC_ENH_MO_OEN_DELAY_MASK GENMASK(31, 29)
#define SPICC_ENH_CTL2 0x40 /* Enhanced Feature */
#define SPICC_ENH_TT_DELAY_MASK GENMASK(14, 0)
#define SPICC_ENH_TT_DELAY_EN BIT(15)
#define SPICC_ENH_TI_DELAY_MASK GENMASK(30, 16)
#define SPICC_ENH_TI_DELAY_EN BIT(31)
#define SPICC_ENH_CTL3 0x44
#define SPICC_ENH_TXFIFO_THRESHOLD GENMASK(4, 0)
#define SPICC_ENH_RXFIFO_THRESHOLD GENMASK(9, 5)
#define SPICC_ENH_SLAVE_MODE BIT(10)
#define SPICC_ENH_WORD_MODE GENMASK(12, 11)
#define WORD_MODE_8_BYTE 0
#define WORD_MODE_4_BYTE 1
#define WORD_MODE_2_BYTE 2
#define WORD_MODE_1_BYTE 3
#define SPICC_ENH_LAST_TRIG_BY_SS BIT(13)
#define SPICC_ENH_CTL4 0x48
#define SPICC_ENH_RECV_THRESHOLD GENMASK(15, 0)
#define SPICC_ENH_SEND_THRESHOLD GENMASK(31, 16)
#define SPICC_ENH_CTL5 0x4c
#define SPICC_ENH_ENDIAN_TXFIFO GENMASK(23, 0)
#define SPICC_ENH_CTL6 0x50
#define SPICC_ENH_ENDIAN_RXFIFO GENMASK(23, 0)
/* for DMA */
#define LITTLE_ENDIAN_1 \
((0 << 21) | (1 << 18) | (2 << 15) | (3 << 12) \
| (4 << 9) | (5 << 6) | (6 << 3) | (7 << 0))
#define LITTLE_ENDIAN_2 \
((1 << 21) | (0 << 18) | (3 << 15) | (2 << 12) \
| (5 << 9) | (4 << 6) | (7 << 3) | (6 << 0))
#define LITTLE_ENDIAN_4 \
((3 << 21) | (2 << 18) | (1 << 15) | (0 << 12) \
| (7 << 9) | (6 << 6) | (5 << 3) | (4 << 0))
#define LITTLE_ENDIAN_8 \
((7 << 21) | (6 << 18) | (5 << 15) | (4 << 12) \
| (3 << 9) | (2 << 6) | (1 << 3) | (0 << 0))
/* for PIO */
#define BIG_ENDIAN_1 LITTLE_ENDIAN_8
#define BIG_ENDIAN_2 \
((6 << 21) | (7 << 18) | (4 << 15) | (5 << 12) \
| (2 << 9) | (3 << 6) | (0 << 3) | (1 << 0))
#define BIG_ENDIAN_4 \
((4 << 21) | (5 << 18) | (6 << 15) | (7 << 12) \
| (0 << 9) | (1 << 6) | (2 << 3) | (3 << 0))
#define BIG_ENDIAN_8 LITTLE_ENDIAN_1
#define SPICC_ENH_STATREG 0x54
#define SPICC_ENH_RECV_TOTAL GENMASK(15, 0)
#define SPICC_ENH_SEND_TOTAL GENMASK(31, 16)
#define SPICC_REGS_END (SPICC_ENH_STATREG + 4)
#endif
#define writel_bits_relaxed(mask, val, addr) \
writel_relaxed((readl_relaxed(addr) & ~(mask)) | (val), addr)
#ifdef CONFIG_AMLOGIC_MODIFY
static int SPICC_FIFO_SIZE = 16;
#else
#define SPICC_FIFO_SIZE 16
#endif
#define SPICC_FIFO_HALF 10
#ifdef CONFIG_AMLOGIC_MODIFY
struct meson_spicc_data {
unsigned int max_speed_hz;
bool has_linear_div;
bool has_oen;
bool has_async_clk;
bool is_div_parent_async_clk;
bool has_word_mode_ctrl;
bool has_endian_ctrl;
bool has_enh_intr;
bool support_dma_burst_len_1;
};
#endif
#define DIRSPI_STA_IDLE 0
#define DIRSPI_STA_READY 1
#define DIRSPI_STA_RUNNING 2
#ifdef CONFIG_AMLOGIC_MODIFY
static void meson_spicc_hw_prepare(struct meson_spicc_device *spicc,
u16 mode, u8 chip_select);
static int __meson_spicc_transfer_one(struct meson_spicc_device *spicc,
struct spi_transfer *xfer);
static void meson_spicc_dma_unmap(struct meson_spicc_device *spicc,
struct spi_transfer *t);
static int meson_spi_delay_to_ns(struct spi_delay *_delay);
static int meson_spicc_runtime_suspend(struct device *dev);
static int meson_spicc_runtime_resume(struct device *dev);
static void dirspi_set_cs(struct spi_device *spi, bool enable);
static void dirspi_start(struct spi_device *spi);
static void dirspi_stop(struct spi_device *spi);
static int dirspi_async(struct spi_device *spi,
dma_addr_t tx_dma,
dma_addr_t rx_dma,
int len,
void (*complete)(void *context),
void *context);
static int dirspi_sync(struct spi_device *spi,
dma_addr_t tx_dma,
dma_addr_t rx_dma,
int len);
static int dirspi_xfer(struct spi_device *spi,
u8 *tx_buf,
u8 *rx_buf,
int len);
static int dirspi_dma_trig(struct spi_device *spi,
dma_addr_t tx_dma,
dma_addr_t rx_dma,
#ifdef CONFIG_SPI_PING_PONG
dma_addr_t tx_dma_pong,
dma_addr_t rx_dma_pong,
#endif
int len,
u8 src);
static int dirspi_dma_trig_start(struct spi_device *spi);
static int dirspi_dma_trig_stop(struct spi_device *spi);
static int dirspi_dma_trig_release(struct spi_device *spi);
static int dirspi_busy_proc(struct spi_device *spi);
static unsigned int meson_spicc_flags = BIT(1);
module_param(meson_spicc_flags, uint, 0644);
MODULE_PARM_DESC(meson_spicc_flags, "meson spicc flags");
#define is_busy_reset() (meson_spicc_flags & BIT(0))
#define pio_polling_en() (meson_spicc_flags & BIT(1))
static int xLimitRange(int val, int min, int max)
{
int ret;
if (val < min)
ret = min;
else if (val > max)
ret = max;
else
ret = val;
return ret;
}
static void meson_spicc_main_clk_ao(struct meson_spicc_device *spicc, bool en)
{
if (spicc->data->has_oen)
writel_bits_relaxed(SPICC_ENH_MAIN_CLK_AO,
en ? SPICC_ENH_MAIN_CLK_AO : 0,
spicc->base + SPICC_ENH_CTL0);
}
static int ns_to_clk(unsigned long clk_rate, int ns)
{
unsigned long abs_ns = abs(ns);
int n_clk;
n_clk = DIV_ROUND_CLOSEST_ULL(clk_rate * abs_ns, 1000000000);
if (ns < 0)
n_clk = 0 - n_clk;
return n_clk;
}
static void meson_spicc_set_cs_setup(struct meson_spicc_device *spicc,
int n_pclk)
{
u32 conf;
conf = readl_relaxed(spicc->base + SPICC_ENH_CTL0);
conf &= ~(SPICC_ENH_CLK_CS_DELAY_MASK | SPICC_ENH_CLK_CS_DELAY_EN);
if (n_pclk) {
conf |= FIELD_PREP(SPICC_ENH_CLK_CS_DELAY_MASK, n_pclk);
conf |= SPICC_ENH_CLK_CS_DELAY_EN;
}
writel_relaxed(conf, spicc->base + SPICC_ENH_CTL0);
}
static void meson_spicc_set_cs_hold(struct meson_spicc_device *spicc,
int n_pclk)
{
u32 conf;
conf = readl_relaxed(spicc->base + SPICC_ENH_CTL2);
conf &= ~(SPICC_ENH_TT_DELAY_MASK | SPICC_ENH_TT_DELAY_EN);
if (n_pclk) {
conf |= FIELD_PREP(SPICC_ENH_TT_DELAY_MASK, n_pclk);
conf |= SPICC_ENH_TT_DELAY_EN;
}
writel_relaxed(conf, spicc->base + SPICC_ENH_CTL2);
}
static void meson_spicc_input_tune(struct meson_spicc_device *spicc,
int n_pclk)
{
u32 conf;
int div, shift;
int mi_delay = 0, cap_delay = 0;
conf = spicc->data->has_linear_div ?
readl_relaxed(spicc->base + SPICC_ENH_CTL0) : 0;
if (conf & SPICC_ENH_DATARATE_EN) {
div = conf & SPICC_ENH_DATARATE_MASK;
div >>= SPICC_ENH_DATARATE_SHIFT;
div++;
div <<= 1;
} else {
conf = readl_relaxed(spicc->base + SPICC_CONREG);
div = conf & SPICC_DATARATE_MASK;
div >>= SPICC_DATARATE_SHIFT;
div += 2;
div = 1 << div;
}
conf = readl_relaxed(spicc->base + SPICC_TESTREG);
if (conf & SPICC_LBC) {
of_property_read_s32(spicc->pdev->dev.of_node,
"loopback_mi_delay", &mi_delay);
of_property_read_s32(spicc->pdev->dev.of_node,
"loopback_cap_delay", &cap_delay);
} else {
shift = n_pclk - (div >> 1);
cap_delay = xLimitRange(shift, SPICC_CAP_DELAY_MIN,
SPICC_CAP_DELAY_MAX);
mi_delay = xLimitRange(cap_delay - shift, SPICC_MI_DELAY_MIN,
SPICC_MI_DELAY_MAX);
cap_delay += 2;
}
conf &= ~(SPICC_MO_DELAY_MASK | SPICC_MI_DELAY_MASK
| SPICC_MI_CAP_DELAY_MASK);
conf |= FIELD_PREP(SPICC_MI_DELAY_MASK, mi_delay);
conf |= FIELD_PREP(SPICC_MI_CAP_DELAY_MASK, cap_delay);
writel_relaxed(conf, spicc->base + SPICC_TESTREG);
dev_dbg(&spicc->pdev->dev,
"latency %d, div %d, mi_delay %d, cap_delay %d\n",
n_pclk, div, mi_delay, cap_delay - 2);
}
static inline void meson_spicc_reset_fifo(struct meson_spicc_device *spicc)
{
/* disable/enable to clean the residue of last transfer */
writel_bits_relaxed(SPICC_ENABLE, 0,
spicc->base + SPICC_CONREG);
writel_bits_relaxed(SPICC_ENABLE, 1,
spicc->base + SPICC_CONREG);
writel_bits_relaxed(SPICC_FIFORST_MASK,
FIELD_PREP(SPICC_FIFORST_MASK, 3),
spicc->base + SPICC_TESTREG);
}
static void meson_spicc_set_width(struct meson_spicc_device *spicc, int width)
{
if (width && width != spicc->bits_per_word) {
spicc->bits_per_word = width;
writel_bits_relaxed(SPICC_BITLENGTH_MASK,
FIELD_PREP(SPICC_BITLENGTH_MASK, width - 1),
spicc->base + SPICC_CONREG);
}
}
static void meson_spicc_set_endian(struct meson_spicc_device *spicc,
bool big_endian)
{
u32 endian;
if (!spicc->data->has_endian_ctrl) {
return;
} else if (spicc->using_dma) {
if (big_endian)
endian = BIG_ENDIAN_8;
else if (spicc->bytes_per_word == 1)
endian = LITTLE_ENDIAN_1;
else if (spicc->bytes_per_word == 2)
endian = LITTLE_ENDIAN_2;
else if (spicc->bytes_per_word == 4)
endian = LITTLE_ENDIAN_4;
else if (spicc->bytes_per_word == 8)
endian = LITTLE_ENDIAN_8;
else
return;
} else {
if (!big_endian)
endian = LITTLE_ENDIAN_8;
else if (spicc->bytes_per_word == 1)
endian = BIG_ENDIAN_1;
else if (spicc->bytes_per_word == 2)
endian = BIG_ENDIAN_2;
else if (spicc->bytes_per_word == 4)
endian = BIG_ENDIAN_4;
else if (spicc->bytes_per_word == 8)
endian = BIG_ENDIAN_8;
else
return;
}
if (spicc->endian != endian) {
writel_relaxed(endian, spicc->base + SPICC_ENH_CTL5);
writel_relaxed(endian, spicc->base + SPICC_ENH_CTL6);
spicc->endian = endian;
}
}
static void meson_spicc_set_word_mode(struct meson_spicc_device *spicc)
{
u32 word_mode, val;
if (!spicc->data->has_word_mode_ctrl)
return;
else if (!spicc->using_dma)
word_mode = WORD_MODE_8_BYTE;
else if (spicc->bytes_per_word == 1)
word_mode = WORD_MODE_1_BYTE;
else if (spicc->bytes_per_word == 2)
word_mode = WORD_MODE_2_BYTE;
else if (spicc->bytes_per_word == 4)
word_mode = WORD_MODE_4_BYTE;
else
word_mode = WORD_MODE_8_BYTE;
if (spicc->wordmode != word_mode) {
val = FIELD_PREP(SPICC_ENH_WORD_MODE, word_mode);
val |= SPICC_ENH_SLAVE_MODE | SPICC_ENH_LAST_TRIG_BY_SS;
writel_relaxed(val, spicc->base + SPICC_ENH_CTL3);
spicc->wordmode = word_mode;
}
}
static int __meson_spicc_set_speed(struct meson_spicc_device *spicc, int hz)
{
u32 div = 0, conf = 0;
conf = readl_relaxed(spicc->base + SPICC_ENH_CTL0);
conf &= ~SPICC_ENH_DATARATE_MASK;
conf |= SPICC_ENH_DATARATE_EN;
div = DIV_ROUND_UP(spicc->pclk_rate, hz);
if (div % 2)
div++;
if (div < 4)
div = 4;
else if (div > 512)
div = 512;
div = (div >> 1) - 1;
conf |= div << SPICC_ENH_DATARATE_SHIFT;
writel_relaxed(conf, spicc->base + SPICC_ENH_CTL0);
return 0;
}
static int meson_spicc_set_speed(struct meson_spicc_device *spicc, int hz, struct spi_device *spi)
{
struct spicc_controller_data *cdata = spi->controller_data;
bool changed = false;
int ns, n_pclk;
int ret = 0;
/* Setup clock speed */
if (!spi_controller_is_target(spicc->controller) && hz &&
spicc->speed_hz != hz) {
spicc->speed_hz = hz;
if (spicc->parent_clk_fixed && spicc->data->has_linear_div) {
ret = __meson_spicc_set_speed(spicc, hz);
} else {
unsigned int pclk_rate;
ret = clk_set_rate(spicc->clk, hz);
pclk_rate = clk_get_rate
(spicc->data->is_div_parent_async_clk ?
spicc->async_clk : spicc->core);
if (spicc->pclk_rate != pclk_rate) {
changed = true;
spicc->pclk_rate = pclk_rate;
}
}
if (ret) {
dev_err(&spicc->pdev->dev, "set clk rate failed\n");
return ret;
}
}
if (cdata && cdata->use_ctrl_cs) {
ns = cdata->ss_leading_gap * NSEC_PER_USEC;
} else if (spi_is_csgpiod(spi)) {
ns = 0;
} else {
ns = meson_spi_delay_to_ns(&spi->cs_setup);
if (ns < 0)
ns = spicc->cs_setup_default;
}
if (changed || spicc->cs_setup_applied != ns) {
spicc->cs_setup_applied = ns;
n_pclk = ns_to_clk(spicc->pclk_rate, ns);
meson_spicc_set_cs_setup(spicc, n_pclk);
}
if (cdata && cdata->use_ctrl_cs) {
ns = cdata->ss_trailing_gap * NSEC_PER_USEC;
} else if (spi_is_csgpiod(spi)) {
ns = 0;
} else {
ns = meson_spi_delay_to_ns(&spi->cs_hold);
if (ns < 0)
ns = spicc->cs_hold_default;
}
if (changed || spicc->cs_hold_applied != ns) {
spicc->cs_hold_applied = ns;
n_pclk = ns_to_clk(spicc->pclk_rate, ns);
meson_spicc_set_cs_hold(spicc, n_pclk);
}
if (cdata && cdata->miso_latency_en) {
ns = cdata->miso_latency;
if (changed || spicc->miso_latency_applied != ns) {
spicc->miso_latency_applied = ns;
n_pclk = ns_to_clk(spicc->pclk_rate, ns);
meson_spicc_input_tune(spicc, n_pclk);
}
} else if (changed || spicc->miso_latency_applied != 0x7FFFFFFF) {
spicc->miso_latency_applied = 0x7FFFFFFF;
meson_spicc_input_tune(spicc, spicc->miso_latency_default);
}
return ret;
}
static u8 meson_spicc_get_ctrl_cs_line(struct spi_device *spi)
{
u8 idx, ret = 0;
for (idx = 0; idx < MESON_SPI_CS_CNT_MAX; idx++) {
if (spi->cs_index_mask & BIT(idx))
return spi_get_chipselect(spi, idx);
}
ret = SPICC_DEFAULT_CS;
return ret;
}
static void _meson_spi_delay_exec(u32 ns)
{
if (!ns)
return;
if (ns <= NSEC_PER_USEC) {
ndelay(ns);
} else {
u32 us = DIV_ROUND_UP(ns, NSEC_PER_USEC);
if (us > 10)
us = 10;
udelay(us);
}
}
static int meson_spi_delay_to_ns(struct spi_delay *_delay)
{
u32 delay = _delay->value;
u32 unit = _delay->unit;
switch (unit) {
case SPI_DELAY_UNIT_USECS:
delay *= NSEC_PER_USEC;
break;
case SPI_DELAY_UNIT_NSECS:
/* Nothing to do here */
break;
default:
return -EINVAL;
}
return delay;
}
static int meson_spi_delay_exec(struct spi_delay *_delay)
{
int delay;
if (!_delay)
return -EINVAL;
delay = meson_spi_delay_to_ns(_delay);
if (delay < 0)
return delay;
_meson_spi_delay_exec(delay);
return 0;
}
static inline void swap32phl(u32 *p)
{
u32 tmp = *p;
*p = (tmp << 16) | (tmp >> 16);
}
static inline u64 swap64hl(u64 val)
{
return (val << 32) | (val >> 32);
}
static void meson_spicc_memcpy_swap64(void *dist,
void *src,
int len,
u8 bytes_per_word)
{
u64 *dist64 = dist;
u64 *src64 = src;
u32 *dist32 = dist;
u32 words = DIV_ROUND_UP(len, SPICC_DMA_BYTES_PER_WORD);
if (bytes_per_word == 1) {
while (words--)
*dist64++ = swab64(*src64++);
} else if (bytes_per_word == 2) {
while (words--) {
*dist64++ = swap64hl(*src64++);
swap32phl(dist32++);
swap32phl(dist32++);
}
} else if (bytes_per_word == 4) {
while (words--)
*dist64++ = swap64hl(*src64++);
}
}
static void meson_spicc_split_xfer(struct meson_spicc_device *spicc,
struct spi_transfer *xfer,
struct spi_transfer *dma_xfer,
struct spi_transfer *pio_xfer)
{
struct spicc_controller_data *cdata = (struct spicc_controller_data *)
spicc->spi->controller_data;
u32 pio_len, dma_len, words;
dma_xfer->len = 0;
pio_xfer->len = 0;
pio_len = xfer->len % SPICC_DMA_BYTES_PER_WORD;
dma_len = xfer->len - pio_len;
words = DIV_ROUND_UP(dma_len, SPICC_DMA_BYTES_PER_WORD);
if (!cdata || !cdata->split_xfer_en ||
xfer->bits_per_word == 64 || !dma_len ||
(!spicc->data->support_dma_burst_len_1 && words == 1) ||
(spicc->data->has_word_mode_ctrl && !pio_len))
return;
words %= DMA_BURST_MAX;
if ((words == 1 && !spicc->data->support_dma_burst_len_1) ||
(words > SPICC_FIFO_SIZE &&
words % 2 && words % 3 && words % 5 && words % 7)) {
dma_len -= SPICC_DMA_BYTES_PER_WORD;
pio_len += SPICC_DMA_BYTES_PER_WORD;
}
memcpy(dma_xfer, xfer, sizeof(*xfer));
dma_xfer->len = dma_len;
if (!spicc->data->has_word_mode_ctrl) {
dma_xfer->bits_per_word = 64;
if (xfer->tx_buf) {
dma_xfer->tx_buf = kzalloc(dma_len, GFP_KERNEL | GFP_DMA);
if (!dma_xfer->tx_buf) {
dma_xfer->len = 0;
return;
}
meson_spicc_memcpy_swap64((void *)dma_xfer->tx_buf,
(void *)xfer->tx_buf,
dma_len,
DIV_ROUND_UP(xfer->bits_per_word, 8));
}
if (xfer->rx_buf) {
dma_xfer->rx_buf = kzalloc(dma_len, GFP_KERNEL | GFP_DMA);
if (!dma_xfer->rx_buf) {
kfree(dma_xfer->tx_buf);
dma_xfer->len = 0;
return;
}
}
}
if (pio_len) {
memcpy(pio_xfer, xfer, sizeof(*xfer));
pio_xfer->len = pio_len;
if (pio_xfer->tx_buf)
pio_xfer->tx_buf += dma_len;
if (pio_xfer->rx_buf)
pio_xfer->rx_buf += dma_len;
}
}
static void meson_spicc_split_xfer_dma_release
(struct meson_spicc_device *spicc,
struct spi_transfer *orig_xfer,
struct spi_transfer *xfer,
bool rx_success)
{
struct spicc_controller_data *cdata = (struct spicc_controller_data *)
spicc->spi->controller_data;
if (!cdata || !cdata->split_xfer_en ||
!xfer->len || spicc->data->has_word_mode_ctrl)
return;
if (rx_success && xfer->rx_buf && orig_xfer->rx_buf)
meson_spicc_memcpy_swap64(orig_xfer->rx_buf,
xfer->rx_buf,
xfer->len,
DIV_ROUND_UP(orig_xfer->bits_per_word, 8));
kfree(xfer->tx_buf);
kfree(xfer->rx_buf);
xfer->len = 0;
}
static void meson_spicc_split_xfer_pio_release
(struct meson_spicc_device *spicc,
struct spi_transfer *orig_xfer,
struct spi_transfer *xfer)
{
(void)spicc;
(void)orig_xfer;
xfer->len = 0;
}
static int meson_spicc_dma_map(struct meson_spicc_device *spicc,
struct spi_transfer *t)
{
struct device *dev = spicc->controller->dev.parent;
int ret = 0;
spicc->tx_dma_mapped = false;
spicc->rx_dma_mapped = false;
if (t->tx_buf && !t->tx_dma) {
t->tx_dma = dma_map_single(dev, (void *)t->tx_buf, t->len,
DMA_TO_DEVICE);
if (dma_mapping_error(dev, t->tx_dma)) {
dev_err(dev, "tx_dma map failed\n");
ret = -ENOMEM;
} else {
spicc->tx_dma_mapped = true;
}
}
if (t->rx_buf && !t->rx_dma) {
t->rx_dma = dma_map_single(dev, t->rx_buf, t->len,
DMA_FROM_DEVICE);
if (dma_mapping_error(dev, t->rx_dma)) {
dev_err(dev, "rx_dma map failed\n");
ret = -ENOMEM;
} else {
spicc->rx_dma_mapped = true;
}
}
if (ret)
meson_spicc_dma_unmap(spicc, t);
return ret;
}
static void meson_spicc_dma_unmap(struct meson_spicc_device *spicc,
struct spi_transfer *t)
{
struct device *dev = spicc->controller->dev.parent;
if (spicc->tx_dma_mapped) {
dma_unmap_single(dev, t->tx_dma, t->len, DMA_TO_DEVICE);
t->tx_dma = 0;
spicc->tx_dma_mapped = false;
}
if (spicc->rx_dma_mapped) {
dma_unmap_single(dev, t->rx_dma, t->len, DMA_FROM_DEVICE);
t->rx_dma = 0;
spicc->rx_dma_mapped = false;
}
}
static u32 meson_spicc_calc_dma_len(struct meson_spicc_device *spicc, u32 *req)
{
u32 len = spicc->tx_remain;
u32 i;
if (len <= SPICC_FIFO_SIZE) {
*req = len;
return len;
}
*req = DMA_REQ_DEFAULT;
if (len == (DMA_BURST_MAX + 1)) {
len = DMA_BURST_MAX - DMA_REQ_DEFAULT;
} else if (len >= DMA_BURST_MAX) {
len = DMA_BURST_MAX;
} else {
/* 1 < len < DMA_BURST_MAX */
for (i = DMA_REQ_DEFAULT; i > 1; i--) {
if ((len % i) == 0) {
*req = i;
return len;
}
}
if (spicc->data->support_dma_burst_len_1) {
*req = 1;
return len;
}
if ((len % DMA_REQ_DEFAULT) == 1)
len -= DMA_REQ_DEFAULT;
len -= len % DMA_REQ_DEFAULT;
}
return len;
}
static void meson_spicc_setup_dma_burst(struct meson_spicc_device *spicc,
bool tx, bool rx, u8 trig_src)
{
unsigned int words, req;
unsigned int count_en = 0;
unsigned int txfifo_thres = 0;
unsigned int read_req = 0;
unsigned int rxfifo_thres = 31;
unsigned int write_req = 0;
unsigned int ld_ctr1 = 0;
words = meson_spicc_calc_dma_len(spicc, &req);
/* Setup Xfer variables */
spicc->tx_remain -= words;
words /= req;
if (trig_src == DMA_TRIG_LINE_N)
count_en |= VSYNC_IRQ_SRC_SELECT;
if (tx) {
count_en |= DMA_READ_COUNTER_EN;
if (trig_src == DMA_TRIG_VSYNC || trig_src == DMA_TRIG_LINE_N)
count_en |= DMA_RADDR_LOAD_BY_VSYNC
| DMA_ADDR_LOAD_FROM_LD_ADDR;
txfifo_thres = SPICC_FIFO_SIZE + 1 - req;
read_req = req - 1;
ld_ctr1 |= FIELD_PREP(DMA_READ_COUNTER, words);
}
if (rx) {
count_en |= DMA_WRITE_COUNTER_EN;
if (trig_src == DMA_TRIG_VSYNC || trig_src == DMA_TRIG_LINE_N)
count_en |= DMA_WADDR_LOAD_BY_VSYNC
| DMA_ADDR_LOAD_FROM_LD_ADDR;
rxfifo_thres = req - 1;
write_req = req - 1;
ld_ctr1 |= FIELD_PREP(DMA_WRITE_COUNTER, words);
}
/* Enable DMA write/read counter */
writel_relaxed(count_en, spicc->base + SPICC_LD_CNTL0);
/* Setup burst length */
writel_relaxed(ld_ctr1, spicc->base + SPICC_LD_CNTL1);
writel_relaxed(((trig_src == DMA_TRIG_NORMAL) ? SPICC_DMA_ENABLE : 0)
| SPICC_DMA_URGENT
| FIELD_PREP(SPICC_TXFIFO_THRESHOLD_MASK, txfifo_thres)
| FIELD_PREP(SPICC_READ_BURST_MASK, read_req)
| FIELD_PREP(SPICC_RXFIFO_THRESHOLD_MASK, rxfifo_thres)
| FIELD_PREP(SPICC_WRITE_BURST_MASK, write_req),
spicc->base + SPICC_DMAREG);
}
static void meson_spicc_dma_irq(struct meson_spicc_device *spicc)
{
u32 count;
unsigned long timeout;
if (!spicc->tx_remain) {
/* Disable all IRQs */
writel_relaxed(0, spicc->base + SPICC_INTREG);
writel_bits_relaxed(SPICC_XCH | SPICC_SMC, 0,
spicc->base + SPICC_CONREG);
if (spicc->data->has_enh_intr && spicc->rx_remain < 0x10000) {
timeout = ktime_get_ns() + 1000000;
while (time_before((unsigned long)ktime_get_ns(), timeout)) {
count = readl_relaxed(spicc->base + SPICC_ENH_STATREG);
if ((count & 0xffff) >= spicc->rx_remain)
break;
}
}
if (!spicc->complete) {
meson_spicc_dma_unmap(spicc, spicc->xfer);
meson_spicc_split_xfer_dma_release(spicc,
spicc->orig_xfer,
&spicc->dma_xfer,
true);
if (spicc->pio_xfer.len) {
meson_spicc_reset_fifo(spicc);
__meson_spicc_transfer_one(spicc, &spicc->pio_xfer);
} else {
spi_finalize_current_transfer(spicc->controller);
spicc->pending = false;
}
} else {
dirspi_set_cs(spicc->spi, false);
spicc->complete(spicc->context);
spicc->complete = NULL;
spicc->pending = false;
}
return;
}
/* Setup burst */
meson_spicc_setup_dma_burst(spicc,
spicc->tx_buf ? true : false,
spicc->rx_buf ? true : false,
DMA_TRIG_NORMAL);
}
#endif
static inline bool meson_spicc_txfull(struct meson_spicc_device *spicc)
{
return !!FIELD_GET(SPICC_TF,
readl_relaxed(spicc->base + SPICC_STATREG));
}
static inline bool meson_spicc_rxready(struct meson_spicc_device *spicc)
{
return FIELD_GET(SPICC_RH | SPICC_RR | SPICC_RF_EN,
readl_relaxed(spicc->base + SPICC_STATREG));
}
static inline u32 meson_spicc_pull_data(struct meson_spicc_device *spicc)
{
unsigned int bytes = min_t(unsigned int, 4, spicc->bytes_per_word);
unsigned int byte_shift = 0;
u32 data = 0;
u8 byte;
if (!spicc->tx_buf)
return 0;
while (bytes--) {
byte = *spicc->tx_buf++;
data |= (byte & 0xff) << byte_shift;
byte_shift += 8;
}
return data;
}
static inline void meson_spicc_push_data(struct meson_spicc_device *spicc,
u32 data)
{
unsigned int bytes = min_t(unsigned int, 4, spicc->bytes_per_word);
unsigned int byte_shift = 0;
u8 byte;
if (!spicc->rx_buf)
return;
while (bytes--) {
byte = (data >> byte_shift) & 0xff;
*spicc->rx_buf++ = byte;
byte_shift += 8;
}
}
static inline void meson_spicc_rx(struct meson_spicc_device *spicc)
{
u32 val;
/* Empty RX FIFO */
while (spicc->rx_remain &&
meson_spicc_rxready(spicc)) {
val = readl_relaxed(spicc->base + SPICC_RXDATA);
if (spicc->bytes_per_word > 4)
meson_spicc_push_data(spicc,
readl_relaxed(spicc->base + SPICC_RXDATA));
meson_spicc_push_data(spicc, val);
spicc->rx_remain--;
}
}
static inline void meson_spicc_tx(struct meson_spicc_device *spicc)
{
u32 val;
/* Fill Up TX FIFO */
while (spicc->tx_remain &&
!meson_spicc_txfull(spicc)) {
val = meson_spicc_pull_data(spicc);
if (spicc->bytes_per_word > 4)
writel_relaxed(meson_spicc_pull_data(spicc),
spicc->base + SPICC_TXDATA);
writel_relaxed(val, spicc->base + SPICC_TXDATA);
spicc->tx_remain--;
}
}
static int meson_spicc_pio_polling(struct meson_spicc_device *spicc)
{
unsigned long timeout;
writel_relaxed(0, spicc->base + SPICC_DMAREG);
meson_spicc_tx(spicc);
if (spicc->tx_remain) {
dev_err(&spicc->pdev->dev, "fifo residue\n");
meson_spicc_reset_fifo(spicc);
return -EIO;
}
writel_bits_relaxed(SPICC_XCH, SPICC_XCH, spicc->base + SPICC_CONREG);
timeout = ktime_get_ns() + 100000000;
while (spicc->rx_remain &&
time_before((unsigned long)ktime_get_ns(), timeout))
meson_spicc_rx(spicc);
writel_bits_relaxed(SPICC_TC, SPICC_TC, spicc->base + SPICC_STATREG);
return spicc->rx_remain ? -ETIMEDOUT : 0;
}
static void meson_spicc_hw_prepare(struct meson_spicc_device *spicc,
u16 mode, u8 chip_select)
{
u32 conf = 0;
meson_spicc_reset_fifo(spicc);
/* Disable all IRQs */
writel_relaxed(0, spicc->base + SPICC_INTREG);
/* Setup no wait cycles by default */
writel_relaxed(0, spicc->base + SPICC_PERIODREG);
conf = readl_relaxed(spicc->base + SPICC_TESTREG);
conf &= ~SPICC_LBC;
if (mode & SPI_LOOP)
conf |= SPICC_LBC;
writel_relaxed(conf, spicc->base + SPICC_TESTREG);
conf = readl_relaxed(spicc->base + SPICC_CONREG);
/* Setup burst length max */
conf |= SPICC_BURSTLENGTH_MASK;
conf &= ~(SPICC_POL | SPICC_PHA | SPICC_SSPOL | SPI_READY
| SPICC_SSCTL | SPICC_SMC | SPICC_XCH | SPICC_CS_MASK);
conf |= FIELD_PREP(SPICC_CS_MASK, chip_select);
if (spicc->toggle_cs_every_word)
conf |= SPICC_SSCTL;
/* Setup transfer mode */
if (mode & SPI_CPOL)
conf |= SPICC_POL;
if (mode & SPI_CPHA)
conf |= SPICC_PHA;
if (mode & SPI_CS_HIGH)
conf |= SPICC_SSPOL;
if (mode & SPI_READY)
conf |= FIELD_PREP(SPICC_DRCTL_MASK, SPICC_DRCTL_LOWLEVEL);
writel_relaxed(conf, spicc->base + SPICC_CONREG);
/* take effect such as sclk polarity */
meson_spicc_main_clk_ao(spicc, true);
meson_spicc_main_clk_ao(spicc, false);
}
static irqreturn_t meson_spicc_irq(int irq, void *data)
{
struct meson_spicc_device *spicc = (void *)data;
unsigned long timeout;
unsigned long flags;
spin_lock_irqsave(&spicc->lock, flags);
if (!spicc->pending) {
spin_unlock_irqrestore(&spicc->lock, flags);
return IRQ_HANDLED;
}
if (readl_relaxed(spicc->base + SPICC_DMAREG) & SPICC_DMA_ENABLE) {
spin_unlock_irqrestore(&spicc->lock, flags);
return IRQ_HANDLED;
}
/* Wait TE */
timeout = ktime_get_ns() + 1000000;
while (!(readl_relaxed(spicc->base + SPICC_STATREG) & SPICC_TE)) {
if (time_after((unsigned long)ktime_get_ns(), timeout)) {
spicc->tx_remain = 0;
spicc->rx_remain = 0;
break;
}
}
/* Clear TC bit */
if (readl_relaxed(spicc->base + SPICC_STATREG) & SPICC_TC)
writel_bits_relaxed(SPICC_TC, SPICC_TC,
spicc->base + SPICC_STATREG);
#ifdef CONFIG_AMLOGIC_MODIFY
if (spicc->using_dma) {
meson_spicc_dma_irq(spicc);
spin_unlock_irqrestore(&spicc->lock, flags);
return IRQ_HANDLED;
}
#endif
/* Empty RX FIFO */
meson_spicc_rx(spicc);
if (spicc->tx_remain) {
meson_spicc_tx(spicc);
writel_bits_relaxed(SPICC_XCH, SPICC_XCH,
spicc->base + SPICC_CONREG);
} else {
/* Wait the last data received */
timeout = ktime_get_ns() + 1000000;
while (spicc->rx_remain &&
time_before((unsigned long)ktime_get_ns(), timeout))
meson_spicc_rx(spicc);
/* Disable all IRQs */
writel_relaxed(0, spicc->base + SPICC_INTREG);
writel_bits_relaxed(SPICC_XCH | SPICC_SMC, 0,
spicc->base + SPICC_CONREG);
if (!spicc->complete) {
meson_spicc_split_xfer_pio_release(spicc,
spicc->orig_xfer,
&spicc->pio_xfer);
spi_finalize_current_transfer(spicc->controller);
} else {
dirspi_set_cs(spicc->spi, false);
spicc->complete(spicc->context);
spicc->complete = NULL;
}
spicc->pending = false;
}
spin_unlock_irqrestore(&spicc->lock, flags);
return IRQ_HANDLED;
}
static int __meson_spicc_transfer_one(struct meson_spicc_device *spicc,
struct spi_transfer *xfer)
{
int ret;
/* Store current transfer */
spicc->xfer = xfer;
/* Setup transfer parameters */
spicc->tx_buf = (u8 *)xfer->tx_buf;
spicc->rx_buf = (u8 *)xfer->rx_buf;
/* Pre-calculate word size */
spicc->bytes_per_word =
DIV_ROUND_UP(spicc->xfer->bits_per_word, 8);
/* Setup transfer parameters */
if (((xfer->len % SPICC_DMA_BYTES_PER_WORD) == 0) &&
(spicc->data->support_dma_burst_len_1 || xfer->len >= 16) &&
(spicc->data->has_word_mode_ctrl || xfer->bits_per_word == 64)) {
spicc->using_dma = 1;
spicc->tx_remain = xfer->len / SPICC_DMA_BYTES_PER_WORD;
spicc->rx_remain = spicc->tx_remain;
} else {
spicc->using_dma = 0;
spicc->tx_remain = xfer->len / spicc->bytes_per_word;
spicc->rx_remain = spicc->tx_remain;
}
meson_spicc_set_width(spicc, xfer->bits_per_word);
meson_spicc_set_endian(spicc, spicc->spi->mode & SPI_LSB_FIRST);
meson_spicc_set_word_mode(spicc);
meson_spicc_set_speed(spicc, xfer->speed_hz, spicc->spi);
writel_relaxed(0, spicc->base + SPICC_DMAREG);
if (spicc->using_dma) {
ret = meson_spicc_dma_map(spicc, xfer);
if (ret)
return ret;
writel_relaxed(xfer->tx_dma, spicc->base + SPICC_DRADDR);
writel_relaxed(xfer->rx_dma, spicc->base + SPICC_DWADDR);
writel_relaxed(xfer->speed_hz >> 25,
spicc->base + SPICC_PERIODREG);
meson_spicc_setup_dma_burst(spicc,
spicc->tx_buf ? true : false,
spicc->rx_buf ? true : false,
DMA_TRIG_NORMAL);
writel_relaxed(spicc->data->has_enh_intr ?
SPICC_DMA_DONE_EN : SPICC_TE_EN,
spicc->base + SPICC_INTREG);
spicc->pending = true;
writel_bits_relaxed(SPICC_SMC | SPICC_XCH,
SPICC_SMC, spicc->base + SPICC_CONREG);
} else {
meson_spicc_tx(spicc);
writel_relaxed(spi_controller_is_target(spicc->controller) ?
SPICC_RR_EN : SPICC_TC_EN, spicc->base + SPICC_INTREG);
spicc->pending = true;
writel_bits_relaxed(SPICC_SMC | SPICC_XCH,
SPICC_XCH, spicc->base + SPICC_CONREG);
}
return 1;
}
static int meson_spicc_transfer_one(struct spi_controller *ctlr,
struct spi_device *spi,
struct spi_transfer *xfer)
{
struct meson_spicc_device *spicc = spi_controller_get_devdata(ctlr);
int ret;
/* Store current transfer */
spicc->spi = spi;
spicc->orig_xfer = xfer;
spicc->complete = NULL;
spicc->tx_buf = (u8 *)xfer->tx_buf;
spicc->rx_buf = (u8 *)xfer->rx_buf;
spicc->bytes_per_word = DIV_ROUND_UP(xfer->bits_per_word, 8);
spicc->tx_remain = xfer->len / spicc->bytes_per_word;
spicc->rx_remain = spicc->tx_remain;
if (spicc->tx_remain <= SPICC_FIFO_SIZE) {
spicc->using_dma = 0;
spicc->dma_xfer.len = 0;
spicc->pio_xfer.len = 0;
meson_spicc_set_width(spicc, xfer->bits_per_word);
meson_spicc_set_endian(spicc, spi->mode & SPI_LSB_FIRST);
meson_spicc_set_word_mode(spicc);
meson_spicc_set_speed(spicc, xfer->speed_hz, spi);
return meson_spicc_pio_polling(spicc);
}
meson_spicc_split_xfer(spicc, xfer, &spicc->dma_xfer, &spicc->pio_xfer);
if (spicc->dma_xfer.len) {
ret = __meson_spicc_transfer_one(spicc, &spicc->dma_xfer);
if (ret < 0) {
meson_spicc_split_xfer_dma_release(spicc,
spicc->orig_xfer,
&spicc->dma_xfer, false);
meson_spicc_split_xfer_pio_release(spicc,
spicc->orig_xfer,
&spicc->pio_xfer);
}
} else {
ret = __meson_spicc_transfer_one(spicc, xfer);
}
return ret;
}
static int meson_spicc_prepare_message(struct spi_controller *ctlr,
struct spi_message *message)
{
struct meson_spicc_device *spicc = spi_controller_get_devdata(ctlr);
struct spi_device *spi = message->spi;
/* Store current message */
meson_spicc_hw_prepare(spicc, spi->mode, meson_spicc_get_ctrl_cs_line(spi));
meson_spicc_set_width(spicc, spi->bits_per_word);
return 0;
}
static int meson_spicc_unprepare_transfer(struct spi_controller *ctlr)
{
struct meson_spicc_device *spicc = spi_controller_get_devdata(ctlr);
/* Disable all IRQs */
writel(0, spicc->base + SPICC_INTREG);
#ifndef CONFIG_AMLOGIC_MODIFY
/* Disable controller */
writel_bits_relaxed(SPICC_ENABLE, 0, spicc->base + SPICC_CONREG);
#endif
return 0;
}
static int meson_spicc_setup(struct spi_device *spi)
{
#ifdef CONFIG_AMLOGIC_MODIFY
struct meson_spicc_device *spicc = spi_controller_get_devdata(spi->controller);
struct spicc_controller_data *cdata;
int ret = 0, i;
for (i = 0; i < SPI_CS_CNT_MAX; i++)
if (spi->chip_select[i] != (u8)SPI_INVALID_CS)
spicc->cs_gpiods[spi->chip_select[i]] = spi->cs_gpiod[i];
cdata = (struct spicc_controller_data *)spi->controller_data;
meson_spicc_hw_prepare(spicc, spi->mode, meson_spicc_get_ctrl_cs_line(spi));
meson_spicc_set_width(spicc, spi->bits_per_word);
meson_spicc_set_speed(spicc, spi->max_speed_hz, spi);
if (cdata) {
cdata->controller_version = CONTROLLER_SPICC;
cdata->controller_capabilities = CAP_DMA_TRIG_VSYNC | CAP_DMA_TRIG_LINE_N;
if (cdata->use_ctrl_cs) {
if (spi->cs_gpiod[0]) {
gpio_free(desc_to_gpio(spi->cs_gpiod[0]));
spi->cs_gpiod[0] = NULL;
}
spicc->ctrl_cs = pinctrl_lookup_state(spicc->pinctrl, "ctrl_cs");
if (IS_ERR_OR_NULL(spicc->ctrl_cs))
dev_err(&spicc->pdev->dev, "select ctrl_cs pinctrl fail\n");
ret = pinctrl_select_state(spicc->pinctrl, spicc->ctrl_cs);
if (ret)
dev_err(&spicc->pdev->dev, "failed to activate ctrl_cs pinctrl state\n");
}
cdata->dirspi_start = dirspi_start;
cdata->dirspi_stop = dirspi_stop;
cdata->dirspi_async = dirspi_async;
cdata->dirspi_sync = dirspi_sync;
cdata->dirspi_xfer = dirspi_xfer;
cdata->dirspi_dma_trig = dirspi_dma_trig;
cdata->dirspi_dma_trig_start = dirspi_dma_trig_start;
cdata->dirspi_dma_trig_stop = dirspi_dma_trig_stop;
cdata->dirspi_dma_trig_release = dirspi_dma_trig_release;
cdata->dirspi_busy_proc = dirspi_busy_proc;
}
#endif
if (!spi->controller_state)
spi->controller_state = spi_controller_get_devdata(spi->controller);
return ret;
}
static void meson_spicc_cleanup(struct spi_device *spi)
{
u8 idx;
for (idx = 0; idx < SPI_CS_CNT_MAX; idx++) {
if (spi->cs_gpiod[idx])
gpio_free(desc_to_gpio(spi->cs_gpiod[idx]));
}
spi->controller_state = NULL;
}
#ifdef CONFIG_AMLOGIC_MODIFY
static int meson_spicc_clk_enable(struct meson_spicc_device *spicc)
{
int ret;
/* take effect such as sclk polarity */
meson_spicc_main_clk_ao(spicc, true);
ret = clk_prepare_enable(spicc->core);
if (!ret) {
ret = clk_prepare_enable(spicc->clk);
if (!ret && spicc->data->has_async_clk)
ret = clk_prepare_enable(spicc->async_clk);
}
meson_spicc_main_clk_ao(spicc, false);
return ret;
}
static void meson_spicc_clk_disable(struct meson_spicc_device *spicc)
{
if (!IS_ERR_OR_NULL(spicc->core))
clk_disable_unprepare(spicc->core);
if (!IS_ERR_OR_NULL(spicc->clk))
clk_disable_unprepare(spicc->clk);
if (spicc->data->has_async_clk && !IS_ERR_OR_NULL(spicc->async_clk))
clk_disable_unprepare(spicc->async_clk);
}
static int meson_spicc_hw_init(struct meson_spicc_device *spicc)
{
/* For GX/AXG, all registers except CONREG are unavailable if
* SPICC_ENABLE is 0, which will be also reset to default value
* if it changed from 1 to 0.
* Set controller mode and enable controller ahead of others here,
* and never disable them.
*/
if (!spi_controller_is_target(spicc->controller)) {
writel_relaxed(SPICC_ENABLE | SPICC_MODE_MASTER,
spicc->base + SPICC_CONREG);
if (spicc->data->has_oen)
writel_relaxed(0xf020000, spicc->base + SPICC_ENH_CTL0);
spicc->bits_per_word = 0;
} else {
writel_relaxed(SPICC_ENABLE, spicc->base + SPICC_CONREG);
writel_relaxed((spicc->miso_latency_default > 0) ? 0 :
SPICC_ENH_DELAY_EN | SPICC_ENH_SI_CAP_DELAY_EN,
spicc->base + SPICC_ENH_CTL1);
}
/* Disable all IRQs */
writel_relaxed(0, spicc->base + SPICC_INTREG);
return 0;
}
static void meson_spicc_stop(struct meson_spicc_device *spicc)
{
writel_bits_relaxed(SPICC_DMA_ENABLE, 0,
spicc->base + SPICC_DMAREG);
writel_relaxed(0, spicc->base + SPICC_INTREG);
writel_bits_relaxed(SPICC_XCH | SPICC_SMC, 0,
spicc->base + SPICC_CONREG);
if (readl_relaxed(spicc->base + SPICC_STATREG) & SPICC_TC)
writel_bits_relaxed(SPICC_TC, SPICC_TC,
spicc->base + SPICC_STATREG);
}
static void meson_spicc_abnormal_reset(struct meson_spicc_device *spicc)
{
u32 val, power_div, linear_div;
if (!IS_ERR_OR_NULL(spicc->rst)) {
power_div = readl_relaxed(spicc->base + SPICC_CONREG);
power_div &= SPICC_DATARATE_MASK;
linear_div = readl_relaxed(spicc->base + SPICC_ENH_CTL0);
linear_div &= SPICC_ENH_DATARATE_MASK | SPICC_ENH_DATARATE_EN;
reset_control_reset(spicc->rst);
meson_spicc_hw_init(spicc);
val = readl_relaxed(spicc->base + SPICC_CONREG);
val &= ~SPICC_DATARATE_MASK;
writel_relaxed(val | power_div, spicc->base + SPICC_CONREG);
val = readl_relaxed(spicc->base + SPICC_ENH_CTL0);
val &= ~(SPICC_ENH_DATARATE_MASK | SPICC_ENH_DATARATE_EN);
writel_relaxed(val | linear_div, spicc->base + SPICC_ENH_CTL0);
}
}
#ifdef MESON_SPICC_HW_IF
static void dirspi_set_cs(struct spi_device *spi, bool enable)
{
struct spicc_controller_data *cdata;
u8 idx;
cdata = (struct spicc_controller_data *)spi->controller_data;
if (spi->mode & SPI_NO_CS || (cdata && cdata->use_ctrl_cs))
return;
if (spi->mode & SPI_CS_HIGH)
enable = !enable;
for (idx = 0; idx < SPI_CS_CNT_MAX; idx++) {
if (spi->cs_gpiod[idx] && !enable)
meson_spi_delay_exec(&spi->cs_hold);
if (spi->cs_gpiod[idx])
gpiod_set_value(spi->cs_gpiod[idx], enable);
if (spi->cs_gpiod[idx] && enable)
meson_spi_delay_exec(&spi->cs_setup);
}
}
static void dirspi_start(struct spi_device *spi)
{
if (spi->controller->auto_runtime_pm)
pm_runtime_get_sync(spi->controller->dev.parent);
dirspi_set_cs(spi, true);
}
static void dirspi_stop(struct spi_device *spi)
{
struct meson_spicc_device *spicc = spi_controller_get_devdata(spi->controller);
dirspi_set_cs(spi, false);
writel_relaxed(0, spicc->base + SPICC_INTREG);
writel_relaxed(0, spicc->base + SPICC_DMAREG);
writel_relaxed(0, spicc->base + SPICC_LD_CNTL0);
writel_bits_relaxed(SPICC_XCH | SPICC_SMC, 0,
spicc->base + SPICC_CONREG);
}
/*
* Return
* <0: error code if the transfer is failed
* 0: if the transfer is finished.(callback executed)
* >0: if the transfer is still in progress
*/
static int dirspi_async(struct spi_device *spi,
dma_addr_t tx_dma,
dma_addr_t rx_dma,
int len,
void (*complete)(void *context),
void *context)
{
struct meson_spicc_device *spicc = spi_controller_get_devdata(spi->controller);
unsigned long flags;
if (!len || !tx_dma || !complete)
return -EINVAL;
spin_lock_irqsave(&spicc->lock, flags);
if (spicc->pending) {
spin_unlock_irqrestore(&spicc->lock, flags);
return -EBUSY;
}
spicc->spi = spi;
spicc->complete = complete;
spicc->context = context;
spicc->using_dma = 1;
spicc->bytes_per_word = DIV_ROUND_UP(spi->bits_per_word, 8);
spicc->dma_xfer.len = 0;
spicc->pio_xfer.len = 0;
dirspi_start(spi);
meson_spicc_hw_prepare(spicc, spi->mode, meson_spicc_get_ctrl_cs_line(spi));
meson_spicc_set_width(spicc, spi->bits_per_word);
meson_spicc_set_speed(spicc, spi->max_speed_hz, spi);
meson_spicc_set_endian(spicc, spi->mode & SPI_LSB_FIRST);
meson_spicc_set_word_mode(spicc);
spicc->tx_remain = len / SPICC_DMA_BYTES_PER_WORD;
spicc->rx_remain = spicc->tx_remain;
writel_relaxed(tx_dma, spicc->base + SPICC_DRADDR);
writel_relaxed(rx_dma, spicc->base + SPICC_DWADDR);
writel_relaxed(spi->max_speed_hz >> 25, spicc->base + SPICC_PERIODREG);
meson_spicc_setup_dma_burst(spicc,
true,
rx_dma ? true : false,
DMA_TRIG_NORMAL);
writel_relaxed(spicc->data->has_enh_intr ?
SPICC_DMA_DONE_EN : SPICC_TE_EN,
spicc->base + SPICC_INTREG);
spicc->pending = true;
writel_bits_relaxed(SPICC_SMC, SPICC_SMC, spicc->base + SPICC_CONREG);
spin_unlock_irqrestore(&spicc->lock, flags);
return 1;
}
static void dirspi_complete(void *arg)
{
complete(arg);
}
static int dirspi_sync(struct spi_device *spi,
dma_addr_t tx_dma,
dma_addr_t rx_dma,
int len)
{
DECLARE_COMPLETION_ONSTACK(done);
int ret;
ret = dirspi_async(spi, tx_dma, rx_dma, len, dirspi_complete, &done);
if (ret < 0)
return ret;
ret = wait_for_completion_timeout(&done, msecs_to_jiffies(200));
return ret ? 0 : -ETIMEDOUT;
}
static int dirspi_xfer(struct spi_device *spi, u8 *tx_buf, u8 *rx_buf, int len)
{
struct meson_spicc_device *spicc;
unsigned long timeout;
unsigned long flags;
u32 sta;
if (len && !tx_buf)
return -EINVAL;
spicc = spi_controller_get_devdata(spi->controller);
spin_lock_irqsave(&spicc->lock, flags);
dirspi_start(spi);
/* Setup transfer parameters */
spicc->using_dma = 0;
spicc->bytes_per_word = DIV_ROUND_UP(spi->bits_per_word, 8);
spicc->tx_buf = tx_buf;
spicc->rx_buf = rx_buf;
spicc->tx_remain = len / spicc->bytes_per_word;
spicc->rx_remain = spicc->tx_remain;
spicc->dma_xfer.len = 0;
spicc->pio_xfer.len = 0;
meson_spicc_hw_prepare(spicc, spi->mode, meson_spicc_get_ctrl_cs_line(spi));
meson_spicc_set_width(spicc, spi->bits_per_word);
meson_spicc_set_speed(spicc, spi->max_speed_hz, spi);
meson_spicc_set_endian(spicc, spi->mode & SPI_LSB_FIRST);
meson_spicc_set_word_mode(spicc);
if (spicc->tx_remain <= SPICC_FIFO_SIZE) {
meson_spicc_tx(spicc);
writel_bits_relaxed(SPICC_XCH, SPICC_XCH,
spicc->base + SPICC_CONREG);
} else {
writel_bits_relaxed(SPICC_SMC, SPICC_SMC,
spicc->base + SPICC_CONREG);
}
timeout = msecs_to_jiffies(200) + jiffies;
while ((spicc->tx_remain || spicc->rx_remain) &&
time_before(jiffies, timeout)) {
sta = readl_relaxed(spicc->base + SPICC_STATREG);
if (spicc->tx_remain && !(sta & SPICC_TF)) {
writel_relaxed(meson_spicc_pull_data(spicc),
spicc->base + SPICC_TXDATA);
spicc->tx_remain--;
}
if (sta & SPICC_RR) {
meson_spicc_push_data(spicc,
readl_relaxed(spicc->base + SPICC_RXDATA));
spicc->rx_remain--;
}
}
dirspi_stop(spi);
spin_unlock_irqrestore(&spicc->lock, flags);
return (spicc->rx_remain || spicc->rx_remain) ? -ETIMEDOUT : 0;
}
static int spicc_dma_trig_start(struct meson_spicc_device *spicc)
{
struct device *dev = &spicc->pdev->dev;
if (spicc->dirspi_status == DIRSPI_STA_RUNNING) {
dev_warn(dev, "start trig in running state\n");
return 0;
}
if (spicc->dirspi_status == DIRSPI_STA_IDLE) {
dev_err(dev, "start trig in idle state\n");
return -EIO;
}
writel_bits_relaxed(SPICC_FIFORST_MASK,
FIELD_PREP(SPICC_FIFORST_MASK, 3),
spicc->base + SPICC_TESTREG);
writel_bits_relaxed(SPICC_SMC, SPICC_SMC, spicc->base + SPICC_CONREG);
writel_bits_relaxed(DMA_EN_SET_BY_VSYNC, DMA_EN_SET_BY_VSYNC,
spicc->base + SPICC_LD_CNTL0);
spicc->dirspi_status = DIRSPI_STA_RUNNING;
dev_dbg(dev, "start trig in ready state success\n");
return 0;
}
static int spicc_dma_trig_stop(struct meson_spicc_device *spicc)
{
struct device *dev = &spicc->pdev->dev;
unsigned long timeout;
u32 dma, sta;
if (spicc->dirspi_status == DIRSPI_STA_IDLE) {
dev_warn(dev, "stop trig in idle state\n");
return 0;
}
if (spicc->dirspi_status == DIRSPI_STA_READY) {
dev_warn(dev, "stop trig in ready state\n");
return 0;
}
writel_bits_relaxed(DMA_EN_SET_BY_VSYNC, 0,
spicc->base + SPICC_LD_CNTL0);
timeout = msecs_to_jiffies(100) + jiffies;
while (time_before(jiffies, timeout)) {
dma = readl_relaxed(spicc->base + SPICC_DMAREG);
sta = readl_relaxed(spicc->base + SPICC_STATREG);
if (((dma & SPICC_DMA_ENABLE) == 0) &&
(sta & SPICC_TC) && (sta & SPICC_TE))
break;
}
if (time_after(jiffies, timeout))
dev_warn(dev, "dma busy\n");
writel_bits_relaxed(SPICC_SMC, 0, spicc->base + SPICC_CONREG);
spicc->dirspi_status = DIRSPI_STA_READY;
dev_dbg(dev, "stop trig in running state success\n");
return 0;
}
static int spicc_dma_trig_release(struct meson_spicc_device *spicc)
{
struct device *dev = &spicc->pdev->dev;
if (spicc->dirspi_status == DIRSPI_STA_IDLE) {
dev_warn(dev, "release trig in idle state\n");
return 0;
}
if (spicc->dirspi_status == DIRSPI_STA_RUNNING)
spicc_dma_trig_stop(spicc);
spicc->dirspi_status = DIRSPI_STA_IDLE;
dev_dbg(dev, "release trig success\n");
return 0;
}
/*
* @tx_dma: DMA address of tx buf
* @rx_dma: DMA address of rx buf
* @src: trigger source, DMA_TRIG_VSYNC or DMA_TRIG_LINE_N
*/
static int dirspi_dma_trig(struct spi_device *spi,
dma_addr_t tx_dma,
dma_addr_t rx_dma,
#ifdef CONFIG_SPI_PING_PONG
dma_addr_t tx_dma_pong,
dma_addr_t rx_dma_pong,
#endif
int len,
u8 src)
{
struct meson_spicc_device *spicc;
spicc = spi_controller_get_devdata(spi->controller);
spicc_dma_trig_release(spicc);
spicc->using_dma = 1;
spicc->bytes_per_word = DIV_ROUND_UP(spi->bits_per_word, 8);
spicc->dma_xfer.len = 0;
spicc->pio_xfer.len = 0;
meson_spicc_hw_prepare(spicc, spi->mode, meson_spicc_get_ctrl_cs_line(spi));
meson_spicc_set_width(spicc, spi->bits_per_word);
meson_spicc_set_speed(spicc, spi->max_speed_hz, spi);
meson_spicc_set_endian(spicc, spi->mode & SPI_LSB_FIRST);
meson_spicc_set_word_mode(spicc);
spicc->tx_remain = len / SPICC_DMA_BYTES_PER_WORD;
meson_spicc_setup_dma_burst(spicc,
tx_dma ? true : false,
rx_dma ? true : false,
src);
writel_relaxed(spi->max_speed_hz >> 25, spicc->base + SPICC_PERIODREG);
writel_relaxed(tx_dma, spicc->base + SPICC_LD_RADDR);
writel_relaxed(rx_dma, spicc->base + SPICC_LD_WADDR);
spicc->dirspi_status = DIRSPI_STA_READY;
dev_dbg(&spicc->pdev->dev, "init trig success\n");
return 0;
}
static int dirspi_dma_trig_start(struct spi_device *spi)
{
struct meson_spicc_device *spicc;
spicc = spi_controller_get_devdata(spi->controller);
return spicc_dma_trig_start(spicc);
}
static int dirspi_dma_trig_stop(struct spi_device *spi)
{
struct meson_spicc_device *spicc;
spicc = spi_controller_get_devdata(spi->controller);
return spicc_dma_trig_stop(spicc);
}
static int dirspi_dma_trig_release(struct spi_device *spi)
{
struct meson_spicc_device *spicc;
spicc = spi_controller_get_devdata(spi->controller);
return spicc_dma_trig_release(spicc);
}
static int dirspi_busy_proc(struct spi_device *spi)
{
struct meson_spicc_device *spicc;
unsigned long flags;
spicc = spi_controller_get_devdata(spi->controller);
spin_lock_irqsave(&spicc->lock, flags);
dirspi_set_cs(spi, false);
meson_spicc_stop(spicc);
if (is_busy_reset())
meson_spicc_abnormal_reset(spicc);
if (spicc->complete) {
spicc->complete(spicc->context);
spicc->complete = NULL;
}
spicc->pending = false;
spin_unlock_irqrestore(&spicc->lock, flags);
return 0;
}
#endif
#ifdef CONFIG_SPICC_TEST
static DEVICE_ATTR_WO(test);
static DEVICE_ATTR_RW(testdev);
#endif
/*
* The Clock Mux
* x-----------------x x---------------x x------\
* |---| 0) fixed factor |---| 1) power2 div |----| |
* | x-----------------x x---------------x | |
* src ---| |5) mux|-- out
* | x-----------------x x---------------x | |
* |---| 2) fixed factor |---| 3) linear div |----| |
* x-----------------x x---------------x x------/
*
* Clk path for GX series:
* src = core clk
* src -> 0 -> 1 -> out
*
* Clk path for AXG series:
* src = core clk
* src -> 0 -> 1 -> 5 -> out
* src -> 2 -> 3 -> 5 -> out
*
* Clk path for G12 series:
* src = async clk
* src -> 0 -> 1 -> 5 -> out
* src -> 2 -> 3 -> 5 -> out
*/
static struct clk_div_table power2_div_table[9] = {
{0, 4}, {1, 8}, {2, 16}, {3, 32},
{4, 64}, {5, 128}, {6, 256}, {7, 512}, {0}
};
static struct clk_div_table linear_div_table[255] = {
[0] = {0},
[254] = {0}
};
static struct clk *
meson_spicc_divider_clk_get(struct meson_spicc_device *spicc, bool is_linear)
{
struct device *dev = &spicc->pdev->dev;
struct clk_init_data init;
struct clk_divider *div;
struct clk *clk;
const char *parent_names[1];
char name[32], *which;
bool is_parent_async = spicc->data->is_div_parent_async_clk;
div = devm_kzalloc(dev, sizeof(*div), GFP_KERNEL);
if (!div)
return ERR_PTR(-ENOMEM);
div->flags = spicc->clk_div_none ? 0 : CLK_DIVIDER_ROUND_CLOSEST;
if (is_linear) {
which = "linear";
div->reg = spicc->base + SPICC_ENH_CTL0;
div->shift = SPICC_ENH_DATARATE_SHIFT;
div->width = SPICC_ENH_DATARATE_WIDTH;
div->table = linear_div_table;
} else {
which = "power2";
div->reg = spicc->base + SPICC_CONREG;
div->shift = SPICC_DATARATE_SHIFT;
div->width = SPICC_DATARATE_WIDTH;
div->table = power2_div_table;
}
/* Register clk-divider */
clk = is_parent_async ? spicc->async_clk : spicc->core;
parent_names[0] = __clk_get_name(clk);
snprintf(name, sizeof(name), "%s_%s_div", dev_name(dev), which);
init.name = name;
init.ops = &clk_divider_ops;
init.flags = ((!is_parent_async) || spicc->parent_clk_fixed) ?
0 : CLK_SET_RATE_PARENT;
init.parent_names = parent_names;
init.num_parents = 1;
div->hw.init = &init;
clk = devm_clk_register(dev, &div->hw);
return clk;
}
static struct clk *
meson_spicc_mux_clk_get(struct meson_spicc_device *spicc,
const char * const *parent_names)
{
struct device *dev = &spicc->pdev->dev;
struct clk_init_data init;
struct clk_mux *mux;
struct clk *clk;
char name[32];
mux = devm_kzalloc(dev, sizeof(*mux), GFP_KERNEL);
if (!mux)
return ERR_PTR(-ENOMEM);
snprintf(name, sizeof(name), "%s_mux", dev_name(dev));
init.name = name;
init.ops = &clk_mux_ops;
init.parent_names = parent_names;
init.num_parents = 2;
init.flags = CLK_SET_RATE_PARENT;
mux->mask = 0x1;
mux->shift = 24;
mux->reg = spicc->base + SPICC_ENH_CTL0;
mux->hw.init = &init;
clk = devm_clk_register(dev, &mux->hw);
return clk;
}
static struct clk *meson_spicc_clk_get(struct meson_spicc_device *spicc)
{
struct clk *clk;
const char *parent_names[2];
int i;
if (!linear_div_table[0].div)
for (i = 0; i < ARRAY_SIZE(linear_div_table) - 1; i++) {
linear_div_table[i].val = i + 2;
linear_div_table[i].div = (i + 3) * 2;
}
/* Get power-of-two divider clk */
clk = meson_spicc_divider_clk_get(spicc, 0);
if (!IS_ERR_OR_NULL(clk) && spicc->data->has_linear_div) {
/* Set power-of-two as the 1st parent */
parent_names[0] = __clk_get_name(clk);
/* Get linear divider clk */
clk = meson_spicc_divider_clk_get(spicc, 1);
if (!IS_ERR_OR_NULL(clk)) {
/* Set linear as the 2nd parent */
parent_names[1] = __clk_get_name(clk);
/* Get mux clk */
clk = meson_spicc_mux_clk_get(spicc, parent_names);
}
}
return clk;
}
/* The clk data rate setting is handled by clk core. We have to save/restore
* it when system suspend/resume.
*/
static void meson_spicc_store(struct meson_spicc_device *spicc)
{
struct resource *res;
int store_sz, i;
res = platform_get_resource(spicc->pdev, IORESOURCE_MEM, 0);
store_sz = ALIGN(resource_size(res) - SPICC_CONREG, 4);
spicc->store_buf = kzalloc(store_sz, GFP_KERNEL);
if (IS_ERR_OR_NULL(spicc->store_buf))
return;
for (i = 0; i < store_sz / 4; i++)
spicc->store_buf[i] = readl_relaxed(spicc->base + (i + 2) * 4);
}
static void meson_spicc_restore(struct meson_spicc_device *spicc)
{
struct resource *res;
int store_sz, i;
res = platform_get_resource(spicc->pdev, IORESOURCE_MEM, 0);
store_sz = ALIGN(resource_size(res) - SPICC_CONREG, 4);
if (IS_ERR_OR_NULL(spicc->store_buf))
return;
for (i = 0; i < store_sz / 4; i++)
writel_relaxed(spicc->store_buf[i], spicc->base + (i + 2) * 4);
kfree(spicc->store_buf);
spicc->store_buf = NULL;
}
#endif
static int meson_spicc_probe(struct platform_device *pdev)
{
struct spi_controller *ctlr;
struct meson_spicc_data *match;
struct meson_spicc_device *spicc;
struct gpio_desc **cs;
int ret, irq, rate;
ctlr = __spi_alloc_controller(&pdev->dev, sizeof(*spicc),
of_property_read_bool(pdev->dev.of_node, "slave"));
if (!ctlr) {
dev_err(&pdev->dev, "controller allocation failed\n");
return -ENOMEM;
}
spicc = spi_controller_get_devdata(ctlr);
spicc->controller = ctlr;
spicc->pdev = pdev;
platform_set_drvdata(pdev, spicc);
spicc->base = devm_platform_ioremap_resource(pdev, 0);
if (IS_ERR_OR_NULL(spicc->base)) {
dev_err(&pdev->dev, "io resource mapping failed\n");
ret = PTR_ERR(spicc->base);
goto out_controller;
}
cs = devm_kcalloc(&pdev->dev, SPI_CS_CNT_MAX, sizeof(*cs),
GFP_KERNEL);
if (!cs)
return -ENOMEM;
spicc->cs_gpiods = cs;
#ifdef CONFIG_AMLOGIC_MODIFY
match = (struct meson_spicc_data *)
of_device_get_match_data(&pdev->dev);
spicc->data = devm_kzalloc(&pdev->dev, sizeof(*match), GFP_KERNEL);
spicc->data->max_speed_hz = match->max_speed_hz;
spicc->data->has_linear_div = match->has_linear_div;
spicc->data->has_oen = match->has_oen;
spicc->data->has_async_clk = match->has_async_clk;
spicc->data->is_div_parent_async_clk = match->is_div_parent_async_clk;
spicc->data->has_word_mode_ctrl = match->has_word_mode_ctrl;
spicc->data->has_endian_ctrl = match->has_endian_ctrl;
spicc->data->has_enh_intr = match->has_enh_intr;
spicc->data->support_dma_burst_len_1 = match->support_dma_burst_len_1;
spicc->rst = devm_reset_control_get(&pdev->dev, "spicc");
if (IS_ERR_OR_NULL(spicc->rst))
dev_warn(&pdev->dev, "no reset resource\n");
else
reset_control_reset(spicc->rst);
meson_spicc_hw_init(spicc);
#else
/* Disable all IRQs */
writel_relaxed(0, spicc->base + SPICC_INTREG);
#endif
spicc->pinctrl = devm_pinctrl_get(&pdev->dev);
if (IS_ERR_OR_NULL(spicc->pinctrl)) {
dev_err(&pdev->dev, "get pinctrl fail\n");
return PTR_ERR(spicc->pinctrl);
}
/* TODO: fixme reduce power consumption*/
spicc->standby = pinctrl_lookup_state(spicc->pinctrl, "standby");
if (IS_ERR_OR_NULL(spicc->standby))
dev_info(&pdev->dev, "failed to select standby pinctrl\n");
irq = platform_get_irq(pdev, 0);
if (irq < 0) {
ret = irq;
goto out_controller;
}
ret = devm_request_irq(&pdev->dev, irq, meson_spicc_irq,
spicc->data->has_enh_intr ?
IRQF_TRIGGER_RISING : 0,
NULL, spicc);
if (ret) {
dev_err(&pdev->dev, "irq request failed\n");
goto out_controller;
}
spicc->core = devm_clk_get(&pdev->dev, "core");
if (IS_ERR_OR_NULL(spicc->core)) {
dev_err(&pdev->dev, "core clock request failed\n");
ret = PTR_ERR(spicc->core);
goto out_controller;
}
ret = clk_prepare_enable(spicc->core);
if (ret) {
dev_err(&pdev->dev, "core clock enable failed\n");
goto out_controller;
}
rate = clk_get_rate(spicc->core);
#ifdef CONFIG_AMLOGIC_MODIFY
spicc->parent_clk_fixed = false;
spicc->toggle_cs_every_word = false;
of_property_read_s32(pdev->dev.of_node, "latency",
&spicc->miso_latency_default);
if (of_property_read_bool(pdev->dev.of_node, "parent_clk_fixed"))
spicc->parent_clk_fixed = true;
if (of_property_read_bool(pdev->dev.of_node, "toggle_cs_every_word"))
spicc->toggle_cs_every_word = true;
of_property_read_s32(pdev->dev.of_node, "cs2clk-us",
&spicc->cs_setup_default);
of_property_read_s32(pdev->dev.of_node, "clk2cs-us",
&spicc->cs_hold_default);
spicc->cs_setup_default *= NSEC_PER_USEC;
spicc->cs_hold_default *= NSEC_PER_USEC;
spicc->clk_div_none = false;
if (of_property_read_bool(pdev->dev.of_node, "clk_div_none"))
spicc->clk_div_none = true;
if (spicc->data->has_async_clk) {
/* SoCs has async-clk is incapable of using full burst */
SPICC_FIFO_SIZE = 15;
spicc->async_clk = devm_clk_get(&pdev->dev, "async");
if (IS_ERR_OR_NULL(spicc->async_clk)) {
dev_err(&pdev->dev, "async clock request failed\n");
ret = PTR_ERR(spicc->async_clk);
goto out_clk_1;
}
ret = clk_prepare_enable(spicc->async_clk);
if (ret) {
dev_err(&pdev->dev, "async clock enable failed\n");
goto out_clk_1;
}
}
if (spicc->parent_clk_fixed) {
spicc->pclk_rate = clk_get_rate
(spicc->data->is_div_parent_async_clk ?
spicc->async_clk : spicc->core);
dev_info(&pdev->dev, "pclk_rate %d Hz\n", spicc->pclk_rate);
}
if (!spi_controller_is_target(spicc->controller)) {
spicc->clk = meson_spicc_clk_get(spicc);
if (IS_ERR_OR_NULL(spicc->clk)) {
dev_err(&pdev->dev, "divider clock get failed\n");
ret = PTR_ERR(spicc->clk);
goto out_clk_2;
}
ret = clk_prepare_enable(spicc->clk);
if (ret) {
dev_err(&pdev->dev, "divider clock enable failed\n");
goto out_clk_2;
}
}
#endif
ctlr->num_chipselect = MESON_SPI_CS_CNT_MAX;
ctlr->use_gpio_descriptors = true;
ctlr->dev.of_node = pdev->dev.of_node;
ctlr->dma_alignment = 8;
ctlr->mode_bits = SPI_CPHA | SPI_CPOL | SPI_CS_HIGH | SPI_LOOP;
if (spicc->data->has_endian_ctrl)
ctlr->mode_bits |= SPI_LSB_FIRST;
ctlr->flags = SPI_CONTROLLER_MUST_TX;
ctlr->setup = meson_spicc_setup;
ctlr->cleanup = meson_spicc_cleanup;
ctlr->prepare_message = meson_spicc_prepare_message;
ctlr->unprepare_transfer_hardware = meson_spicc_unprepare_transfer;
ctlr->transfer_one = meson_spicc_transfer_one;
/* Setup max rate according to the Meson GX datasheet */
ctlr->max_speed_hz = spicc->data->max_speed_hz;
ret = devm_spi_register_controller(&pdev->dev, ctlr);
if (ret) {
dev_err(&pdev->dev, "spi controller registration failed\n");
goto out_clk;
}
#ifdef CONFIG_AMLOGIC_MODIFY
spin_lock_init(&spicc->lock);
#ifdef CONFIG_SPICC_TEST
device_create_file(&ctlr->dev, &dev_attr_test);
device_create_file(&ctlr->dev, &dev_attr_testdev);
#endif
#ifdef CONFIG_PM_SLEEP
//pm_runtime_set_autosuspend_delay(&pdev->dev, 500);
//pm_runtime_use_autosuspend(&pdev->dev);
ctlr->auto_runtime_pm = false;
//pm_runtime_enable(&pdev->dev);
#endif
#endif
return 0;
out_clk:
#ifdef CONFIG_AMLOGIC_MODIFY
clk_disable_unprepare(spicc->clk);
out_clk_2:
if (spicc->data->has_async_clk)
clk_disable_unprepare(spicc->async_clk);
out_clk_1:
#endif
clk_disable_unprepare(spicc->core);
out_controller:
spi_controller_put(ctlr);
return ret;
}
static void meson_spicc_remove(struct platform_device *pdev)
{
struct meson_spicc_device *spicc = platform_get_drvdata(pdev);
/* Disable SPI */
writel(0, spicc->base + SPICC_CONREG);
clk_disable_unprepare(spicc->core);
#ifdef CONFIG_AMLOGIC_MODIFY
if (spicc->data->has_async_clk)
clk_disable_unprepare(spicc->async_clk);
clk_disable_unprepare(spicc->clk);
#ifdef CONFIG_SPICC_TEST
device_remove_file(&spicc->controller->dev, &dev_attr_test);
device_remove_file(&spicc->controller->dev, &dev_attr_testdev);
#endif
#endif
}
#ifdef CONFIG_AMLOGIC_MODIFY
#ifdef CONFIG_PM_SLEEP
static int meson_spicc_suspend(struct device *dev)
{
struct meson_spicc_device *spicc = dev_get_drvdata(dev);
int i;
pinctrl_pm_select_sleep_state(dev);
/* gpio cs pins Not in default pinmux */
for (i = 0; i < SPI_CS_CNT_MAX; i++)
if (spicc->cs_gpiods[i])
gpiod_set_value_cansleep(spicc->cs_gpiods[i], 1);
meson_spicc_store(spicc);
meson_spicc_clk_disable(spicc);
return spi_controller_suspend(spicc->controller);
}
static int meson_spicc_resume(struct device *dev)
{
struct meson_spicc_device *spicc = dev_get_drvdata(dev);
int i;
pinctrl_pm_select_default_state(dev);
/* gpio cs pins Not in default pinmux */
for (i = 0; i < SPI_CS_CNT_MAX; i++)
if (spicc->cs_gpiods[i])
gpiod_set_value_cansleep(spicc->cs_gpiods[i], 0);
meson_spicc_restore(spicc);
meson_spicc_clk_enable(spicc);
return spi_controller_resume(spicc->controller);
}
#endif /* CONFIG_PM_SLEEP */
static int meson_spicc_runtime_suspend(struct device *dev)
{
struct meson_spicc_device *spicc = dev_get_drvdata(dev);
meson_spicc_store(spicc);
meson_spicc_clk_disable(spicc);
return 0;
}
static int meson_spicc_runtime_resume(struct device *dev)
{
struct meson_spicc_device *spicc = dev_get_drvdata(dev);
meson_spicc_restore(spicc);
return meson_spicc_clk_enable(spicc);
}
static const struct dev_pm_ops meson_spicc_pm_ops = {
SET_SYSTEM_SLEEP_PM_OPS(meson_spicc_suspend, meson_spicc_resume)
SET_RUNTIME_PM_OPS(meson_spicc_runtime_suspend,
meson_spicc_runtime_resume,
NULL)
};
#ifndef CONFIG_AMLOGIC_REMOVE_OLD
static struct meson_spicc_data meson_spicc_gx_data __initdata = {
.max_speed_hz = 30000000,
};
static struct meson_spicc_data meson_spicc_axg_data __initdata = {
.max_speed_hz = 80000000,
.has_linear_div = true,
.has_oen = true,
.has_async_clk = true,
};
#endif
static struct meson_spicc_data meson_spicc_g12_data __initdata = {
.max_speed_hz = 124000000,
.has_linear_div = true,
.has_oen = true,
.has_async_clk = true,
.is_div_parent_async_clk = true,
};
static struct meson_spicc_data meson_spicc_s5_data __initdata = {
.max_speed_hz = 124000000,
.has_linear_div = true,
.has_oen = true,
.has_async_clk = true,
.is_div_parent_async_clk = true,
.has_word_mode_ctrl = true,
.has_endian_ctrl = true,
.has_enh_intr = true,
.support_dma_burst_len_1 = true,
};
#endif
static const struct of_device_id meson_spicc_of_match[] = {
#ifdef CONFIG_AMLOGIC_MODIFY
#ifndef CONFIG_AMLOGIC_REMOVE_OLD
{
.compatible = "amlogic,meson-gx-spicc",
.data = &meson_spicc_gx_data,
},
{
.compatible = "amlogic,meson-axg-spicc",
.data = &meson_spicc_axg_data,
},
#endif
{
.compatible = "amlogic,meson-g12-spicc",
.data = &meson_spicc_g12_data,
},
{
.compatible = "amlogic,meson-s5-spicc",
.data = &meson_spicc_s5_data,
},
#else
.compatible = "amlogic,meson-gx-spicc",
.compatible = "amlogic,meson-axg-spicc"
#endif
{ /* sentinel */ }
};
MODULE_DEVICE_TABLE(of, meson_spicc_of_match);
struct platform_driver meson_spicc_driver = {
.probe = meson_spicc_probe,
.remove = meson_spicc_remove,
.driver = {
.name = "meson-spicc",
.of_match_table = of_match_ptr(meson_spicc_of_match),
#ifdef CONFIG_AMLOGIC_MODIFY
.pm = &meson_spicc_pm_ops,
#endif
},
};
#ifndef MODULE
module_platform_driver(meson_spicc_driver);
#endif
MODULE_DESCRIPTION("Meson SPI Communication Controller driver");
MODULE_AUTHOR("Neil Armstrong <[email protected]>");
MODULE_LICENSE("GPL");