mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-08-27 11:19:37 +00:00
![Rafał Miłecki](/assets/img/avatar_default.png)
This commit makes transfer function use spi_transfer_is_last to determine if currently processed transfer is the last one. Thanks to that we finally set hardware registers properly and it makes controller behave the way it's expected to. This allows simplifying read function which can now simply start reading from the slot 0 instead of the last saved offset. It has been successfully tested using spi_write_then_read. Moreover this change fixes handling messages with two writing transfers. It's important for SPI flash devices as their drivers commonly use one transfer for a command and another one for data. Signed-off-by: Rafał Miłecki <rafal@milecki.pl> Signed-off-by: Mark Brown <broonie@kernel.org>
360 lines
8.6 KiB
C
360 lines
8.6 KiB
C
/*
|
|
* Copyright (C) 2014-2016 Rafał Miłecki <rafal@milecki.pl>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*/
|
|
|
|
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/bcma/bcma.h>
|
|
#include <linux/spi/spi.h>
|
|
|
|
#include "spi-bcm53xx.h"
|
|
|
|
#define BCM53XXSPI_MAX_SPI_BAUD 13500000 /* 216 MHz? */
|
|
#define BCM53XXSPI_FLASH_WINDOW SZ_32M
|
|
|
|
/* The longest observed required wait was 19 ms */
|
|
#define BCM53XXSPI_SPE_TIMEOUT_MS 80
|
|
|
|
struct bcm53xxspi {
|
|
struct bcma_device *core;
|
|
struct spi_master *master;
|
|
void __iomem *mmio_base;
|
|
bool bspi; /* Boot SPI mode with memory mapping */
|
|
};
|
|
|
|
static inline u32 bcm53xxspi_read(struct bcm53xxspi *b53spi, u16 offset)
|
|
{
|
|
return bcma_read32(b53spi->core, offset);
|
|
}
|
|
|
|
static inline void bcm53xxspi_write(struct bcm53xxspi *b53spi, u16 offset,
|
|
u32 value)
|
|
{
|
|
bcma_write32(b53spi->core, offset, value);
|
|
}
|
|
|
|
static void bcm53xxspi_disable_bspi(struct bcm53xxspi *b53spi)
|
|
{
|
|
struct device *dev = &b53spi->core->dev;
|
|
unsigned long deadline;
|
|
u32 tmp;
|
|
|
|
if (!b53spi->bspi)
|
|
return;
|
|
|
|
tmp = bcm53xxspi_read(b53spi, B53SPI_BSPI_MAST_N_BOOT_CTRL);
|
|
if (tmp & 0x1)
|
|
return;
|
|
|
|
deadline = jiffies + usecs_to_jiffies(200);
|
|
do {
|
|
tmp = bcm53xxspi_read(b53spi, B53SPI_BSPI_BUSY_STATUS);
|
|
if (!(tmp & 0x1)) {
|
|
bcm53xxspi_write(b53spi, B53SPI_BSPI_MAST_N_BOOT_CTRL,
|
|
0x1);
|
|
ndelay(200);
|
|
b53spi->bspi = false;
|
|
return;
|
|
}
|
|
udelay(1);
|
|
} while (!time_after_eq(jiffies, deadline));
|
|
|
|
dev_warn(dev, "Timeout disabling BSPI\n");
|
|
}
|
|
|
|
static void bcm53xxspi_enable_bspi(struct bcm53xxspi *b53spi)
|
|
{
|
|
u32 tmp;
|
|
|
|
if (b53spi->bspi)
|
|
return;
|
|
|
|
tmp = bcm53xxspi_read(b53spi, B53SPI_BSPI_MAST_N_BOOT_CTRL);
|
|
if (!(tmp & 0x1))
|
|
return;
|
|
|
|
bcm53xxspi_write(b53spi, B53SPI_BSPI_MAST_N_BOOT_CTRL, 0x0);
|
|
b53spi->bspi = true;
|
|
}
|
|
|
|
static inline unsigned int bcm53xxspi_calc_timeout(size_t len)
|
|
{
|
|
/* Do some magic calculation based on length and buad. Add 10% and 1. */
|
|
return (len * 9000 / BCM53XXSPI_MAX_SPI_BAUD * 110 / 100) + 1;
|
|
}
|
|
|
|
static int bcm53xxspi_wait(struct bcm53xxspi *b53spi, unsigned int timeout_ms)
|
|
{
|
|
unsigned long deadline;
|
|
u32 tmp;
|
|
|
|
/* SPE bit has to be 0 before we read MSPI STATUS */
|
|
deadline = jiffies + msecs_to_jiffies(BCM53XXSPI_SPE_TIMEOUT_MS);
|
|
do {
|
|
tmp = bcm53xxspi_read(b53spi, B53SPI_MSPI_SPCR2);
|
|
if (!(tmp & B53SPI_MSPI_SPCR2_SPE))
|
|
break;
|
|
udelay(5);
|
|
} while (!time_after_eq(jiffies, deadline));
|
|
|
|
if (tmp & B53SPI_MSPI_SPCR2_SPE)
|
|
goto spi_timeout;
|
|
|
|
/* Check status */
|
|
deadline = jiffies + msecs_to_jiffies(timeout_ms);
|
|
do {
|
|
tmp = bcm53xxspi_read(b53spi, B53SPI_MSPI_MSPI_STATUS);
|
|
if (tmp & B53SPI_MSPI_MSPI_STATUS_SPIF) {
|
|
bcm53xxspi_write(b53spi, B53SPI_MSPI_MSPI_STATUS, 0);
|
|
return 0;
|
|
}
|
|
|
|
cpu_relax();
|
|
udelay(100);
|
|
} while (!time_after_eq(jiffies, deadline));
|
|
|
|
spi_timeout:
|
|
bcm53xxspi_write(b53spi, B53SPI_MSPI_MSPI_STATUS, 0);
|
|
|
|
pr_err("Timeout waiting for SPI to be ready!\n");
|
|
|
|
return -EBUSY;
|
|
}
|
|
|
|
static void bcm53xxspi_buf_write(struct bcm53xxspi *b53spi, u8 *w_buf,
|
|
size_t len, bool cont)
|
|
{
|
|
u32 tmp;
|
|
int i;
|
|
|
|
for (i = 0; i < len; i++) {
|
|
/* Transmit Register File MSB */
|
|
bcm53xxspi_write(b53spi, B53SPI_MSPI_TXRAM + 4 * (i * 2),
|
|
(unsigned int)w_buf[i]);
|
|
}
|
|
|
|
for (i = 0; i < len; i++) {
|
|
tmp = B53SPI_CDRAM_CONT | B53SPI_CDRAM_PCS_DISABLE_ALL |
|
|
B53SPI_CDRAM_PCS_DSCK;
|
|
if (!cont && i == len - 1)
|
|
tmp &= ~B53SPI_CDRAM_CONT;
|
|
tmp &= ~0x1;
|
|
/* Command Register File */
|
|
bcm53xxspi_write(b53spi, B53SPI_MSPI_CDRAM + 4 * i, tmp);
|
|
}
|
|
|
|
/* Set queue pointers */
|
|
bcm53xxspi_write(b53spi, B53SPI_MSPI_NEWQP, 0);
|
|
bcm53xxspi_write(b53spi, B53SPI_MSPI_ENDQP, len - 1);
|
|
|
|
if (cont)
|
|
bcm53xxspi_write(b53spi, B53SPI_MSPI_WRITE_LOCK, 1);
|
|
|
|
/* Start SPI transfer */
|
|
tmp = bcm53xxspi_read(b53spi, B53SPI_MSPI_SPCR2);
|
|
tmp |= B53SPI_MSPI_SPCR2_SPE;
|
|
if (cont)
|
|
tmp |= B53SPI_MSPI_SPCR2_CONT_AFTER_CMD;
|
|
bcm53xxspi_write(b53spi, B53SPI_MSPI_SPCR2, tmp);
|
|
|
|
/* Wait for SPI to finish */
|
|
bcm53xxspi_wait(b53spi, bcm53xxspi_calc_timeout(len));
|
|
|
|
if (!cont)
|
|
bcm53xxspi_write(b53spi, B53SPI_MSPI_WRITE_LOCK, 0);
|
|
}
|
|
|
|
static void bcm53xxspi_buf_read(struct bcm53xxspi *b53spi, u8 *r_buf,
|
|
size_t len, bool cont)
|
|
{
|
|
u32 tmp;
|
|
int i;
|
|
|
|
for (i = 0; i < len; i++) {
|
|
tmp = B53SPI_CDRAM_CONT | B53SPI_CDRAM_PCS_DISABLE_ALL |
|
|
B53SPI_CDRAM_PCS_DSCK;
|
|
if (!cont && i == len - 1)
|
|
tmp &= ~B53SPI_CDRAM_CONT;
|
|
tmp &= ~0x1;
|
|
/* Command Register File */
|
|
bcm53xxspi_write(b53spi, B53SPI_MSPI_CDRAM + 4 * i, tmp);
|
|
}
|
|
|
|
/* Set queue pointers */
|
|
bcm53xxspi_write(b53spi, B53SPI_MSPI_NEWQP, 0);
|
|
bcm53xxspi_write(b53spi, B53SPI_MSPI_ENDQP, len - 1);
|
|
|
|
if (cont)
|
|
bcm53xxspi_write(b53spi, B53SPI_MSPI_WRITE_LOCK, 1);
|
|
|
|
/* Start SPI transfer */
|
|
tmp = bcm53xxspi_read(b53spi, B53SPI_MSPI_SPCR2);
|
|
tmp |= B53SPI_MSPI_SPCR2_SPE;
|
|
if (cont)
|
|
tmp |= B53SPI_MSPI_SPCR2_CONT_AFTER_CMD;
|
|
bcm53xxspi_write(b53spi, B53SPI_MSPI_SPCR2, tmp);
|
|
|
|
/* Wait for SPI to finish */
|
|
bcm53xxspi_wait(b53spi, bcm53xxspi_calc_timeout(len));
|
|
|
|
if (!cont)
|
|
bcm53xxspi_write(b53spi, B53SPI_MSPI_WRITE_LOCK, 0);
|
|
|
|
for (i = 0; i < len; ++i) {
|
|
u16 reg = B53SPI_MSPI_RXRAM + 4 * (1 + i * 2);
|
|
|
|
/* Data stored in the transmit register file LSB */
|
|
r_buf[i] = (u8)bcm53xxspi_read(b53spi, reg);
|
|
}
|
|
}
|
|
|
|
static int bcm53xxspi_transfer_one(struct spi_master *master,
|
|
struct spi_device *spi,
|
|
struct spi_transfer *t)
|
|
{
|
|
struct bcm53xxspi *b53spi = spi_master_get_devdata(master);
|
|
u8 *buf;
|
|
size_t left;
|
|
|
|
bcm53xxspi_disable_bspi(b53spi);
|
|
|
|
if (t->tx_buf) {
|
|
buf = (u8 *)t->tx_buf;
|
|
left = t->len;
|
|
while (left) {
|
|
size_t to_write = min_t(size_t, 16, left);
|
|
bool cont = !spi_transfer_is_last(master, t) ||
|
|
left - to_write > 0;
|
|
|
|
bcm53xxspi_buf_write(b53spi, buf, to_write, cont);
|
|
left -= to_write;
|
|
buf += to_write;
|
|
}
|
|
}
|
|
|
|
if (t->rx_buf) {
|
|
buf = (u8 *)t->rx_buf;
|
|
left = t->len;
|
|
while (left) {
|
|
size_t to_read = min_t(size_t, 16, left);
|
|
bool cont = !spi_transfer_is_last(master, t) ||
|
|
left - to_read > 0;
|
|
|
|
bcm53xxspi_buf_read(b53spi, buf, to_read, cont);
|
|
left -= to_read;
|
|
buf += to_read;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int bcm53xxspi_flash_read(struct spi_device *spi,
|
|
struct spi_flash_read_message *msg)
|
|
{
|
|
struct bcm53xxspi *b53spi = spi_master_get_devdata(spi->master);
|
|
int ret = 0;
|
|
|
|
if (msg->from + msg->len > BCM53XXSPI_FLASH_WINDOW)
|
|
return -EINVAL;
|
|
|
|
bcm53xxspi_enable_bspi(b53spi);
|
|
memcpy_fromio(msg->buf, b53spi->mmio_base + msg->from, msg->len);
|
|
msg->retlen = msg->len;
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**************************************************
|
|
* BCMA
|
|
**************************************************/
|
|
|
|
static const struct bcma_device_id bcm53xxspi_bcma_tbl[] = {
|
|
BCMA_CORE(BCMA_MANUF_BCM, BCMA_CORE_NS_QSPI, BCMA_ANY_REV, BCMA_ANY_CLASS),
|
|
{},
|
|
};
|
|
MODULE_DEVICE_TABLE(bcma, bcm53xxspi_bcma_tbl);
|
|
|
|
static int bcm53xxspi_bcma_probe(struct bcma_device *core)
|
|
{
|
|
struct device *dev = &core->dev;
|
|
struct bcm53xxspi *b53spi;
|
|
struct spi_master *master;
|
|
int err;
|
|
|
|
if (core->bus->drv_cc.core->id.rev != 42) {
|
|
pr_err("SPI on SoC with unsupported ChipCommon rev\n");
|
|
return -ENOTSUPP;
|
|
}
|
|
|
|
master = spi_alloc_master(dev, sizeof(*b53spi));
|
|
if (!master)
|
|
return -ENOMEM;
|
|
|
|
b53spi = spi_master_get_devdata(master);
|
|
b53spi->master = master;
|
|
b53spi->core = core;
|
|
|
|
if (core->addr_s[0])
|
|
b53spi->mmio_base = devm_ioremap(dev, core->addr_s[0],
|
|
BCM53XXSPI_FLASH_WINDOW);
|
|
b53spi->bspi = true;
|
|
bcm53xxspi_disable_bspi(b53spi);
|
|
|
|
master->dev.of_node = dev->of_node;
|
|
master->transfer_one = bcm53xxspi_transfer_one;
|
|
if (b53spi->mmio_base)
|
|
master->spi_flash_read = bcm53xxspi_flash_read;
|
|
|
|
bcma_set_drvdata(core, b53spi);
|
|
|
|
err = devm_spi_register_master(dev, master);
|
|
if (err) {
|
|
spi_master_put(master);
|
|
bcma_set_drvdata(core, NULL);
|
|
return err;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct bcma_driver bcm53xxspi_bcma_driver = {
|
|
.name = KBUILD_MODNAME,
|
|
.id_table = bcm53xxspi_bcma_tbl,
|
|
.probe = bcm53xxspi_bcma_probe,
|
|
};
|
|
|
|
/**************************************************
|
|
* Init & exit
|
|
**************************************************/
|
|
|
|
static int __init bcm53xxspi_module_init(void)
|
|
{
|
|
int err = 0;
|
|
|
|
err = bcma_driver_register(&bcm53xxspi_bcma_driver);
|
|
if (err)
|
|
pr_err("Failed to register bcma driver: %d\n", err);
|
|
|
|
return err;
|
|
}
|
|
|
|
static void __exit bcm53xxspi_module_exit(void)
|
|
{
|
|
bcma_driver_unregister(&bcm53xxspi_bcma_driver);
|
|
}
|
|
|
|
module_init(bcm53xxspi_module_init);
|
|
module_exit(bcm53xxspi_module_exit);
|
|
|
|
MODULE_DESCRIPTION("Broadcom BCM53xx SPI Controller driver");
|
|
MODULE_AUTHOR("Rafał Miłecki <zajec5@gmail.com>");
|
|
MODULE_LICENSE("GPL v2");
|