[U-Boot] [PATCH v4 07/12] drivers: spi: cf_spi: convert to driver model
Jagan Teki
jagan at amarulasolutions.com
Mon Mar 11 17:34:34 UTC 2019
On Sun, Mar 10, 2019 at 9:47 PM Angelo Dureghello <angelo at sysam.it> wrote:
>
> Hi Jagan,
>
> thanks for your comments,
>
> On Fri, Mar 08, 2019 at 11:30:56AM +0530, Jagan Teki wrote:
> > On Mon, Dec 17, 2018 at 1:06 AM Angelo Dureghello <angelo at sysam.it> wrote:
> > >
> > > Converting to driver model and removes non-dm code.
> > >
> > > Reviewed-by: Simon Glass <sjg at chromium.org>
> > > Signed-off-by: Angelo Dureghello <angelo at sysam.it>
> > > ---
> > > Changes for v2:
> > > - removed non DM code part
> > > - add default setup of CTAR registers
> > > - add DT CTAR register setup support
> > > Changes for v3:
> > > - changed commit head
> > > - removed spi_slave reference
> > > - add #ifdefs for the case OF_PLATDATA is used
> > > Changes for v4:
> > > - remove all internal static functions that are no more needed including
> > > their code in the standard driver methods
> > > - add helper macro for ctrl setup
> > > - fix wrong fifo level check on spi tx
> > > - move code inside same #if (avoid multiple #if on same option)
> > > - removed externals and moved bus control code here
> > > ---
> > > drivers/spi/cf_spi.c | 539 ++++++++++++++++--------
> > > include/dm/platform_data/spi_coldfire.h | 29 ++
> > > 2 files changed, 401 insertions(+), 167 deletions(-)
> > > create mode 100644 include/dm/platform_data/spi_coldfire.h
> > >
> > > diff --git a/drivers/spi/cf_spi.c b/drivers/spi/cf_spi.c
> > > index 522631cbbf..3d02c87637 100644
> > > --- a/drivers/spi/cf_spi.c
> > > +++ b/drivers/spi/cf_spi.c
> > > @@ -6,23 +6,31 @@
> > > *
> > > * Copyright (C) 2004-2009 Freescale Semiconductor, Inc.
> > > * TsiChung Liew (Tsi-Chung.Liew at freescale.com)
> > > + *
> > > + * Support for DM and DT, non-DM code removed.
> > > + * Copyright (C) 2018 Angelo Dureghello <angelo at sysam.it>
> > > + *
> > > + * TODO: fsl_dspi.c should work as a driver for the DSPI module.
> > > */
> > >
> > > #include <common.h>
> > > +#include <dm.h>
> > > +#include <dm/platform_data/spi_coldfire.h>
> > > #include <spi.h>
> > > #include <malloc.h>
> > > +#include <wait_bit.h>
> > > +#include <asm/coldfire/dspi.h>
> > > #include <asm/immap.h>
> > > +#include <asm/io.h>
> > >
> > > -struct cf_spi_slave {
> > > - struct spi_slave slave;
> > > +struct coldfire_spi_priv {
> > > + struct dspi *regs;
> > > + struct gpio *gpio_regs;
> > > uint baudrate;
> > > + int mode;
> > > int charbit;
> > > };
> > >
> > > -extern void cfspi_port_conf(void);
> > > -extern int cfspi_claim_bus(uint bus, uint cs);
> > > -extern void cfspi_release_bus(uint bus, uint cs);
> > > -
> > > DECLARE_GLOBAL_DATA_PTR;
> > >
> > > #ifndef CONFIG_SPI_IDLE_VAL
> > > @@ -33,149 +41,267 @@ DECLARE_GLOBAL_DATA_PTR;
> > > #endif
> > > #endif
> > >
> > > -#if defined(CONFIG_CF_DSPI)
> > > /* DSPI specific mode */
> > > #define SPI_MODE_MOD 0x00200000
> > > #define SPI_DBLRATE 0x00100000
> > >
> > > -static inline struct cf_spi_slave *to_cf_spi_slave(struct spi_slave *slave)
> > > +#define MCF_DSPI_MAX_CTAR_REGS 8
> > > +
> > > +/* Default values */
> > > +#define MCF_DSPI_DEFAULT_SCK_FREQ 10000000
> > > +#define MCF_DSPI_DEFAULT_MAX_CS 4
> > > +#define MCF_DSPI_DEFAULT_MODE 0
> > > +
> > > +#define MCF_DSPI_DEFAULT_CTAR (DSPI_CTAR_TRSZ(7) | \
> > > + DSPI_CTAR_PCSSCK_1CLK | \
> > > + DSPI_CTAR_PASC(0) | \
> > > + DSPI_CTAR_PDT(0) | \
> > > + DSPI_CTAR_CSSCK(0) | \
> > > + DSPI_CTAR_ASC(0) | \
> > > + DSPI_CTAR_DT(1) | \
> > > + DSPI_CTAR_BR(6))
> > > +
> > > +#define setup_ctrl(ctrl, cs) ((ctrl & 0xFF000000) | ((1 << cs) << 16))
> > > +
> > > +static inline void cfspi_tx(struct coldfire_spi_priv *cfspi,
> > > + u32 ctrl, u16 data)
> > > {
> > > - return container_of(slave, struct cf_spi_slave, slave);
> > > + /*
> > > + * Need to check fifo level here
> > > + */
> > > + while ((readl(&cfspi->regs->sr) & 0x0000F000) >= 0x4000)
> > > + ;
> > > +
> > > + writel(ctrl | data, &cfspi->regs->tfr);
> > > }
> > >
> > > -static void cfspi_init(void)
> > > +static inline u16 cfspi_rx(struct coldfire_spi_priv *cfspi)
> > > {
> > > - volatile dspi_t *dspi = (dspi_t *) MMAP_DSPI;
> > > -
> > > - cfspi_port_conf(); /* port configuration */
> > > + while ((readl(&cfspi->regs->sr) & 0x000000F0) == 0)
> > > + ;
> > >
> > > - dspi->mcr = DSPI_MCR_MSTR | DSPI_MCR_CSIS7 | DSPI_MCR_CSIS6 |
> > > - DSPI_MCR_CSIS5 | DSPI_MCR_CSIS4 | DSPI_MCR_CSIS3 |
> > > - DSPI_MCR_CSIS2 | DSPI_MCR_CSIS1 | DSPI_MCR_CSIS0 |
> > > - DSPI_MCR_CRXF | DSPI_MCR_CTXF;
> > > + return readw(&cfspi->regs->rfr);
> > > +}
> >
> > Look like you include wait header and forgot to implement
> > wait_for_bit_* logic which I commented before.
> >
>
> I tried to use it, this is why i forgot the header.
> The fact is that wait_for_bit_* logic wait for one or more bit(s),
> but cannot wait for one "of" more bit(s), as in the above case.
> So seems cannot apply here.
>
> > >
> > > - /* Default setting in platform configuration */
> > > -#ifdef CONFIG_SYS_DSPI_CTAR0
> > > - dspi->ctar[0] = CONFIG_SYS_DSPI_CTAR0;
> > > -#endif
> > > -#ifdef CONFIG_SYS_DSPI_CTAR1
> > > - dspi->ctar[1] = CONFIG_SYS_DSPI_CTAR1;
> > > -#endif
> > > -#ifdef CONFIG_SYS_DSPI_CTAR2
> > > - dspi->ctar[2] = CONFIG_SYS_DSPI_CTAR2;
> > > -#endif
> > > -#ifdef CONFIG_SYS_DSPI_CTAR3
> > > - dspi->ctar[3] = CONFIG_SYS_DSPI_CTAR3;
> > > -#endif
> > > -#ifdef CONFIG_SYS_DSPI_CTAR4
> > > - dspi->ctar[4] = CONFIG_SYS_DSPI_CTAR4;
> > > +static int coldfire_spi_claim_bus(struct udevice *dev)
> > > +{
> > > + struct udevice *bus = dev->parent;
> > > + struct coldfire_spi_priv *cfspi = dev_get_priv(bus);
> > > + struct dspi *dspi = cfspi->regs;
> > > +#if defined(CONFIG_MCF5445x) || \
> > > + defined(CONFIG_MCF5441x) || defined(CONFIG_MCF5227x)
> > > + struct dm_spi_slave_platdata *slave_plat =
> > > + dev_get_parent_platdata(dev);
> > > + struct gpio *gpio = cfspi->gpio_regs;
> > > #endif
> > > -#ifdef CONFIG_SYS_DSPI_CTAR5
> > > - dspi->ctar[5] = CONFIG_SYS_DSPI_CTAR5;
> > > +
> > > + if ((in_be32(&dspi->sr) & DSPI_SR_TXRXS) != DSPI_SR_TXRXS)
> > > + return -1;
> > > +
> > > + /* Clear FIFO and resume transfer */
> > > + clrbits_be32(&dspi->mcr, DSPI_MCR_CTXF | DSPI_MCR_CRXF);
> > > +
> > > +#ifdef CONFIG_MCF5445x
> > > + switch (slave_plat->cs) {
> > > + case 0:
> > > + clrbits_8(&gpio->par_dspi, GPIO_PAR_DSPI_PCS0_PCS0);
> > > + setbits_8(&gpio->par_dspi, GPIO_PAR_DSPI_PCS0_PCS0);
> > > + break;
> > > + case 1:
> > > + clrbits_8(&gpio->par_dspi, GPIO_PAR_DSPI_PCS1_PCS1);
> > > + setbits_8(&gpio->par_dspi, GPIO_PAR_DSPI_PCS1_PCS1);
> > > + break;
> > > + case 2:
> > > + clrbits_8(&gpio->par_dspi, GPIO_PAR_DSPI_PCS2_PCS2);
> > > + setbits_8(&gpio->par_dspi, GPIO_PAR_DSPI_PCS2_PCS2);
> > > + break;
> > > + case 3:
> > > + clrbits_8(&gpio->par_dma, ~GPIO_PAR_DMA_DACK0_UNMASK);
> > > + setbits_8(&gpio->par_dma, GPIO_PAR_DMA_DACK0_PCS3);
> > > + break;
> > > + case 5:
> > > + clrbits_8(&gpio->par_dspi, GPIO_PAR_DSPI_PCS5_PCS5);
> > > + setbits_8(&gpio->par_dspi, GPIO_PAR_DSPI_PCS5_PCS5);
> > > + break;
> > > + }
> > > #endif
> > > -#ifdef CONFIG_SYS_DSPI_CTAR6
> > > - dspi->ctar[6] = CONFIG_SYS_DSPI_CTAR6;
> > > +
> > > +#ifdef CONFIG_MCF5441x
> > > + switch (slave_plat->cs) {
> > > + case 0:
> > > + clrbits_8(&gpio->par_dspi0, ~GPIO_PAR_DSPI0_PCS0_MASK);
> > > + setbits_8(&gpio->par_dspi0, GPIO_PAR_DSPI0_PCS0_DSPI0PCS0);
> > > + break;
> > > + case 1:
> > > + clrbits_8(&gpio->par_dspiow, GPIO_PAR_DSPIOW_DSPI0PSC1);
> > > + setbits_8(&gpio->par_dspiow, GPIO_PAR_DSPIOW_DSPI0PSC1);
> > > + break;
> > > + }
> > > #endif
> > > -#ifdef CONFIG_SYS_DSPI_CTAR7
> > > - dspi->ctar[7] = CONFIG_SYS_DSPI_CTAR7;
> > > +
> > > +#ifdef CONFIG_MCF5227x
> > > + switch (slave_plat->cs) {
> > > + case 0:
> > > + clrbits_8(&gpio->par_dspi, GPIO_PAR_DSPI_PCS0_UNMASK);
> > > + setbits_8(&gpio->par_dspi, GPIO_PAR_DSPI_PCS0_PCS0);
> > > + break;
> > > + case 2:
> > > + clrbits_8(&gpio->par_timer, ~GPIO_PAR_TIMER_T2IN_UNMASK);
> > > + setbits_8(&gpio->par_timer, GPIO_PAR_TIMER_T2IN_DSPIPCS2);
> > > + break;
> > > + }
> > > #endif
> > > + return 0;
> > > }
> > >
> > > -static void cfspi_tx(u32 ctrl, u16 data)
> > > +static int coldfire_spi_release_bus(struct udevice *dev)
> > > {
> > > - volatile dspi_t *dspi = (dspi_t *) MMAP_DSPI;
> > > -
> > > - while ((dspi->sr & 0x0000F000) >= 4) ;
> > > -
> > > - dspi->tfr = (ctrl | data);
> > > -}
> > > + struct udevice *bus = dev->parent;
> > > + struct coldfire_spi_priv *cfspi = dev_get_priv(bus);
> > > + struct dspi *dspi = cfspi->regs;
> > > +#if defined(CONFIG_MCF5445x) || \
> > > + defined(CONFIG_MCF5441x) || defined(CONFIG_MCF5227x)
> > > + struct dm_spi_slave_platdata *slave_plat =
> > > + dev_get_parent_platdata(dev);
> > > + struct gpio *gpio = cfspi->gpio_regs;
> > > +#endif
> > >
> > > -static u16 cfspi_rx(void)
> > > -{
> > > - volatile dspi_t *dspi = (dspi_t *) MMAP_DSPI;
> > > + /* Clear FIFO */
> > > + clrbits_be32(&dspi->mcr, DSPI_MCR_CTXF | DSPI_MCR_CRXF);
> > > +
> > > +#ifdef CONFIG_MCF5445x
> > > + switch (slave_plat->cs) {
> > > + case 0:
> > > + clrbits_8(&gpio->par_dspi, GPIO_PAR_DSPI_PCS0_PCS0);
> > > + break;
> > > + case 1:
> > > + clrbits_8(&gpio->par_dspi, GPIO_PAR_DSPI_PCS1_PCS1);
> > > + break;
> > > + case 2:
> > > + clrbits_8(&gpio->par_dspi, GPIO_PAR_DSPI_PCS2_PCS2);
> > > + break;
> > > + case 3:
> > > + clrbits_8(&gpio->par_dma, ~GPIO_PAR_DMA_DACK0_UNMASK);
> > > + break;
> > > + case 5:
> > > + clrbits_8(&gpio->par_dspi, GPIO_PAR_DSPI_PCS5_PCS5);
> > > + break;
> > > + }
> > > +#endif
> > >
> > > - while ((dspi->sr & 0x000000F0) == 0) ;
> > > +#ifdef CONFIG_MCF5441x
> > > + if (slave_plat->cs == 1)
> > > + clrbits_8(&gpio->par_dspiow, GPIO_PAR_DSPIOW_DSPI0PSC1);
> > > +#endif
> > >
> > > - return (dspi->rfr & 0xFFFF);
> > > +#ifdef CONFIG_MCF5227x
> >
> > Like this macro, along with above CONFIG_MCF5445x
> >
> > Does it support separate compatible between these diff, if yes we can
> > handle these via driver data.
> >
> Ok, fixing this, nearly done, should be able to avoid
> all the config macroes probably.
>
> > > + switch (slave_plat->cs) {
> > > + case 0:
> > > + clrbits_8(&gpio->par_dspi, GPIO_PAR_DSPI_PCS0_PCS0);
> > > + break;
> > > + case 2:
> > > + clrbits_8(&gpio->par_timer, ~GPIO_PAR_TIMER_T2IN_UNMASK);
> > > + break;
> > > + }
> > > +#endif
> > > + return 0;
> > > }
> > >
> > > -static int cfspi_xfer(struct spi_slave *slave, uint bitlen, const void *dout,
> > > - void *din, ulong flags)
> > > +static int coldfire_spi_xfer(struct udevice *dev, unsigned int bitlen,
> > > + const void *dout, void *din,
> > > + unsigned long flags)
> > > {
> > > - struct cf_spi_slave *cfslave = to_cf_spi_slave(slave);
> > > + struct udevice *bus = dev_get_parent(dev);
> > > + struct coldfire_spi_priv *cfspi = dev_get_priv(bus);
> > > + struct dm_spi_slave_platdata *slave_plat = dev_get_parent_platdata(dev);
> > > u16 *spi_rd16 = NULL, *spi_wr16 = NULL;
> > > u8 *spi_rd = NULL, *spi_wr = NULL;
> > > - static u32 ctrl = 0;
> > > + static u32 ctrl;
> > > uint len = bitlen >> 3;
> > >
> > > - if (cfslave->charbit == 16) {
> > > + if (cfspi->charbit == 16) {
> > > bitlen >>= 1;
> > > - spi_wr16 = (u16 *) dout;
> > > - spi_rd16 = (u16 *) din;
> > > + spi_wr16 = (u16 *)dout;
> > > + spi_rd16 = (u16 *)din;
> > > } else {
> > > - spi_wr = (u8 *) dout;
> > > - spi_rd = (u8 *) din;
> > > + spi_wr = (u8 *)dout;
> > > + spi_rd = (u8 *)din;
> > > }
> > >
> > > if ((flags & SPI_XFER_BEGIN) == SPI_XFER_BEGIN)
> > > ctrl |= DSPI_TFR_CONT;
> > >
> > > - ctrl = (ctrl & 0xFF000000) | ((1 << slave->cs) << 16);
> > > + ctrl = setup_ctrl(ctrl, slave_plat->cs);
> > >
> > > if (len > 1) {
> > > int tmp_len = len - 1;
> > > +
> > > while (tmp_len--) {
> > > - if (dout != NULL) {
> > > - if (cfslave->charbit == 16)
> > > - cfspi_tx(ctrl, *spi_wr16++);
> > > + if (dout) {
> > > + if (cfspi->charbit == 16)
> > > + cfspi_tx(cfspi, ctrl, *spi_wr16++);
> > > else
> > > - cfspi_tx(ctrl, *spi_wr++);
> > > - cfspi_rx();
> > > + cfspi_tx(cfspi, ctrl, *spi_wr++);
> > > + cfspi_rx(cfspi);
> > > }
> > >
> > > - if (din != NULL) {
> > > - cfspi_tx(ctrl, CONFIG_SPI_IDLE_VAL);
> > > - if (cfslave->charbit == 16)
> > > - *spi_rd16++ = cfspi_rx();
> > > + if (din) {
> > > + cfspi_tx(cfspi, ctrl, CONFIG_SPI_IDLE_VAL);
> > > + if (cfspi->charbit == 16)
> > > + *spi_rd16++ = cfspi_rx(cfspi);
> > > else
> > > - *spi_rd++ = cfspi_rx();
> > > + *spi_rd++ = cfspi_rx(cfspi);
> > > }
> > > }
> > >
> > > len = 1; /* remaining byte */
> > > }
> > >
> > > - if ((flags & SPI_XFER_END) == SPI_XFER_END)
> > > + if (flags & SPI_XFER_END)
> > > ctrl &= ~DSPI_TFR_CONT;
> > >
> > > if (len) {
> > > - if (dout != NULL) {
> > > - if (cfslave->charbit == 16)
> > > - cfspi_tx(ctrl, *spi_wr16);
> > > + if (dout) {
> > > + if (cfspi->charbit == 16)
> > > + cfspi_tx(cfspi, ctrl, *spi_wr16);
> > > else
> > > - cfspi_tx(ctrl, *spi_wr);
> > > - cfspi_rx();
> > > + cfspi_tx(cfspi, ctrl, *spi_wr);
> > > + cfspi_rx(cfspi);
> > > }
> > >
> > > - if (din != NULL) {
> > > - cfspi_tx(ctrl, CONFIG_SPI_IDLE_VAL);
> > > - if (cfslave->charbit == 16)
> > > - *spi_rd16 = cfspi_rx();
> > > + if (din) {
> > > + cfspi_tx(cfspi, ctrl, CONFIG_SPI_IDLE_VAL);
> > > + if (cfspi->charbit == 16)
> > > + *spi_rd16 = cfspi_rx(cfspi);
> > > else
> > > - *spi_rd = cfspi_rx();
> > > + *spi_rd = cfspi_rx(cfspi);
> > > }
> > > } else {
> > > /* dummy read */
> > > - cfspi_tx(ctrl, CONFIG_SPI_IDLE_VAL);
> > > - cfspi_rx();
> > > + cfspi_tx(cfspi, ctrl, CONFIG_SPI_IDLE_VAL);
> > > + cfspi_rx(cfspi);
> > > }
> > >
> > > return 0;
> > > }
> > >
> > > -static struct spi_slave *cfspi_setup_slave(struct cf_spi_slave *cfslave,
> > > - uint mode)
> > > +static int coldfire_spi_set_speed(struct udevice *bus, uint max_hz)
> > > {
> > > + struct coldfire_spi_priv *cfspi = dev_get_priv(bus);
> > > + struct dspi *dspi = cfspi->regs;
> > > + int prescaler[] = { 2, 3, 5, 7 };
> > > + int scaler[] = {
> > > + 2, 4, 6, 8,
> > > + 16, 32, 64, 128,
> > > + 256, 512, 1024, 2048,
> > > + 4096, 8192, 16384, 32768
> > > + };
> > > + int i, j, pbrcnt, brcnt, diff, tmp, dbr = 0;
> > > + int best_i, best_j, bestmatch = 0x7FFFFFFF, baud_speed;
> >
> > bestmatch, replace with macro?
> >
>
> Ok, done.
>
> > > + u32 bus_setup;
> > > +
> > > + cfspi->baudrate = max_hz;
> > > +
> > > /*
> > > * bit definition for mode:
> > > * bit 31 - 28: Transfer size 3 to 16 bits
> > > @@ -189,66 +315,37 @@ static struct spi_slave *cfspi_setup_slave(struct cf_spi_slave *cfslave,
> > > * 11 - 8: Delay after transfer scaler
> > > * 7 - 0: SPI_CPHA, SPI_CPOL, SPI_LSB_FIRST
> > > */
> > > - volatile dspi_t *dspi = (dspi_t *) MMAP_DSPI;
> > > - int prescaler[] = { 2, 3, 5, 7 };
> > > - int scaler[] = {
> > > - 2, 4, 6, 8,
> > > - 16, 32, 64, 128,
> > > - 256, 512, 1024, 2048,
> > > - 4096, 8192, 16384, 32768
> > > - };
> > > - int i, j, pbrcnt, brcnt, diff, tmp, dbr = 0;
> > > - int best_i, best_j, bestmatch = 0x7FFFFFFF, baud_speed;
> > > - u32 bus_setup = 0;
> > > +
> > > + /* Read current setup */
> > > + bus_setup = readl(&dspi->ctar[bus->seq]);
> > >
> > > tmp = (prescaler[3] * scaler[15]);
> > > /* Maximum and minimum baudrate it can handle */
> > > - if ((cfslave->baudrate > (gd->bus_clk >> 1)) ||
> > > - (cfslave->baudrate < (gd->bus_clk / tmp))) {
> > > + if ((cfspi->baudrate > (gd->bus_clk >> 1)) ||
> > > + (cfspi->baudrate < (gd->bus_clk / tmp))) {
> > > printf("Exceed baudrate limitation: Max %d - Min %d\n",
> > > (int)(gd->bus_clk >> 1), (int)(gd->bus_clk / tmp));
> > > - return NULL;
> > > + return -1;
> > > }
> > >
> > > /* Activate Double Baud when it exceed 1/4 the bus clk */
> > > - if ((CONFIG_SYS_DSPI_CTAR0 & DSPI_CTAR_DBR) ||
> > > - (cfslave->baudrate > (gd->bus_clk / (prescaler[0] * scaler[0])))) {
> > > + if ((bus_setup & DSPI_CTAR_DBR) ||
> > > + (cfspi->baudrate > (gd->bus_clk / (prescaler[0] * scaler[0])))) {
> > > bus_setup |= DSPI_CTAR_DBR;
> > > dbr = 1;
> > > }
> > >
> > > - if (mode & SPI_CPOL)
> > > - bus_setup |= DSPI_CTAR_CPOL;
> > > - if (mode & SPI_CPHA)
> > > - bus_setup |= DSPI_CTAR_CPHA;
> > > - if (mode & SPI_LSB_FIRST)
> > > - bus_setup |= DSPI_CTAR_LSBFE;
> > > -
> > > /* Overwrite default value set in platform configuration file */
> > > - if (mode & SPI_MODE_MOD) {
> > > -
> > > - if ((mode & 0xF0000000) == 0)
> > > - bus_setup |=
> > > - dspi->ctar[cfslave->slave.bus] & 0x78000000;
> > > - else
> > > - bus_setup |= ((mode & 0xF0000000) >> 1);
> > > -
> > > + if (cfspi->mode & SPI_MODE_MOD) {
> > > /*
> > > * Check to see if it is enabled by default in platform
> > > * config, or manual setting passed by mode parameter
> > > */
> > > - if (mode & SPI_DBLRATE) {
> > > + if (cfspi->mode & SPI_DBLRATE) {
> > > bus_setup |= DSPI_CTAR_DBR;
> > > dbr = 1;
> > > }
> > > - bus_setup |= (mode & 0x0FC00000) >> 4; /* PSCSCK, PASC, PDT */
> > > - bus_setup |= (mode & 0x000FFF00) >> 4; /* CSSCK, ASC, DT */
> > > - } else
> > > - bus_setup |= (dspi->ctar[cfslave->slave.bus] & 0x78FCFFF0);
> > > -
> > > - cfslave->charbit =
> > > - ((dspi->ctar[cfslave->slave.bus] & 0x78000000) ==
> > > - 0x78000000) ? 16 : 8;
> > > + }
> > >
> > > pbrcnt = sizeof(prescaler) / sizeof(int);
> > > brcnt = sizeof(scaler) / sizeof(int);
> > > @@ -259,10 +356,10 @@ static struct spi_slave *cfspi_setup_slave(struct cf_spi_slave *cfslave,
> > > for (j = 0; j < brcnt; j++) {
> > > tmp = (baud_speed / scaler[j]) * (1 + dbr);
> > >
> > > - if (tmp > cfslave->baudrate)
> > > - diff = tmp - cfslave->baudrate;
> > > + if (tmp > cfspi->baudrate)
> > > + diff = tmp - cfspi->baudrate;
> > > else
> > > - diff = cfslave->baudrate - tmp;
> > > + diff = cfspi->baudrate - tmp;
> > >
> > > if (diff < bestmatch) {
> > > bestmatch = diff;
> > > @@ -271,65 +368,173 @@ static struct spi_slave *cfspi_setup_slave(struct cf_spi_slave *cfslave,
> > > }
> > > }
> > > }
> > > +
> > > + bus_setup &= ~(DSPI_CTAR_PBR(0x03) | DSPI_CTAR_BR(0x0f));
> > > bus_setup |= (DSPI_CTAR_PBR(best_i) | DSPI_CTAR_BR(best_j));
> > > - dspi->ctar[cfslave->slave.bus] = bus_setup;
> > > + writel(bus_setup, &dspi->ctar[bus->seq]);
> > >
> > > - return &cfslave->slave;
> > > + return 0;
> > > }
> > > -#endif /* CONFIG_CF_DSPI */
> > >
> > > -#ifdef CONFIG_CMD_SPI
> > > -int spi_cs_is_valid(unsigned int bus, unsigned int cs)
> > > +static int coldfire_spi_set_mode(struct udevice *bus, uint mode)
> > > {
> > > - if (((cs >= 0) && (cs < 8)) && ((bus >= 0) && (bus < 8)))
> > > - return 1;
> > > - else
> > > - return 0;
> > > -}
> > > + struct coldfire_spi_priv *cfspi = dev_get_priv(bus);
> > > + struct dspi *dspi = cfspi->regs;
> > > + u32 bus_setup = 0;
> > >
> > > -void spi_init(void)
> > > -{
> > > - cfspi_init();
> > > -}
> > > + cfspi->mode = mode;
> > >
> > > -struct spi_slave *spi_setup_slave(unsigned int bus, unsigned int cs,
> > > - unsigned int max_hz, unsigned int mode)
> > > -{
> > > - struct cf_spi_slave *cfslave;
> > > + if (cfspi->mode & SPI_CPOL)
> > > + bus_setup |= DSPI_CTAR_CPOL;
> > > + if (cfspi->mode & SPI_CPHA)
> > > + bus_setup |= DSPI_CTAR_CPHA;
> > > + if (cfspi->mode & SPI_LSB_FIRST)
> > > + bus_setup |= DSPI_CTAR_LSBFE;
> > > +
> > > + /* Overwrite default value set in platform configuration file */
> > > + if (cfspi->mode & SPI_MODE_MOD) {
> > > + if ((cfspi->mode & 0xF0000000) == 0)
> > > + bus_setup |=
> > > + readl(&dspi->ctar[bus->seq]) & 0x78000000;
> > > + else
> > > + bus_setup |= ((cfspi->mode & 0xF0000000) >> 1);
> > >
> > > - if (!spi_cs_is_valid(bus, cs))
> > > - return NULL;
> > > + /* PSCSCK, PASC, PDT */
> > > + bus_setup |= (cfspi->mode & 0x0FC00000) >> 4;
> > > + /* CSSCK, ASC, DT */
> > > + bus_setup |= (cfspi->mode & 0x000FFF00) >> 4;
> > > + } else {
> > > + bus_setup |= (readl(&dspi->ctar[bus->seq]) & 0x78FCFFF0);
> > > + }
> > >
> > > - cfslave = spi_alloc_slave(struct cf_spi_slave, bus, cs);
> > > - if (!cfslave)
> > > - return NULL;
> > > + cfspi->charbit =
> > > + ((readl(&dspi->ctar[bus->seq]) & 0x78000000) ==
> > > + 0x78000000) ? 16 : 8;
> >
> > Same here?
> >
>
> Ok, done.
>
> > >
> > > - cfslave->baudrate = max_hz;
> > > + setbits_be32(&dspi->ctar[bus->seq], bus_setup);
> > >
> > > - /* specific setup */
> > > - return cfspi_setup_slave(cfslave, mode);
> > > + return 0;
> > > }
> > >
> > > -void spi_free_slave(struct spi_slave *slave)
> > > +static int coldfire_spi_probe(struct udevice *bus)
> > > {
> > > - struct cf_spi_slave *cfslave = to_cf_spi_slave(slave);
> > > + struct coldfire_spi_platdata *plat = dev_get_platdata(bus);
> > > + struct coldfire_spi_priv *cfspi = dev_get_priv(bus);
> > > + struct dspi *dspi = cfspi->regs;
> > > + int i;
> > >
> > > - free(cfslave);
> > > -}
> > > + cfspi->regs = (struct dspi *)plat->regs_addr;
> > > + cfspi->gpio_regs = (struct gpio *)MMAP_GPIO;
> > >
> > > -int spi_claim_bus(struct spi_slave *slave)
> > > -{
> > > - return cfspi_claim_bus(slave->bus, slave->cs);
> > > + cfspi->baudrate = plat->speed_hz;
> > > + cfspi->mode = plat->mode;
> > > +
> > > + for (i = 0; i < MCF_DSPI_MAX_CTAR_REGS; i++) {
> > > + unsigned int ctar = 0;
> > > +
> > > + if (plat->ctar[i][0] == 0)
> > > + break;
> > > +
> > > + ctar = DSPI_CTAR_TRSZ(plat->ctar[i][0]) |
> > > + DSPI_CTAR_PCSSCK(plat->ctar[i][1]) |
> > > + DSPI_CTAR_PASC(plat->ctar[i][2]) |
> > > + DSPI_CTAR_PDT(plat->ctar[i][3]) |
> > > + DSPI_CTAR_CSSCK(plat->ctar[i][4]) |
> > > + DSPI_CTAR_ASC(plat->ctar[i][5]) |
> > > + DSPI_CTAR_DT(plat->ctar[i][6]) |
> > > + DSPI_CTAR_BR(plat->ctar[i][7]);
> > > +
> > > + writel(ctar, &cfspi->regs->ctar[i]);
> > > + }
> > > +
> > > + /* Default CTARs */
> > > + for (i = 0; i < MCF_DSPI_MAX_CTAR_REGS; i++)
> > > + writel(MCF_DSPI_DEFAULT_CTAR, &dspi->ctar[i]);
> > > +
> > > + dspi->mcr = DSPI_MCR_MSTR | DSPI_MCR_CSIS7 | DSPI_MCR_CSIS6 |
> > > + DSPI_MCR_CSIS5 | DSPI_MCR_CSIS4 | DSPI_MCR_CSIS3 |
> > > + DSPI_MCR_CSIS2 | DSPI_MCR_CSIS1 | DSPI_MCR_CSIS0 |
> > > + DSPI_MCR_CRXF | DSPI_MCR_CTXF;
> > > +
> > > + return 0;
> > > }
> > >
> > > -void spi_release_bus(struct spi_slave *slave)
> > > +void spi_init(void)
> > > {
> > > - cfspi_release_bus(slave->bus, slave->cs);
> > > }
> > >
> > > -int spi_xfer(struct spi_slave *slave, unsigned int bitlen, const void *dout,
> > > - void *din, unsigned long flags)
> > > +#if CONFIG_IS_ENABLED(OF_CONTROL) && !CONFIG_IS_ENABLED(OF_PLATDATA)
> > > +static int coldfire_dspi_ofdata_to_platdata(struct udevice *bus)
> > > {
> > > - return cfspi_xfer(slave, bitlen, dout, din, flags);
> > > + fdt_addr_t addr;
> > > + struct coldfire_spi_platdata *plat = bus->platdata;
> > > + const void *blob = gd->fdt_blob;
> > > + int node = dev_of_offset(bus);
> > > + int *ctar, len;
> > > +
> > > + addr = devfdt_get_addr(bus);
> > > + if (addr == FDT_ADDR_T_NONE)
> > > + return -ENOMEM;
> > > +
> > > + plat->regs_addr = addr;
> > > +
> > > + plat->num_cs = fdtdec_get_int(blob, node, "num-cs",
> > > + MCF_DSPI_DEFAULT_MAX_CS);
> > > +
> > > + plat->speed_hz = fdtdec_get_int(blob, node, "spi-max-frequency",
> > > + MCF_DSPI_DEFAULT_SCK_FREQ);
> > > +
> > > + plat->mode = fdtdec_get_int(blob, node, "spi-mode",
> > > + MCF_DSPI_DEFAULT_MODE);
> > > +
> > > + memset(plat->ctar, 0, sizeof(plat->ctar));
> > > +
> > > + ctar = (int *)fdt_getprop(blob, node, "ctar-params", &len);
> > > +
> > > + if (ctar && len) {
> > > + int i, q, ctar_regs;
> > > +
> > > + ctar_regs = len / sizeof(unsigned int) / MAX_CTAR_FIELDS;
> > > +
> > > + if (ctar_regs > MAX_CTAR_REGS)
> > > + ctar_regs = MAX_CTAR_REGS;
> > > +
> > > + for (i = 0; i < ctar_regs; i++) {
> > > + for (q = 0; q < MAX_CTAR_FIELDS; q++)
> > > + plat->ctar[i][q] = *ctar++;
> > > + }
> > > + }
> > > +
> > > + debug("DSPI: regs=%pa, max-frequency=%d, num-cs=%d, mode=%d\n",
> > > + (void *)plat->regs_addr,
> > > + plat->speed_hz, plat->num_cs, plat->mode);
> > > +
> > > + return 0;
> > > }
> > > -#endif /* CONFIG_CMD_SPI */
> > > +
> > > +static const struct udevice_id coldfire_spi_ids[] = {
> > > + { .compatible = "fsl,mcf-dspi" },
> > > + { }
> > > +};
> > > +#endif
> > > +
> > > +static const struct dm_spi_ops coldfire_spi_ops = {
> > > + .claim_bus = coldfire_spi_claim_bus,
> > > + .release_bus = coldfire_spi_release_bus,
> > > + .xfer = coldfire_spi_xfer,
> > > + .set_speed = coldfire_spi_set_speed,
> > > + .set_mode = coldfire_spi_set_mode,
> > > +};
> > > +
> > > +U_BOOT_DRIVER(coldfire_spi) = {
> > > + .name = "spi_coldfire",
> > > + .id = UCLASS_SPI,
> > > + .probe = coldfire_spi_probe,
> > > + .ops = &coldfire_spi_ops,
> > > + .platdata_auto_alloc_size = sizeof(struct coldfire_spi_platdata),
> > > + .priv_auto_alloc_size = sizeof(struct coldfire_spi_priv),
> > > +#if !CONFIG_IS_ENABLED(OF_PLATDATA)
> > > + .of_match = coldfire_spi_ids,
> > > + .ofdata_to_platdata = coldfire_dspi_ofdata_to_platdata,
> > > +#endif
> > > +};
> >
> > This has to be as below
> >
> > U_BOOT_DRIVER(coldfire_spi) = {
> > .name = "spi_coldfire",
> > .id = UCLASS_SPI,
> > #if CONFIG_IS_ENABLED(OF_CONTROL) && !CONFIG_IS_ENABLED(OF_PLATDATA)
> > .of_match = coldfire_spi_ids,
> > .ofdata_to_platdata = coldfire_dspi_ofdata_to_platdata,
> > .platdata_auto_alloc_size = sizeof(struct coldfire_spi_platdata),
> > #endif
> > .probe = coldfire_spi_probe,
> > .ops = &coldfire_spi_ops,
> > .priv_auto_alloc_size = sizeof(struct coldfire_spi_priv),
> > };
>
> Ok, done.
>
> If there are no other points from you, will provide a new version in
> short.
Just send next version, meanwhile I will look for wait_for_bit will
combine while applying.
More information about the U-Boot
mailing list