2019-05-29 00:57:06 +08:00
|
|
|
// SPDX-License-Identifier: GPL-2.0-only
|
2016-02-05 00:13:30 +08:00
|
|
|
/*
|
|
|
|
* SPI-Engine SPI controller driver
|
|
|
|
* Copyright 2015 Analog Devices Inc.
|
|
|
|
* Author: Lars-Peter Clausen <lars@metafoo.de>
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/clk.h>
|
2024-02-03 05:31:32 +08:00
|
|
|
#include <linux/fpga/adi-axi-common.h>
|
2023-11-18 04:13:00 +08:00
|
|
|
#include <linux/idr.h>
|
2016-02-05 00:13:30 +08:00
|
|
|
#include <linux/interrupt.h>
|
|
|
|
#include <linux/io.h>
|
|
|
|
#include <linux/of.h>
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/platform_device.h>
|
|
|
|
#include <linux/spi/spi.h>
|
|
|
|
|
|
|
|
#define SPI_ENGINE_REG_RESET 0x40
|
|
|
|
|
|
|
|
#define SPI_ENGINE_REG_INT_ENABLE 0x80
|
|
|
|
#define SPI_ENGINE_REG_INT_PENDING 0x84
|
|
|
|
#define SPI_ENGINE_REG_INT_SOURCE 0x88
|
|
|
|
|
|
|
|
#define SPI_ENGINE_REG_SYNC_ID 0xc0
|
|
|
|
|
|
|
|
#define SPI_ENGINE_REG_CMD_FIFO_ROOM 0xd0
|
|
|
|
#define SPI_ENGINE_REG_SDO_FIFO_ROOM 0xd4
|
|
|
|
#define SPI_ENGINE_REG_SDI_FIFO_LEVEL 0xd8
|
|
|
|
|
|
|
|
#define SPI_ENGINE_REG_CMD_FIFO 0xe0
|
|
|
|
#define SPI_ENGINE_REG_SDO_DATA_FIFO 0xe4
|
|
|
|
#define SPI_ENGINE_REG_SDI_DATA_FIFO 0xe8
|
|
|
|
#define SPI_ENGINE_REG_SDI_DATA_FIFO_PEEK 0xec
|
|
|
|
|
|
|
|
#define SPI_ENGINE_INT_CMD_ALMOST_EMPTY BIT(0)
|
|
|
|
#define SPI_ENGINE_INT_SDO_ALMOST_EMPTY BIT(1)
|
|
|
|
#define SPI_ENGINE_INT_SDI_ALMOST_FULL BIT(2)
|
|
|
|
#define SPI_ENGINE_INT_SYNC BIT(3)
|
|
|
|
|
|
|
|
#define SPI_ENGINE_CONFIG_CPHA BIT(0)
|
|
|
|
#define SPI_ENGINE_CONFIG_CPOL BIT(1)
|
|
|
|
#define SPI_ENGINE_CONFIG_3WIRE BIT(2)
|
|
|
|
|
|
|
|
#define SPI_ENGINE_INST_TRANSFER 0x0
|
|
|
|
#define SPI_ENGINE_INST_ASSERT 0x1
|
|
|
|
#define SPI_ENGINE_INST_WRITE 0x2
|
|
|
|
#define SPI_ENGINE_INST_MISC 0x3
|
|
|
|
|
|
|
|
#define SPI_ENGINE_CMD_REG_CLK_DIV 0x0
|
|
|
|
#define SPI_ENGINE_CMD_REG_CONFIG 0x1
|
|
|
|
|
|
|
|
#define SPI_ENGINE_MISC_SYNC 0x0
|
|
|
|
#define SPI_ENGINE_MISC_SLEEP 0x1
|
|
|
|
|
|
|
|
#define SPI_ENGINE_TRANSFER_WRITE 0x1
|
|
|
|
#define SPI_ENGINE_TRANSFER_READ 0x2
|
|
|
|
|
|
|
|
#define SPI_ENGINE_CMD(inst, arg1, arg2) \
|
|
|
|
(((inst) << 12) | ((arg1) << 8) | (arg2))
|
|
|
|
|
|
|
|
#define SPI_ENGINE_CMD_TRANSFER(flags, n) \
|
|
|
|
SPI_ENGINE_CMD(SPI_ENGINE_INST_TRANSFER, (flags), (n))
|
|
|
|
#define SPI_ENGINE_CMD_ASSERT(delay, cs) \
|
|
|
|
SPI_ENGINE_CMD(SPI_ENGINE_INST_ASSERT, (delay), (cs))
|
|
|
|
#define SPI_ENGINE_CMD_WRITE(reg, val) \
|
|
|
|
SPI_ENGINE_CMD(SPI_ENGINE_INST_WRITE, (reg), (val))
|
|
|
|
#define SPI_ENGINE_CMD_SLEEP(delay) \
|
|
|
|
SPI_ENGINE_CMD(SPI_ENGINE_INST_MISC, SPI_ENGINE_MISC_SLEEP, (delay))
|
|
|
|
#define SPI_ENGINE_CMD_SYNC(id) \
|
|
|
|
SPI_ENGINE_CMD(SPI_ENGINE_INST_MISC, SPI_ENGINE_MISC_SYNC, (id))
|
|
|
|
|
|
|
|
struct spi_engine_program {
|
|
|
|
unsigned int length;
|
|
|
|
uint16_t instructions[];
|
|
|
|
};
|
|
|
|
|
2023-11-18 04:13:00 +08:00
|
|
|
/**
|
|
|
|
* struct spi_engine_message_state - SPI engine per-message state
|
|
|
|
*/
|
|
|
|
struct spi_engine_message_state {
|
|
|
|
/** Instructions for executing this message. */
|
2016-02-05 00:13:30 +08:00
|
|
|
struct spi_engine_program *p;
|
2023-11-18 04:13:00 +08:00
|
|
|
/** Number of elements in cmd_buf array. */
|
2016-02-05 00:13:30 +08:00
|
|
|
unsigned cmd_length;
|
2023-11-18 04:13:00 +08:00
|
|
|
/** Array of commands not yet written to CMD FIFO. */
|
2016-02-05 00:13:30 +08:00
|
|
|
const uint16_t *cmd_buf;
|
2023-11-18 04:13:00 +08:00
|
|
|
/** Next xfer with tx_buf not yet fully written to TX FIFO. */
|
2016-02-05 00:13:30 +08:00
|
|
|
struct spi_transfer *tx_xfer;
|
2023-11-18 04:13:00 +08:00
|
|
|
/** Size of tx_buf in bytes. */
|
2016-02-05 00:13:30 +08:00
|
|
|
unsigned int tx_length;
|
2023-11-18 04:13:00 +08:00
|
|
|
/** Bytes not yet written to TX FIFO. */
|
2016-02-05 00:13:30 +08:00
|
|
|
const uint8_t *tx_buf;
|
2023-11-18 04:13:00 +08:00
|
|
|
/** Next xfer with rx_buf not yet fully written to RX FIFO. */
|
2016-02-05 00:13:30 +08:00
|
|
|
struct spi_transfer *rx_xfer;
|
2023-11-18 04:13:00 +08:00
|
|
|
/** Size of tx_buf in bytes. */
|
2016-02-05 00:13:30 +08:00
|
|
|
unsigned int rx_length;
|
2023-11-18 04:13:00 +08:00
|
|
|
/** Bytes not yet written to the RX FIFO. */
|
2016-02-05 00:13:30 +08:00
|
|
|
uint8_t *rx_buf;
|
2023-11-18 04:13:00 +08:00
|
|
|
/** ID to correlate SYNC interrupts with this message. */
|
|
|
|
u8 sync_id;
|
|
|
|
};
|
|
|
|
|
|
|
|
struct spi_engine {
|
|
|
|
struct clk *clk;
|
|
|
|
struct clk *ref_clk;
|
|
|
|
|
|
|
|
spinlock_t lock;
|
|
|
|
|
|
|
|
void __iomem *base;
|
2016-02-05 00:13:30 +08:00
|
|
|
|
2023-11-18 04:13:00 +08:00
|
|
|
struct spi_message *msg;
|
|
|
|
struct ida sync_ida;
|
2016-02-05 00:13:30 +08:00
|
|
|
unsigned int completed_id;
|
|
|
|
|
|
|
|
unsigned int int_enable;
|
|
|
|
};
|
|
|
|
|
|
|
|
static void spi_engine_program_add_cmd(struct spi_engine_program *p,
|
|
|
|
bool dry, uint16_t cmd)
|
|
|
|
{
|
|
|
|
if (!dry)
|
|
|
|
p->instructions[p->length] = cmd;
|
|
|
|
p->length++;
|
|
|
|
}
|
|
|
|
|
|
|
|
static unsigned int spi_engine_get_config(struct spi_device *spi)
|
|
|
|
{
|
|
|
|
unsigned int config = 0;
|
|
|
|
|
|
|
|
if (spi->mode & SPI_CPOL)
|
|
|
|
config |= SPI_ENGINE_CONFIG_CPOL;
|
|
|
|
if (spi->mode & SPI_CPHA)
|
|
|
|
config |= SPI_ENGINE_CONFIG_CPHA;
|
|
|
|
if (spi->mode & SPI_3WIRE)
|
|
|
|
config |= SPI_ENGINE_CONFIG_3WIRE;
|
|
|
|
|
|
|
|
return config;
|
|
|
|
}
|
|
|
|
|
|
|
|
static unsigned int spi_engine_get_clk_div(struct spi_engine *spi_engine,
|
|
|
|
struct spi_device *spi, struct spi_transfer *xfer)
|
|
|
|
{
|
|
|
|
unsigned int clk_div;
|
|
|
|
|
|
|
|
clk_div = DIV_ROUND_UP(clk_get_rate(spi_engine->ref_clk),
|
|
|
|
xfer->speed_hz * 2);
|
|
|
|
if (clk_div > 255)
|
|
|
|
clk_div = 255;
|
|
|
|
else if (clk_div > 0)
|
|
|
|
clk_div -= 1;
|
|
|
|
|
|
|
|
return clk_div;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void spi_engine_gen_xfer(struct spi_engine_program *p, bool dry,
|
|
|
|
struct spi_transfer *xfer)
|
|
|
|
{
|
|
|
|
unsigned int len = xfer->len;
|
|
|
|
|
|
|
|
while (len) {
|
|
|
|
unsigned int n = min(len, 256U);
|
|
|
|
unsigned int flags = 0;
|
|
|
|
|
|
|
|
if (xfer->tx_buf)
|
|
|
|
flags |= SPI_ENGINE_TRANSFER_WRITE;
|
|
|
|
if (xfer->rx_buf)
|
|
|
|
flags |= SPI_ENGINE_TRANSFER_READ;
|
|
|
|
|
|
|
|
spi_engine_program_add_cmd(p, dry,
|
|
|
|
SPI_ENGINE_CMD_TRANSFER(flags, n - 1));
|
|
|
|
len -= n;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void spi_engine_gen_sleep(struct spi_engine_program *p, bool dry,
|
2019-09-26 18:51:47 +08:00
|
|
|
struct spi_engine *spi_engine, unsigned int clk_div,
|
|
|
|
struct spi_transfer *xfer)
|
2016-02-05 00:13:30 +08:00
|
|
|
{
|
|
|
|
unsigned int spi_clk = clk_get_rate(spi_engine->ref_clk);
|
|
|
|
unsigned int t;
|
2019-09-26 18:51:47 +08:00
|
|
|
int delay;
|
|
|
|
|
2021-03-08 22:54:53 +08:00
|
|
|
delay = spi_delay_to_ns(&xfer->delay, xfer);
|
|
|
|
if (delay < 0)
|
|
|
|
return;
|
|
|
|
delay /= 1000;
|
2016-02-05 00:13:30 +08:00
|
|
|
|
|
|
|
if (delay == 0)
|
|
|
|
return;
|
|
|
|
|
|
|
|
t = DIV_ROUND_UP(delay * spi_clk, (clk_div + 1) * 2);
|
|
|
|
while (t) {
|
|
|
|
unsigned int n = min(t, 256U);
|
|
|
|
|
|
|
|
spi_engine_program_add_cmd(p, dry, SPI_ENGINE_CMD_SLEEP(n - 1));
|
|
|
|
t -= n;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void spi_engine_gen_cs(struct spi_engine_program *p, bool dry,
|
|
|
|
struct spi_device *spi, bool assert)
|
|
|
|
{
|
|
|
|
unsigned int mask = 0xff;
|
|
|
|
|
|
|
|
if (assert)
|
2023-03-11 01:32:03 +08:00
|
|
|
mask ^= BIT(spi_get_chipselect(spi, 0));
|
2016-02-05 00:13:30 +08:00
|
|
|
|
|
|
|
spi_engine_program_add_cmd(p, dry, SPI_ENGINE_CMD_ASSERT(1, mask));
|
|
|
|
}
|
|
|
|
|
|
|
|
static int spi_engine_compile_message(struct spi_engine *spi_engine,
|
|
|
|
struct spi_message *msg, bool dry, struct spi_engine_program *p)
|
|
|
|
{
|
|
|
|
struct spi_device *spi = msg->spi;
|
|
|
|
struct spi_transfer *xfer;
|
|
|
|
int clk_div, new_clk_div;
|
|
|
|
bool cs_change = true;
|
|
|
|
|
|
|
|
clk_div = -1;
|
|
|
|
|
|
|
|
spi_engine_program_add_cmd(p, dry,
|
|
|
|
SPI_ENGINE_CMD_WRITE(SPI_ENGINE_CMD_REG_CONFIG,
|
|
|
|
spi_engine_get_config(spi)));
|
|
|
|
|
|
|
|
list_for_each_entry(xfer, &msg->transfers, transfer_list) {
|
|
|
|
new_clk_div = spi_engine_get_clk_div(spi_engine, spi, xfer);
|
|
|
|
if (new_clk_div != clk_div) {
|
|
|
|
clk_div = new_clk_div;
|
|
|
|
spi_engine_program_add_cmd(p, dry,
|
|
|
|
SPI_ENGINE_CMD_WRITE(SPI_ENGINE_CMD_REG_CLK_DIV,
|
|
|
|
clk_div));
|
|
|
|
}
|
|
|
|
|
|
|
|
if (cs_change)
|
|
|
|
spi_engine_gen_cs(p, dry, spi, true);
|
|
|
|
|
|
|
|
spi_engine_gen_xfer(p, dry, xfer);
|
2019-09-26 18:51:47 +08:00
|
|
|
spi_engine_gen_sleep(p, dry, spi_engine, clk_div, xfer);
|
2016-02-05 00:13:30 +08:00
|
|
|
|
|
|
|
cs_change = xfer->cs_change;
|
|
|
|
if (list_is_last(&xfer->transfer_list, &msg->transfers))
|
|
|
|
cs_change = !cs_change;
|
|
|
|
|
|
|
|
if (cs_change)
|
|
|
|
spi_engine_gen_cs(p, dry, spi, false);
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void spi_engine_xfer_next(struct spi_engine *spi_engine,
|
|
|
|
struct spi_transfer **_xfer)
|
|
|
|
{
|
|
|
|
struct spi_message *msg = spi_engine->msg;
|
|
|
|
struct spi_transfer *xfer = *_xfer;
|
|
|
|
|
|
|
|
if (!xfer) {
|
|
|
|
xfer = list_first_entry(&msg->transfers,
|
|
|
|
struct spi_transfer, transfer_list);
|
|
|
|
} else if (list_is_last(&xfer->transfer_list, &msg->transfers)) {
|
|
|
|
xfer = NULL;
|
|
|
|
} else {
|
|
|
|
xfer = list_next_entry(xfer, transfer_list);
|
|
|
|
}
|
|
|
|
|
|
|
|
*_xfer = xfer;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void spi_engine_tx_next(struct spi_engine *spi_engine)
|
|
|
|
{
|
2023-11-18 04:13:00 +08:00
|
|
|
struct spi_engine_message_state *st = spi_engine->msg->state;
|
|
|
|
struct spi_transfer *xfer = st->tx_xfer;
|
2016-02-05 00:13:30 +08:00
|
|
|
|
|
|
|
do {
|
|
|
|
spi_engine_xfer_next(spi_engine, &xfer);
|
|
|
|
} while (xfer && !xfer->tx_buf);
|
|
|
|
|
2023-11-18 04:13:00 +08:00
|
|
|
st->tx_xfer = xfer;
|
2016-02-05 00:13:30 +08:00
|
|
|
if (xfer) {
|
2023-11-18 04:13:00 +08:00
|
|
|
st->tx_length = xfer->len;
|
|
|
|
st->tx_buf = xfer->tx_buf;
|
2016-02-05 00:13:30 +08:00
|
|
|
} else {
|
2023-11-18 04:13:00 +08:00
|
|
|
st->tx_buf = NULL;
|
2016-02-05 00:13:30 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void spi_engine_rx_next(struct spi_engine *spi_engine)
|
|
|
|
{
|
2023-11-18 04:13:00 +08:00
|
|
|
struct spi_engine_message_state *st = spi_engine->msg->state;
|
|
|
|
struct spi_transfer *xfer = st->rx_xfer;
|
2016-02-05 00:13:30 +08:00
|
|
|
|
|
|
|
do {
|
|
|
|
spi_engine_xfer_next(spi_engine, &xfer);
|
|
|
|
} while (xfer && !xfer->rx_buf);
|
|
|
|
|
2023-11-18 04:13:00 +08:00
|
|
|
st->rx_xfer = xfer;
|
2016-02-05 00:13:30 +08:00
|
|
|
if (xfer) {
|
2023-11-18 04:13:00 +08:00
|
|
|
st->rx_length = xfer->len;
|
|
|
|
st->rx_buf = xfer->rx_buf;
|
2016-02-05 00:13:30 +08:00
|
|
|
} else {
|
2023-11-18 04:13:00 +08:00
|
|
|
st->rx_buf = NULL;
|
2016-02-05 00:13:30 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static bool spi_engine_write_cmd_fifo(struct spi_engine *spi_engine)
|
|
|
|
{
|
|
|
|
void __iomem *addr = spi_engine->base + SPI_ENGINE_REG_CMD_FIFO;
|
2023-11-18 04:13:00 +08:00
|
|
|
struct spi_engine_message_state *st = spi_engine->msg->state;
|
2016-02-05 00:13:30 +08:00
|
|
|
unsigned int n, m, i;
|
|
|
|
const uint16_t *buf;
|
|
|
|
|
|
|
|
n = readl_relaxed(spi_engine->base + SPI_ENGINE_REG_CMD_FIFO_ROOM);
|
2023-11-18 04:13:00 +08:00
|
|
|
while (n && st->cmd_length) {
|
|
|
|
m = min(n, st->cmd_length);
|
|
|
|
buf = st->cmd_buf;
|
2016-02-05 00:13:30 +08:00
|
|
|
for (i = 0; i < m; i++)
|
|
|
|
writel_relaxed(buf[i], addr);
|
2023-11-18 04:13:00 +08:00
|
|
|
st->cmd_buf += m;
|
|
|
|
st->cmd_length -= m;
|
2016-02-05 00:13:30 +08:00
|
|
|
n -= m;
|
|
|
|
}
|
|
|
|
|
2023-11-18 04:13:00 +08:00
|
|
|
return st->cmd_length != 0;
|
2016-02-05 00:13:30 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
static bool spi_engine_write_tx_fifo(struct spi_engine *spi_engine)
|
|
|
|
{
|
|
|
|
void __iomem *addr = spi_engine->base + SPI_ENGINE_REG_SDO_DATA_FIFO;
|
2023-11-18 04:13:00 +08:00
|
|
|
struct spi_engine_message_state *st = spi_engine->msg->state;
|
2016-02-05 00:13:30 +08:00
|
|
|
unsigned int n, m, i;
|
|
|
|
const uint8_t *buf;
|
|
|
|
|
|
|
|
n = readl_relaxed(spi_engine->base + SPI_ENGINE_REG_SDO_FIFO_ROOM);
|
2023-11-18 04:13:00 +08:00
|
|
|
while (n && st->tx_length) {
|
|
|
|
m = min(n, st->tx_length);
|
|
|
|
buf = st->tx_buf;
|
2016-02-05 00:13:30 +08:00
|
|
|
for (i = 0; i < m; i++)
|
|
|
|
writel_relaxed(buf[i], addr);
|
2023-11-18 04:13:00 +08:00
|
|
|
st->tx_buf += m;
|
|
|
|
st->tx_length -= m;
|
2016-02-05 00:13:30 +08:00
|
|
|
n -= m;
|
2023-11-18 04:13:00 +08:00
|
|
|
if (st->tx_length == 0)
|
2016-02-05 00:13:30 +08:00
|
|
|
spi_engine_tx_next(spi_engine);
|
|
|
|
}
|
|
|
|
|
2023-11-18 04:13:00 +08:00
|
|
|
return st->tx_length != 0;
|
2016-02-05 00:13:30 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
static bool spi_engine_read_rx_fifo(struct spi_engine *spi_engine)
|
|
|
|
{
|
|
|
|
void __iomem *addr = spi_engine->base + SPI_ENGINE_REG_SDI_DATA_FIFO;
|
2023-11-18 04:13:00 +08:00
|
|
|
struct spi_engine_message_state *st = spi_engine->msg->state;
|
2016-02-05 00:13:30 +08:00
|
|
|
unsigned int n, m, i;
|
|
|
|
uint8_t *buf;
|
|
|
|
|
|
|
|
n = readl_relaxed(spi_engine->base + SPI_ENGINE_REG_SDI_FIFO_LEVEL);
|
2023-11-18 04:13:00 +08:00
|
|
|
while (n && st->rx_length) {
|
|
|
|
m = min(n, st->rx_length);
|
|
|
|
buf = st->rx_buf;
|
2016-02-05 00:13:30 +08:00
|
|
|
for (i = 0; i < m; i++)
|
|
|
|
buf[i] = readl_relaxed(addr);
|
2023-11-18 04:13:00 +08:00
|
|
|
st->rx_buf += m;
|
|
|
|
st->rx_length -= m;
|
2016-02-05 00:13:30 +08:00
|
|
|
n -= m;
|
2023-11-18 04:13:00 +08:00
|
|
|
if (st->rx_length == 0)
|
2016-02-05 00:13:30 +08:00
|
|
|
spi_engine_rx_next(spi_engine);
|
|
|
|
}
|
|
|
|
|
2023-11-18 04:13:00 +08:00
|
|
|
return st->rx_length != 0;
|
2016-02-05 00:13:30 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
static irqreturn_t spi_engine_irq(int irq, void *devid)
|
|
|
|
{
|
2023-07-28 17:32:03 +08:00
|
|
|
struct spi_controller *host = devid;
|
|
|
|
struct spi_engine *spi_engine = spi_controller_get_devdata(host);
|
2016-02-05 00:13:30 +08:00
|
|
|
unsigned int disable_int = 0;
|
|
|
|
unsigned int pending;
|
|
|
|
|
|
|
|
pending = readl_relaxed(spi_engine->base + SPI_ENGINE_REG_INT_PENDING);
|
|
|
|
|
|
|
|
if (pending & SPI_ENGINE_INT_SYNC) {
|
|
|
|
writel_relaxed(SPI_ENGINE_INT_SYNC,
|
|
|
|
spi_engine->base + SPI_ENGINE_REG_INT_PENDING);
|
|
|
|
spi_engine->completed_id = readl_relaxed(
|
|
|
|
spi_engine->base + SPI_ENGINE_REG_SYNC_ID);
|
|
|
|
}
|
|
|
|
|
|
|
|
spin_lock(&spi_engine->lock);
|
|
|
|
|
|
|
|
if (pending & SPI_ENGINE_INT_CMD_ALMOST_EMPTY) {
|
|
|
|
if (!spi_engine_write_cmd_fifo(spi_engine))
|
|
|
|
disable_int |= SPI_ENGINE_INT_CMD_ALMOST_EMPTY;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (pending & SPI_ENGINE_INT_SDO_ALMOST_EMPTY) {
|
|
|
|
if (!spi_engine_write_tx_fifo(spi_engine))
|
|
|
|
disable_int |= SPI_ENGINE_INT_SDO_ALMOST_EMPTY;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (pending & (SPI_ENGINE_INT_SDI_ALMOST_FULL | SPI_ENGINE_INT_SYNC)) {
|
|
|
|
if (!spi_engine_read_rx_fifo(spi_engine))
|
|
|
|
disable_int |= SPI_ENGINE_INT_SDI_ALMOST_FULL;
|
|
|
|
}
|
|
|
|
|
2023-11-18 04:13:00 +08:00
|
|
|
if (pending & SPI_ENGINE_INT_SYNC && spi_engine->msg) {
|
|
|
|
struct spi_engine_message_state *st = spi_engine->msg->state;
|
|
|
|
|
|
|
|
if (spi_engine->completed_id == st->sync_id) {
|
2016-02-05 00:13:30 +08:00
|
|
|
struct spi_message *msg = spi_engine->msg;
|
2023-11-18 04:13:00 +08:00
|
|
|
struct spi_engine_message_state *st = msg->state;
|
2016-02-05 00:13:30 +08:00
|
|
|
|
2023-11-18 04:13:00 +08:00
|
|
|
ida_free(&spi_engine->sync_ida, st->sync_id);
|
|
|
|
kfree(st->p);
|
|
|
|
kfree(st);
|
2016-02-05 00:13:30 +08:00
|
|
|
msg->status = 0;
|
|
|
|
msg->actual_length = msg->frame_length;
|
|
|
|
spi_engine->msg = NULL;
|
2023-07-28 17:32:03 +08:00
|
|
|
spi_finalize_current_message(host);
|
2016-02-05 00:13:30 +08:00
|
|
|
disable_int |= SPI_ENGINE_INT_SYNC;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (disable_int) {
|
|
|
|
spi_engine->int_enable &= ~disable_int;
|
|
|
|
writel_relaxed(spi_engine->int_enable,
|
|
|
|
spi_engine->base + SPI_ENGINE_REG_INT_ENABLE);
|
|
|
|
}
|
|
|
|
|
|
|
|
spin_unlock(&spi_engine->lock);
|
|
|
|
|
|
|
|
return IRQ_HANDLED;
|
|
|
|
}
|
|
|
|
|
2023-07-28 17:32:03 +08:00
|
|
|
static int spi_engine_transfer_one_message(struct spi_controller *host,
|
2016-02-05 00:13:30 +08:00
|
|
|
struct spi_message *msg)
|
|
|
|
{
|
|
|
|
struct spi_engine_program p_dry, *p;
|
2023-07-28 17:32:03 +08:00
|
|
|
struct spi_engine *spi_engine = spi_controller_get_devdata(host);
|
2023-11-18 04:13:00 +08:00
|
|
|
struct spi_engine_message_state *st;
|
2016-02-05 00:13:30 +08:00
|
|
|
unsigned int int_enable = 0;
|
|
|
|
unsigned long flags;
|
|
|
|
size_t size;
|
2023-11-18 04:13:00 +08:00
|
|
|
int ret;
|
|
|
|
|
|
|
|
st = kzalloc(sizeof(*st), GFP_KERNEL);
|
|
|
|
if (!st)
|
|
|
|
return -ENOMEM;
|
2016-02-05 00:13:30 +08:00
|
|
|
|
|
|
|
p_dry.length = 0;
|
|
|
|
spi_engine_compile_message(spi_engine, msg, true, &p_dry);
|
|
|
|
|
|
|
|
size = sizeof(*p->instructions) * (p_dry.length + 1);
|
|
|
|
p = kzalloc(sizeof(*p) + size, GFP_KERNEL);
|
2023-11-18 04:13:00 +08:00
|
|
|
if (!p) {
|
|
|
|
kfree(st);
|
2016-02-05 00:13:30 +08:00
|
|
|
return -ENOMEM;
|
2023-11-18 04:13:00 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
ret = ida_alloc_range(&spi_engine->sync_ida, 0, U8_MAX, GFP_KERNEL);
|
|
|
|
if (ret < 0) {
|
|
|
|
kfree(p);
|
|
|
|
kfree(st);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
st->sync_id = ret;
|
|
|
|
|
2016-02-05 00:13:30 +08:00
|
|
|
spi_engine_compile_message(spi_engine, msg, false, p);
|
|
|
|
|
|
|
|
spin_lock_irqsave(&spi_engine->lock, flags);
|
2023-11-18 04:13:00 +08:00
|
|
|
spi_engine_program_add_cmd(p, false, SPI_ENGINE_CMD_SYNC(st->sync_id));
|
2016-02-05 00:13:30 +08:00
|
|
|
|
2023-11-18 04:13:00 +08:00
|
|
|
msg->state = st;
|
2016-02-05 00:13:30 +08:00
|
|
|
spi_engine->msg = msg;
|
2023-11-18 04:13:00 +08:00
|
|
|
st->p = p;
|
2016-02-05 00:13:30 +08:00
|
|
|
|
2023-11-18 04:13:00 +08:00
|
|
|
st->cmd_buf = p->instructions;
|
|
|
|
st->cmd_length = p->length;
|
2016-02-05 00:13:30 +08:00
|
|
|
if (spi_engine_write_cmd_fifo(spi_engine))
|
|
|
|
int_enable |= SPI_ENGINE_INT_CMD_ALMOST_EMPTY;
|
|
|
|
|
|
|
|
spi_engine_tx_next(spi_engine);
|
|
|
|
if (spi_engine_write_tx_fifo(spi_engine))
|
|
|
|
int_enable |= SPI_ENGINE_INT_SDO_ALMOST_EMPTY;
|
|
|
|
|
|
|
|
spi_engine_rx_next(spi_engine);
|
2023-11-18 04:13:00 +08:00
|
|
|
if (st->rx_length != 0)
|
2016-02-05 00:13:30 +08:00
|
|
|
int_enable |= SPI_ENGINE_INT_SDI_ALMOST_FULL;
|
|
|
|
|
|
|
|
int_enable |= SPI_ENGINE_INT_SYNC;
|
|
|
|
|
|
|
|
writel_relaxed(int_enable,
|
|
|
|
spi_engine->base + SPI_ENGINE_REG_INT_ENABLE);
|
|
|
|
spi_engine->int_enable = int_enable;
|
|
|
|
spin_unlock_irqrestore(&spi_engine->lock, flags);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int spi_engine_probe(struct platform_device *pdev)
|
|
|
|
{
|
|
|
|
struct spi_engine *spi_engine;
|
2023-07-28 17:32:03 +08:00
|
|
|
struct spi_controller *host;
|
2016-02-05 00:13:30 +08:00
|
|
|
unsigned int version;
|
|
|
|
int irq;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
irq = platform_get_irq(pdev, 0);
|
2023-08-02 17:32:38 +08:00
|
|
|
if (irq < 0)
|
|
|
|
return irq;
|
2016-02-05 00:13:30 +08:00
|
|
|
|
2023-11-18 04:12:55 +08:00
|
|
|
host = devm_spi_alloc_host(&pdev->dev, sizeof(*spi_engine));
|
2023-07-28 17:32:03 +08:00
|
|
|
if (!host)
|
2016-02-05 00:13:30 +08:00
|
|
|
return -ENOMEM;
|
|
|
|
|
2023-11-18 04:12:54 +08:00
|
|
|
spi_engine = spi_controller_get_devdata(host);
|
2016-02-05 00:13:30 +08:00
|
|
|
|
|
|
|
spin_lock_init(&spi_engine->lock);
|
2023-11-18 04:13:00 +08:00
|
|
|
ida_init(&spi_engine->sync_ida);
|
2016-02-05 00:13:30 +08:00
|
|
|
|
2023-08-23 21:39:18 +08:00
|
|
|
spi_engine->clk = devm_clk_get_enabled(&pdev->dev, "s_axi_aclk");
|
2023-11-18 04:12:55 +08:00
|
|
|
if (IS_ERR(spi_engine->clk))
|
|
|
|
return PTR_ERR(spi_engine->clk);
|
2016-02-05 00:13:30 +08:00
|
|
|
|
2023-08-23 21:39:18 +08:00
|
|
|
spi_engine->ref_clk = devm_clk_get_enabled(&pdev->dev, "spi_clk");
|
2023-11-18 04:12:55 +08:00
|
|
|
if (IS_ERR(spi_engine->ref_clk))
|
|
|
|
return PTR_ERR(spi_engine->ref_clk);
|
2016-02-05 00:13:30 +08:00
|
|
|
|
2020-04-09 23:56:21 +08:00
|
|
|
spi_engine->base = devm_platform_ioremap_resource(pdev, 0);
|
2023-11-18 04:12:55 +08:00
|
|
|
if (IS_ERR(spi_engine->base))
|
|
|
|
return PTR_ERR(spi_engine->base);
|
2020-04-09 23:56:21 +08:00
|
|
|
|
2024-02-03 05:31:32 +08:00
|
|
|
version = readl(spi_engine->base + ADI_AXI_REG_VERSION);
|
|
|
|
if (ADI_AXI_PCORE_VER_MAJOR(version) != 1) {
|
2024-04-13 06:52:48 +08:00
|
|
|
dev_err(&pdev->dev, "Unsupported peripheral version %u.%u.%u\n",
|
2024-02-03 05:31:32 +08:00
|
|
|
ADI_AXI_PCORE_VER_MAJOR(version),
|
|
|
|
ADI_AXI_PCORE_VER_MINOR(version),
|
|
|
|
ADI_AXI_PCORE_VER_PATCH(version));
|
2023-11-18 04:12:55 +08:00
|
|
|
return -ENODEV;
|
2020-04-09 23:56:21 +08:00
|
|
|
}
|
|
|
|
|
2016-02-05 00:13:30 +08:00
|
|
|
writel_relaxed(0x00, spi_engine->base + SPI_ENGINE_REG_RESET);
|
|
|
|
writel_relaxed(0xff, spi_engine->base + SPI_ENGINE_REG_INT_PENDING);
|
|
|
|
writel_relaxed(0x00, spi_engine->base + SPI_ENGINE_REG_INT_ENABLE);
|
|
|
|
|
2023-07-28 17:32:03 +08:00
|
|
|
ret = request_irq(irq, spi_engine_irq, 0, pdev->name, host);
|
2016-02-05 00:13:30 +08:00
|
|
|
if (ret)
|
2023-11-18 04:12:55 +08:00
|
|
|
return ret;
|
2016-02-05 00:13:30 +08:00
|
|
|
|
2023-07-28 17:32:03 +08:00
|
|
|
host->dev.of_node = pdev->dev.of_node;
|
|
|
|
host->mode_bits = SPI_CPOL | SPI_CPHA | SPI_3WIRE;
|
|
|
|
host->bits_per_word_mask = SPI_BPW_MASK(8);
|
|
|
|
host->max_speed_hz = clk_get_rate(spi_engine->ref_clk) / 2;
|
|
|
|
host->transfer_one_message = spi_engine_transfer_one_message;
|
|
|
|
host->num_chipselect = 8;
|
2016-02-05 00:13:30 +08:00
|
|
|
|
2023-07-28 17:32:03 +08:00
|
|
|
ret = spi_register_controller(host);
|
2016-02-05 00:13:30 +08:00
|
|
|
if (ret)
|
|
|
|
goto err_free_irq;
|
|
|
|
|
2023-07-28 17:32:03 +08:00
|
|
|
platform_set_drvdata(pdev, host);
|
2016-02-05 00:13:30 +08:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
err_free_irq:
|
2023-07-28 17:32:03 +08:00
|
|
|
free_irq(irq, host);
|
2016-02-05 00:13:30 +08:00
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2023-03-04 01:19:22 +08:00
|
|
|
static void spi_engine_remove(struct platform_device *pdev)
|
2016-02-05 00:13:30 +08:00
|
|
|
{
|
2023-11-18 04:12:55 +08:00
|
|
|
struct spi_controller *host = platform_get_drvdata(pdev);
|
2023-07-28 17:32:03 +08:00
|
|
|
struct spi_engine *spi_engine = spi_controller_get_devdata(host);
|
2016-02-05 00:13:30 +08:00
|
|
|
int irq = platform_get_irq(pdev, 0);
|
|
|
|
|
2023-07-28 17:32:03 +08:00
|
|
|
spi_unregister_controller(host);
|
2016-02-05 00:13:30 +08:00
|
|
|
|
2023-07-28 17:32:03 +08:00
|
|
|
free_irq(irq, host);
|
2016-02-05 00:13:30 +08:00
|
|
|
|
|
|
|
writel_relaxed(0xff, spi_engine->base + SPI_ENGINE_REG_INT_PENDING);
|
|
|
|
writel_relaxed(0x00, spi_engine->base + SPI_ENGINE_REG_INT_ENABLE);
|
|
|
|
writel_relaxed(0x01, spi_engine->base + SPI_ENGINE_REG_RESET);
|
|
|
|
}
|
|
|
|
|
|
|
|
static const struct of_device_id spi_engine_match_table[] = {
|
|
|
|
{ .compatible = "adi,axi-spi-engine-1.00.a" },
|
|
|
|
{ },
|
|
|
|
};
|
2016-11-24 00:37:08 +08:00
|
|
|
MODULE_DEVICE_TABLE(of, spi_engine_match_table);
|
2016-02-05 00:13:30 +08:00
|
|
|
|
|
|
|
static struct platform_driver spi_engine_driver = {
|
|
|
|
.probe = spi_engine_probe,
|
2023-03-04 01:19:22 +08:00
|
|
|
.remove_new = spi_engine_remove,
|
2016-02-05 00:13:30 +08:00
|
|
|
.driver = {
|
|
|
|
.name = "spi-engine",
|
|
|
|
.of_match_table = spi_engine_match_table,
|
|
|
|
},
|
|
|
|
};
|
|
|
|
module_platform_driver(spi_engine_driver);
|
|
|
|
|
|
|
|
MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>");
|
|
|
|
MODULE_DESCRIPTION("Analog Devices SPI engine peripheral driver");
|
|
|
|
MODULE_LICENSE("GPL");
|