mirror of
https://github.com/torvalds/linux.git
synced 2026-05-05 23:05:25 -04:00
spi: spi_amd: Performance Optimization Patch Series
Merge series from Raju Rangoju <Raju.Rangoju@amd.com>: AMD SPI controller’s index mode performance is constrained by the hardware limitation of the FIFO queue length. This patch series introduces optimizations to the spi_amd driver, aiming to maximize throughput and enhance overall performance. The changes includes, - Enable SPI dual and quad I/O modes and update SPI-MEM support function to reflect AMD SPI0 hardware capabilities. - Utilize efficient kernel APIs to streamline SPI I/O operations for enhanced performance. - Refine the set tx/rx count functions to optimize SPI I/O throughput. - Minimize the number of data read calls by efficiently retrieving data from FIFO queues, improving SPI I/O efficiency. - Add changes to support AMD HID2 SPI controller and update SPI-MEM support function to reflect AMD HID2 hardware capabilities. - Add changes to set SPI controller address mode before initiating the commands - Add changes to implement HIDDMA read operation support for HID2 SPI controller
This commit is contained in:
@@ -7,12 +7,14 @@
|
||||
// Author: Sanjay R Mehta <sanju.mehta@amd.com>
|
||||
|
||||
#include <linux/acpi.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/dma-mapping.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/io-64-nonatomic-lo-hi.h>
|
||||
#include <linux/iopoll.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/spi/spi.h>
|
||||
#include <linux/iopoll.h>
|
||||
#include <linux/spi/spi-mem.h>
|
||||
|
||||
#define AMD_SPI_CTRL0_REG 0x00
|
||||
@@ -33,10 +35,12 @@
|
||||
#define AMD_SPI_TX_COUNT_REG 0x48
|
||||
#define AMD_SPI_RX_COUNT_REG 0x4B
|
||||
#define AMD_SPI_STATUS_REG 0x4C
|
||||
#define AMD_SPI_ADDR32CTRL_REG 0x50
|
||||
|
||||
#define AMD_SPI_FIFO_SIZE 70
|
||||
#define AMD_SPI_MEM_SIZE 200
|
||||
#define AMD_SPI_MAX_DATA 64
|
||||
#define AMD_SPI_HID2_DMA_SIZE 4096
|
||||
|
||||
#define AMD_SPI_ENA_REG 0x20
|
||||
#define AMD_SPI_ALT_SPD_SHIFT 20
|
||||
@@ -47,17 +51,46 @@
|
||||
#define AMD_SPI_SPD7_SHIFT 8
|
||||
#define AMD_SPI_SPD7_MASK GENMASK(13, AMD_SPI_SPD7_SHIFT)
|
||||
|
||||
#define AMD_SPI_HID2_INPUT_RING_BUF0 0X100
|
||||
#define AMD_SPI_HID2_CNTRL 0x150
|
||||
#define AMD_SPI_HID2_INT_STATUS 0x154
|
||||
#define AMD_SPI_HID2_CMD_START 0x156
|
||||
#define AMD_SPI_HID2_INT_MASK 0x158
|
||||
#define AMD_SPI_HID2_READ_CNTRL0 0x170
|
||||
#define AMD_SPI_HID2_READ_CNTRL1 0x174
|
||||
#define AMD_SPI_HID2_READ_CNTRL2 0x180
|
||||
|
||||
#define AMD_SPI_MAX_HZ 100000000
|
||||
#define AMD_SPI_MIN_HZ 800000
|
||||
|
||||
#define AMD_SPI_IO_SLEEP_US 20
|
||||
#define AMD_SPI_IO_TIMEOUT_US 2000000
|
||||
|
||||
/* SPI read command opcodes */
|
||||
#define AMD_SPI_OP_READ 0x03 /* Read data bytes (low frequency) */
|
||||
#define AMD_SPI_OP_READ_FAST 0x0b /* Read data bytes (high frequency) */
|
||||
#define AMD_SPI_OP_READ_1_1_2 0x3b /* Read data bytes (Dual Output SPI) */
|
||||
#define AMD_SPI_OP_READ_1_2_2 0xbb /* Read data bytes (Dual I/O SPI) */
|
||||
#define AMD_SPI_OP_READ_1_1_4 0x6b /* Read data bytes (Quad Output SPI) */
|
||||
#define AMD_SPI_OP_READ_1_4_4 0xeb /* Read data bytes (Quad I/O SPI) */
|
||||
|
||||
/* SPI read command opcodes - 4B address */
|
||||
#define AMD_SPI_OP_READ_FAST_4B 0x0c /* Read data bytes (high frequency) */
|
||||
#define AMD_SPI_OP_READ_1_1_2_4B 0x3c /* Read data bytes (Dual Output SPI) */
|
||||
#define AMD_SPI_OP_READ_1_2_2_4B 0xbc /* Read data bytes (Dual I/O SPI) */
|
||||
#define AMD_SPI_OP_READ_1_1_4_4B 0x6c /* Read data bytes (Quad Output SPI) */
|
||||
#define AMD_SPI_OP_READ_1_4_4_4B 0xec /* Read data bytes (Quad I/O SPI) */
|
||||
|
||||
/**
|
||||
* enum amd_spi_versions - SPI controller versions
|
||||
* @AMD_SPI_V1: AMDI0061 hardware version
|
||||
* @AMD_SPI_V2: AMDI0062 hardware version
|
||||
* @AMD_HID2_SPI: AMDI0063 hardware version
|
||||
*/
|
||||
enum amd_spi_versions {
|
||||
AMD_SPI_V1 = 1,
|
||||
AMD_SPI_V2,
|
||||
AMD_HID2_SPI,
|
||||
};
|
||||
|
||||
enum amd_spi_speed {
|
||||
@@ -88,23 +121,27 @@ struct amd_spi_freq {
|
||||
/**
|
||||
* struct amd_spi - SPI driver instance
|
||||
* @io_remap_addr: Start address of the SPI controller registers
|
||||
* @phy_dma_buf: Physical address of DMA buffer
|
||||
* @dma_virt_addr: Virtual address of DMA buffer
|
||||
* @version: SPI controller hardware version
|
||||
* @speed_hz: Device frequency
|
||||
*/
|
||||
struct amd_spi {
|
||||
void __iomem *io_remap_addr;
|
||||
dma_addr_t phy_dma_buf;
|
||||
void *dma_virt_addr;
|
||||
enum amd_spi_versions version;
|
||||
unsigned int speed_hz;
|
||||
};
|
||||
|
||||
static inline u8 amd_spi_readreg8(struct amd_spi *amd_spi, int idx)
|
||||
{
|
||||
return ioread8((u8 __iomem *)amd_spi->io_remap_addr + idx);
|
||||
return readb((u8 __iomem *)amd_spi->io_remap_addr + idx);
|
||||
}
|
||||
|
||||
static inline void amd_spi_writereg8(struct amd_spi *amd_spi, int idx, u8 val)
|
||||
{
|
||||
iowrite8(val, ((u8 __iomem *)amd_spi->io_remap_addr + idx));
|
||||
writeb(val, ((u8 __iomem *)amd_spi->io_remap_addr + idx));
|
||||
}
|
||||
|
||||
static void amd_spi_setclear_reg8(struct amd_spi *amd_spi, int idx, u8 set, u8 clear)
|
||||
@@ -115,14 +152,34 @@ static void amd_spi_setclear_reg8(struct amd_spi *amd_spi, int idx, u8 set, u8 c
|
||||
amd_spi_writereg8(amd_spi, idx, tmp);
|
||||
}
|
||||
|
||||
static inline u16 amd_spi_readreg16(struct amd_spi *amd_spi, int idx)
|
||||
{
|
||||
return readw((u8 __iomem *)amd_spi->io_remap_addr + idx);
|
||||
}
|
||||
|
||||
static inline void amd_spi_writereg16(struct amd_spi *amd_spi, int idx, u16 val)
|
||||
{
|
||||
writew(val, ((u8 __iomem *)amd_spi->io_remap_addr + idx));
|
||||
}
|
||||
|
||||
static inline u32 amd_spi_readreg32(struct amd_spi *amd_spi, int idx)
|
||||
{
|
||||
return ioread32((u8 __iomem *)amd_spi->io_remap_addr + idx);
|
||||
return readl((u8 __iomem *)amd_spi->io_remap_addr + idx);
|
||||
}
|
||||
|
||||
static inline void amd_spi_writereg32(struct amd_spi *amd_spi, int idx, u32 val)
|
||||
{
|
||||
iowrite32(val, ((u8 __iomem *)amd_spi->io_remap_addr + idx));
|
||||
writel(val, ((u8 __iomem *)amd_spi->io_remap_addr + idx));
|
||||
}
|
||||
|
||||
static inline u64 amd_spi_readreg64(struct amd_spi *amd_spi, int idx)
|
||||
{
|
||||
return readq((u8 __iomem *)amd_spi->io_remap_addr + idx);
|
||||
}
|
||||
|
||||
static inline void amd_spi_writereg64(struct amd_spi *amd_spi, int idx, u64 val)
|
||||
{
|
||||
writeq(val, ((u8 __iomem *)amd_spi->io_remap_addr + idx));
|
||||
}
|
||||
|
||||
static inline void amd_spi_setclear_reg32(struct amd_spi *amd_spi, int idx, u32 set, u32 clear)
|
||||
@@ -156,6 +213,7 @@ static int amd_spi_set_opcode(struct amd_spi *amd_spi, u8 cmd_opcode)
|
||||
AMD_SPI_OPCODE_MASK);
|
||||
return 0;
|
||||
case AMD_SPI_V2:
|
||||
case AMD_HID2_SPI:
|
||||
amd_spi_writereg8(amd_spi, AMD_SPI_OPCODE_REG, cmd_opcode);
|
||||
return 0;
|
||||
default:
|
||||
@@ -165,12 +223,12 @@ static int amd_spi_set_opcode(struct amd_spi *amd_spi, u8 cmd_opcode)
|
||||
|
||||
static inline void amd_spi_set_rx_count(struct amd_spi *amd_spi, u8 rx_count)
|
||||
{
|
||||
amd_spi_setclear_reg8(amd_spi, AMD_SPI_RX_COUNT_REG, rx_count, 0xff);
|
||||
amd_spi_writereg8(amd_spi, AMD_SPI_RX_COUNT_REG, rx_count);
|
||||
}
|
||||
|
||||
static inline void amd_spi_set_tx_count(struct amd_spi *amd_spi, u8 tx_count)
|
||||
{
|
||||
amd_spi_setclear_reg8(amd_spi, AMD_SPI_TX_COUNT_REG, tx_count, 0xff);
|
||||
amd_spi_writereg8(amd_spi, AMD_SPI_TX_COUNT_REG, tx_count);
|
||||
}
|
||||
|
||||
static int amd_spi_busy_wait(struct amd_spi *amd_spi)
|
||||
@@ -183,6 +241,7 @@ static int amd_spi_busy_wait(struct amd_spi *amd_spi)
|
||||
reg = AMD_SPI_CTRL0_REG;
|
||||
break;
|
||||
case AMD_SPI_V2:
|
||||
case AMD_HID2_SPI:
|
||||
reg = AMD_SPI_STATUS_REG;
|
||||
break;
|
||||
default:
|
||||
@@ -208,6 +267,7 @@ static int amd_spi_execute_opcode(struct amd_spi *amd_spi)
|
||||
AMD_SPI_EXEC_CMD);
|
||||
return 0;
|
||||
case AMD_SPI_V2:
|
||||
case AMD_HID2_SPI:
|
||||
/* Trigger the command execution */
|
||||
amd_spi_setclear_reg8(amd_spi, AMD_SPI_CMD_TRIGGER_REG,
|
||||
AMD_SPI_TRIGGER_CMD, AMD_SPI_TRIGGER_CMD);
|
||||
@@ -349,6 +409,7 @@ fin_msg:
|
||||
case AMD_SPI_V1:
|
||||
break;
|
||||
case AMD_SPI_V2:
|
||||
case AMD_HID2_SPI:
|
||||
amd_spi_clear_chip(amd_spi, spi_get_chipselect(message->spi, 0));
|
||||
break;
|
||||
default:
|
||||
@@ -360,20 +421,82 @@ fin_msg:
|
||||
return message->status;
|
||||
}
|
||||
|
||||
static inline bool amd_is_spi_read_cmd_4b(const u16 op)
|
||||
{
|
||||
switch (op) {
|
||||
case AMD_SPI_OP_READ_FAST_4B:
|
||||
case AMD_SPI_OP_READ_1_1_2_4B:
|
||||
case AMD_SPI_OP_READ_1_2_2_4B:
|
||||
case AMD_SPI_OP_READ_1_1_4_4B:
|
||||
case AMD_SPI_OP_READ_1_4_4_4B:
|
||||
return true;
|
||||
default:
|
||||
return false;
|
||||
}
|
||||
}
|
||||
|
||||
static inline bool amd_is_spi_read_cmd(const u16 op)
|
||||
{
|
||||
switch (op) {
|
||||
case AMD_SPI_OP_READ:
|
||||
case AMD_SPI_OP_READ_FAST:
|
||||
case AMD_SPI_OP_READ_1_1_2:
|
||||
case AMD_SPI_OP_READ_1_2_2:
|
||||
case AMD_SPI_OP_READ_1_1_4:
|
||||
case AMD_SPI_OP_READ_1_4_4:
|
||||
return true;
|
||||
default:
|
||||
return amd_is_spi_read_cmd_4b(op);
|
||||
}
|
||||
}
|
||||
|
||||
static bool amd_spi_supports_op(struct spi_mem *mem,
|
||||
const struct spi_mem_op *op)
|
||||
{
|
||||
struct amd_spi *amd_spi = spi_controller_get_devdata(mem->spi->controller);
|
||||
|
||||
/* bus width is number of IO lines used to transmit */
|
||||
if (op->cmd.buswidth > 1 || op->addr.buswidth > 1 ||
|
||||
op->data.buswidth > 1 || op->data.nbytes > AMD_SPI_MAX_DATA)
|
||||
if (op->cmd.buswidth > 1 || op->addr.buswidth > 4)
|
||||
return false;
|
||||
|
||||
/* AMD SPI controllers support quad mode only for read operations */
|
||||
if (amd_is_spi_read_cmd(op->cmd.opcode)) {
|
||||
if (op->data.buswidth > 4)
|
||||
return false;
|
||||
|
||||
/*
|
||||
* HID2 SPI controller supports DMA read up to 4K bytes and
|
||||
* doesn't support 4-byte address commands.
|
||||
*/
|
||||
if (amd_spi->version == AMD_HID2_SPI) {
|
||||
if (amd_is_spi_read_cmd_4b(op->cmd.opcode) ||
|
||||
op->data.nbytes > AMD_SPI_HID2_DMA_SIZE)
|
||||
return false;
|
||||
} else if (op->data.nbytes > AMD_SPI_MAX_DATA) {
|
||||
return false;
|
||||
}
|
||||
} else if (op->data.buswidth > 1 || op->data.nbytes > AMD_SPI_MAX_DATA) {
|
||||
return false;
|
||||
}
|
||||
|
||||
return spi_mem_default_supports_op(mem, op);
|
||||
}
|
||||
|
||||
static int amd_spi_adjust_op_size(struct spi_mem *mem, struct spi_mem_op *op)
|
||||
{
|
||||
op->data.nbytes = clamp_val(op->data.nbytes, 0, AMD_SPI_MAX_DATA);
|
||||
struct amd_spi *amd_spi = spi_controller_get_devdata(mem->spi->controller);
|
||||
|
||||
/*
|
||||
* HID2 SPI controller DMA read mode supports reading up to 4k
|
||||
* bytes in single transaction, where as SPI0 and HID2 SPI
|
||||
* controller index mode supports maximum of 64 bytes in a single
|
||||
* transaction.
|
||||
*/
|
||||
if (amd_spi->version == AMD_HID2_SPI && amd_is_spi_read_cmd(op->cmd.opcode))
|
||||
op->data.nbytes = clamp_val(op->data.nbytes, 0, AMD_SPI_HID2_DMA_SIZE);
|
||||
else
|
||||
op->data.nbytes = clamp_val(op->data.nbytes, 0, AMD_SPI_MAX_DATA);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
@@ -397,15 +520,23 @@ static void amd_spi_mem_data_out(struct amd_spi *amd_spi,
|
||||
const struct spi_mem_op *op)
|
||||
{
|
||||
int base_addr = AMD_SPI_FIFO_BASE + op->addr.nbytes;
|
||||
u8 *buf = (u8 *)op->data.buf.out;
|
||||
u64 *buf_64 = (u64 *)op->data.buf.out;
|
||||
u32 nbytes = op->data.nbytes;
|
||||
u32 left_data = nbytes;
|
||||
u8 *buf;
|
||||
int i;
|
||||
|
||||
amd_spi_set_opcode(amd_spi, op->cmd.opcode);
|
||||
amd_spi_set_addr(amd_spi, op);
|
||||
|
||||
for (i = 0; i < nbytes; i++)
|
||||
amd_spi_writereg8(amd_spi, (base_addr + i), buf[i]);
|
||||
for (i = 0; left_data >= 8; i++, left_data -= 8)
|
||||
amd_spi_writereg64(amd_spi, base_addr + op->dummy.nbytes + (i * 8), *buf_64++);
|
||||
|
||||
buf = (u8 *)buf_64;
|
||||
for (i = 0; i < left_data; i++) {
|
||||
amd_spi_writereg8(amd_spi, base_addr + op->dummy.nbytes + nbytes + i - left_data,
|
||||
buf[i]);
|
||||
}
|
||||
|
||||
amd_spi_set_tx_count(amd_spi, op->addr.nbytes + op->data.nbytes);
|
||||
amd_spi_set_rx_count(amd_spi, 0);
|
||||
@@ -413,26 +544,128 @@ static void amd_spi_mem_data_out(struct amd_spi *amd_spi,
|
||||
amd_spi_execute_opcode(amd_spi);
|
||||
}
|
||||
|
||||
static void amd_spi_hiddma_read(struct amd_spi *amd_spi, const struct spi_mem_op *op)
|
||||
{
|
||||
u16 hid_cmd_start, val;
|
||||
u32 hid_regval;
|
||||
|
||||
/* Set the opcode in hid2_read_control0 register */
|
||||
hid_regval = amd_spi_readreg32(amd_spi, AMD_SPI_HID2_READ_CNTRL0);
|
||||
hid_regval = (hid_regval & ~GENMASK(7, 0)) | op->cmd.opcode;
|
||||
|
||||
/*
|
||||
* Program the address in the hid2_read_control0 register [8:31]. The address should
|
||||
* be written starting from the 8th bit of the register, requiring an 8-bit shift.
|
||||
* Additionally, to convert a 2-byte spinand address to a 3-byte address, another
|
||||
* 8-bit shift is needed. Therefore, a total shift of 16 bits is required.
|
||||
*/
|
||||
hid_regval = (hid_regval & ~GENMASK(31, 8)) | (op->addr.val << 16);
|
||||
amd_spi_writereg32(amd_spi, AMD_SPI_HID2_READ_CNTRL0, hid_regval);
|
||||
|
||||
/* Configure dummy clock cycles for fast read, dual, quad I/O commands */
|
||||
hid_regval = amd_spi_readreg32(amd_spi, AMD_SPI_HID2_READ_CNTRL2);
|
||||
/* Fast read dummy cycle */
|
||||
hid_regval &= ~GENMASK(4, 0);
|
||||
|
||||
/* Fast read Dual I/O dummy cycle */
|
||||
hid_regval &= ~GENMASK(12, 8);
|
||||
|
||||
/* Fast read Quad I/O dummy cycle */
|
||||
hid_regval = (hid_regval & ~GENMASK(20, 16)) | BIT(17);
|
||||
|
||||
/* Set no of preamble bytecount */
|
||||
hid_regval &= ~GENMASK(27, 24);
|
||||
amd_spi_writereg32(amd_spi, AMD_SPI_HID2_READ_CNTRL2, hid_regval);
|
||||
|
||||
/*
|
||||
* Program the HID2 Input Ring Buffer0. 4k aligned buf_memory_addr[31:12],
|
||||
* buf_size[4:0], end_input_ring[5].
|
||||
*/
|
||||
hid_regval = amd_spi->phy_dma_buf | BIT(5) | BIT(0);
|
||||
amd_spi_writereg32(amd_spi, AMD_SPI_HID2_INPUT_RING_BUF0, hid_regval);
|
||||
|
||||
/* Program max read length(no of DWs) in hid2_read_control1 register */
|
||||
hid_regval = amd_spi_readreg32(amd_spi, AMD_SPI_HID2_READ_CNTRL1);
|
||||
hid_regval = (hid_regval & ~GENMASK(15, 0)) | ((op->data.nbytes / 4) - 1);
|
||||
amd_spi_writereg32(amd_spi, AMD_SPI_HID2_READ_CNTRL1, hid_regval);
|
||||
|
||||
/* Set cmd start bit in hid2_cmd_start register to trigger HID basic read operation */
|
||||
hid_cmd_start = amd_spi_readreg16(amd_spi, AMD_SPI_HID2_CMD_START);
|
||||
amd_spi_writereg16(amd_spi, AMD_SPI_HID2_CMD_START, (hid_cmd_start | BIT(3)));
|
||||
|
||||
/* Check interrupt status of HIDDMA basic read operation in hid2_int_status register */
|
||||
readw_poll_timeout(amd_spi->io_remap_addr + AMD_SPI_HID2_INT_STATUS, val,
|
||||
(val & BIT(3)), AMD_SPI_IO_SLEEP_US, AMD_SPI_IO_TIMEOUT_US);
|
||||
|
||||
/* Clear the interrupts by writing to hid2_int_status register */
|
||||
val = amd_spi_readreg16(amd_spi, AMD_SPI_HID2_INT_STATUS);
|
||||
amd_spi_writereg16(amd_spi, AMD_SPI_HID2_INT_STATUS, val);
|
||||
}
|
||||
|
||||
static void amd_spi_mem_data_in(struct amd_spi *amd_spi,
|
||||
const struct spi_mem_op *op)
|
||||
{
|
||||
int offset = (op->addr.nbytes == 0) ? 0 : 1;
|
||||
u8 *buf = (u8 *)op->data.buf.in;
|
||||
int base_addr = AMD_SPI_FIFO_BASE + op->addr.nbytes;
|
||||
u64 *buf_64 = (u64 *)op->data.buf.in;
|
||||
u32 nbytes = op->data.nbytes;
|
||||
int base_addr, i;
|
||||
u32 left_data = nbytes;
|
||||
u32 data;
|
||||
u8 *buf;
|
||||
int i;
|
||||
|
||||
base_addr = AMD_SPI_FIFO_BASE + op->addr.nbytes + offset;
|
||||
/*
|
||||
* Condition for using HID read mode. Only for reading complete page data, use HID read.
|
||||
* Use index mode otherwise.
|
||||
*/
|
||||
if (amd_spi->version == AMD_HID2_SPI && amd_is_spi_read_cmd(op->cmd.opcode)) {
|
||||
amd_spi_hiddma_read(amd_spi, op);
|
||||
|
||||
amd_spi_set_opcode(amd_spi, op->cmd.opcode);
|
||||
amd_spi_set_addr(amd_spi, op);
|
||||
amd_spi_set_tx_count(amd_spi, op->addr.nbytes);
|
||||
amd_spi_set_rx_count(amd_spi, op->data.nbytes + 1);
|
||||
amd_spi_clear_fifo_ptr(amd_spi);
|
||||
amd_spi_execute_opcode(amd_spi);
|
||||
amd_spi_busy_wait(amd_spi);
|
||||
for (i = 0; left_data >= 8; i++, left_data -= 8)
|
||||
*buf_64++ = readq((u8 __iomem *)amd_spi->dma_virt_addr + (i * 8));
|
||||
|
||||
for (i = 0; i < nbytes; i++)
|
||||
buf[i] = amd_spi_readreg8(amd_spi, base_addr + i);
|
||||
buf = (u8 *)buf_64;
|
||||
for (i = 0; i < left_data; i++)
|
||||
buf[i] = readb((u8 __iomem *)amd_spi->dma_virt_addr +
|
||||
(nbytes - left_data + i));
|
||||
|
||||
/* Reset HID RX memory logic */
|
||||
data = amd_spi_readreg32(amd_spi, AMD_SPI_HID2_CNTRL);
|
||||
amd_spi_writereg32(amd_spi, AMD_SPI_HID2_CNTRL, data | BIT(5));
|
||||
} else {
|
||||
/* Index mode */
|
||||
amd_spi_set_opcode(amd_spi, op->cmd.opcode);
|
||||
amd_spi_set_addr(amd_spi, op);
|
||||
amd_spi_set_tx_count(amd_spi, op->addr.nbytes + op->dummy.nbytes);
|
||||
|
||||
for (i = 0; i < op->dummy.nbytes; i++)
|
||||
amd_spi_writereg8(amd_spi, (base_addr + i), 0xff);
|
||||
|
||||
amd_spi_set_rx_count(amd_spi, op->data.nbytes);
|
||||
amd_spi_clear_fifo_ptr(amd_spi);
|
||||
amd_spi_execute_opcode(amd_spi);
|
||||
amd_spi_busy_wait(amd_spi);
|
||||
|
||||
for (i = 0; left_data >= 8; i++, left_data -= 8)
|
||||
*buf_64++ = amd_spi_readreg64(amd_spi, base_addr + op->dummy.nbytes +
|
||||
(i * 8));
|
||||
|
||||
buf = (u8 *)buf_64;
|
||||
for (i = 0; i < left_data; i++)
|
||||
buf[i] = amd_spi_readreg8(amd_spi, base_addr + op->dummy.nbytes +
|
||||
nbytes + i - left_data);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
static void amd_set_spi_addr_mode(struct amd_spi *amd_spi,
|
||||
const struct spi_mem_op *op)
|
||||
{
|
||||
u32 val = amd_spi_readreg32(amd_spi, AMD_SPI_ADDR32CTRL_REG);
|
||||
|
||||
if (amd_is_spi_read_cmd_4b(op->cmd.opcode))
|
||||
amd_spi_writereg32(amd_spi, AMD_SPI_ADDR32CTRL_REG, val | BIT(0));
|
||||
else
|
||||
amd_spi_writereg32(amd_spi, AMD_SPI_ADDR32CTRL_REG, val & ~BIT(0));
|
||||
}
|
||||
|
||||
static int amd_spi_exec_mem_op(struct spi_mem *mem,
|
||||
@@ -447,6 +680,9 @@ static int amd_spi_exec_mem_op(struct spi_mem *mem,
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
if (amd_spi->version == AMD_SPI_V2)
|
||||
amd_set_spi_addr_mode(amd_spi, op);
|
||||
|
||||
switch (op->data.dir) {
|
||||
case SPI_MEM_DATA_IN:
|
||||
amd_spi_mem_data_in(amd_spi, op);
|
||||
@@ -489,6 +725,31 @@ static size_t amd_spi_max_transfer_size(struct spi_device *spi)
|
||||
return AMD_SPI_FIFO_SIZE;
|
||||
}
|
||||
|
||||
static int amd_spi_setup_hiddma(struct amd_spi *amd_spi, struct device *dev)
|
||||
{
|
||||
u32 hid_regval;
|
||||
|
||||
/* Allocate DMA buffer to use for HID basic read operation */
|
||||
amd_spi->dma_virt_addr = dma_alloc_coherent(dev, AMD_SPI_HID2_DMA_SIZE,
|
||||
&amd_spi->phy_dma_buf, GFP_KERNEL);
|
||||
if (!amd_spi->dma_virt_addr)
|
||||
return -ENOMEM;
|
||||
|
||||
/*
|
||||
* Enable interrupts and set mask bits in hid2_int_mask register to generate interrupt
|
||||
* properly for HIDDMA basic read operations.
|
||||
*/
|
||||
hid_regval = amd_spi_readreg32(amd_spi, AMD_SPI_HID2_INT_MASK);
|
||||
hid_regval = (hid_regval & GENMASK(31, 8)) | BIT(19);
|
||||
amd_spi_writereg32(amd_spi, AMD_SPI_HID2_INT_MASK, hid_regval);
|
||||
|
||||
/* Configure buffer unit(4k) in hid2_control register */
|
||||
hid_regval = amd_spi_readreg32(amd_spi, AMD_SPI_HID2_CNTRL);
|
||||
amd_spi_writereg32(amd_spi, AMD_SPI_HID2_CNTRL, hid_regval & ~BIT(3));
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int amd_spi_probe(struct platform_device *pdev)
|
||||
{
|
||||
struct device *dev = &pdev->dev;
|
||||
@@ -512,9 +773,9 @@ static int amd_spi_probe(struct platform_device *pdev)
|
||||
amd_spi->version = (uintptr_t) device_get_match_data(dev);
|
||||
|
||||
/* Initialize the spi_controller fields */
|
||||
host->bus_num = 0;
|
||||
host->bus_num = (amd_spi->version == AMD_HID2_SPI) ? 2 : 0;
|
||||
host->num_chipselect = 4;
|
||||
host->mode_bits = 0;
|
||||
host->mode_bits = SPI_TX_DUAL | SPI_TX_QUAD | SPI_RX_DUAL | SPI_RX_QUAD;
|
||||
host->flags = SPI_CONTROLLER_HALF_DUPLEX;
|
||||
host->max_speed_hz = AMD_SPI_MAX_HZ;
|
||||
host->min_speed_hz = AMD_SPI_MIN_HZ;
|
||||
@@ -529,13 +790,17 @@ static int amd_spi_probe(struct platform_device *pdev)
|
||||
if (err)
|
||||
return dev_err_probe(dev, err, "error registering SPI controller\n");
|
||||
|
||||
return 0;
|
||||
if (amd_spi->version == AMD_HID2_SPI)
|
||||
err = amd_spi_setup_hiddma(amd_spi, dev);
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
#ifdef CONFIG_ACPI
|
||||
static const struct acpi_device_id spi_acpi_match[] = {
|
||||
{ "AMDI0061", AMD_SPI_V1 },
|
||||
{ "AMDI0062", AMD_SPI_V2 },
|
||||
{ "AMDI0063", AMD_HID2_SPI },
|
||||
{},
|
||||
};
|
||||
MODULE_DEVICE_TABLE(acpi, spi_acpi_match);
|
||||
|
||||
Reference in New Issue
Block a user