From mboxrd@z Thu Jan 1 00:00:00 1970 From: Angelo Dureghello Date: Sun, 10 Mar 2019 17:17:54 +0100 Subject: [U-Boot] [PATCH v4 07/12] drivers: spi: cf_spi: convert to driver model In-Reply-To: References: <20181216112300.9367-1-angelo@sysam.it> <20181216112300.9367-7-angelo@sysam.it> Message-ID: <20190310161753.GA10593@jerusalem> List-Id: MIME-Version: 1.0 Content-Type: text/plain; charset="us-ascii" Content-Transfer-Encoding: 7bit To: u-boot@lists.denx.de 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 wrote: > > > > Converting to driver model and removes non-dm code. > > > > Reviewed-by: Simon Glass > > Signed-off-by: Angelo Dureghello > > --- > > 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 > > + * > > + * TODO: fsl_dspi.c should work as a driver for the DSPI module. > > */ > > > > #include > > +#include > > +#include > > #include > > #include > > +#include > > +#include > > #include > > +#include > > > > -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. Regards, Angelo