| /* | |
| * (C) Copyright 2000-2003 | |
| * Wolfgang Denk, DENX Software Engineering, wd@denx.de. | |
| * | |
| * Copyright (C) 2004-2009, 2015 Freescale Semiconductor, Inc. | |
| * TsiChung Liew (Tsi-Chung.Liew@freescale.com) | |
| * Chao Fu (B44548@freescale.com) | |
| * Haikun Wang (B53464@freescale.com) | |
| * | |
| * SPDX-License-Identifier: GPL-2.0+ | |
| */ | |
| #include <dm.h> | |
| #include <errno.h> | |
| #include <common.h> | |
| #include <spi.h> | |
| #include <malloc.h> | |
| #include <asm/io.h> | |
| #include <fdtdec.h> | |
| #ifndef CONFIG_M68K | |
| #include <asm/arch/clock.h> | |
| #endif | |
| #include <fsl_dspi.h> | |
| DECLARE_GLOBAL_DATA_PTR; | |
| /* fsl_dspi_platdata flags */ | |
| #define DSPI_FLAG_REGMAP_ENDIAN_BIG BIT(0) | |
| /* idle data value */ | |
| #define DSPI_IDLE_VAL 0x0 | |
| /* max chipselect signals number */ | |
| #define FSL_DSPI_MAX_CHIPSELECT 6 | |
| /* default SCK frequency, unit: HZ */ | |
| #define FSL_DSPI_DEFAULT_SCK_FREQ 10000000 | |
| /* tx/rx data wait timeout value, unit: us */ | |
| #define DSPI_TXRX_WAIT_TIMEOUT 1000000 | |
| /* CTAR register pre-configure value */ | |
| #define DSPI_CTAR_DEFAULT_VALUE (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(0)) | |
| /* CTAR register pre-configure mask */ | |
| #define DSPI_CTAR_SET_MODE_MASK (DSPI_CTAR_TRSZ(15) | \ | |
| DSPI_CTAR_PCSSCK(3) | \ | |
| DSPI_CTAR_PASC(3) | \ | |
| DSPI_CTAR_PDT(3) | \ | |
| DSPI_CTAR_CSSCK(15) | \ | |
| DSPI_CTAR_ASC(15) | \ | |
| DSPI_CTAR_DT(15)) | |
| /** | |
| * struct fsl_dspi_platdata - platform data for Freescale DSPI | |
| * | |
| * @flags: Flags for DSPI DSPI_FLAG_... | |
| * @speed_hz: Default SCK frequency | |
| * @num_chipselect: Number of DSPI chipselect signals | |
| * @regs_addr: Base address of DSPI registers | |
| */ | |
| struct fsl_dspi_platdata { | |
| uint flags; | |
| uint speed_hz; | |
| uint num_chipselect; | |
| fdt_addr_t regs_addr; | |
| }; | |
| /** | |
| * struct fsl_dspi_priv - private data for Freescale DSPI | |
| * | |
| * @flags: Flags for DSPI DSPI_FLAG_... | |
| * @mode: SPI mode to use for slave device (see SPI mode flags) | |
| * @mcr_val: MCR register configure value | |
| * @bus_clk: DSPI input clk frequency | |
| * @speed_hz: Default SCK frequency | |
| * @charbit: How many bits in every transfer | |
| * @num_chipselect: Number of DSPI chipselect signals | |
| * @ctar_val: CTAR register configure value of per chipselect slave device | |
| * @regs: Point to DSPI register structure for I/O access | |
| */ | |
| struct fsl_dspi_priv { | |
| uint flags; | |
| uint mode; | |
| uint mcr_val; | |
| uint bus_clk; | |
| uint speed_hz; | |
| uint charbit; | |
| uint num_chipselect; | |
| uint ctar_val[FSL_DSPI_MAX_CHIPSELECT]; | |
| struct dspi *regs; | |
| }; | |
| #ifndef CONFIG_DM_SPI | |
| struct fsl_dspi { | |
| struct spi_slave slave; | |
| struct fsl_dspi_priv priv; | |
| }; | |
| #endif | |
| __weak void cpu_dspi_port_conf(void) | |
| { | |
| } | |
| __weak int cpu_dspi_claim_bus(uint bus, uint cs) | |
| { | |
| return 0; | |
| } | |
| __weak void cpu_dspi_release_bus(uint bus, uint cs) | |
| { | |
| } | |
| static uint dspi_read32(uint flags, uint *addr) | |
| { | |
| return flags & DSPI_FLAG_REGMAP_ENDIAN_BIG ? | |
| in_be32(addr) : in_le32(addr); | |
| } | |
| static void dspi_write32(uint flags, uint *addr, uint val) | |
| { | |
| flags & DSPI_FLAG_REGMAP_ENDIAN_BIG ? | |
| out_be32(addr, val) : out_le32(addr, val); | |
| } | |
| static void dspi_halt(struct fsl_dspi_priv *priv, u8 halt) | |
| { | |
| uint mcr_val; | |
| mcr_val = dspi_read32(priv->flags, &priv->regs->mcr); | |
| if (halt) | |
| mcr_val |= DSPI_MCR_HALT; | |
| else | |
| mcr_val &= ~DSPI_MCR_HALT; | |
| dspi_write32(priv->flags, &priv->regs->mcr, mcr_val); | |
| } | |
| static void fsl_dspi_init_mcr(struct fsl_dspi_priv *priv, uint cfg_val) | |
| { | |
| /* halt DSPI module */ | |
| dspi_halt(priv, 1); | |
| dspi_write32(priv->flags, &priv->regs->mcr, cfg_val); | |
| /* resume module */ | |
| dspi_halt(priv, 0); | |
| priv->mcr_val = cfg_val; | |
| } | |
| static void fsl_dspi_cfg_cs_active_state(struct fsl_dspi_priv *priv, | |
| uint cs, uint state) | |
| { | |
| uint mcr_val; | |
| dspi_halt(priv, 1); | |
| mcr_val = dspi_read32(priv->flags, &priv->regs->mcr); | |
| if (state & SPI_CS_HIGH) | |
| /* CSx inactive state is low */ | |
| mcr_val &= ~DSPI_MCR_PCSIS(cs); | |
| else | |
| /* CSx inactive state is high */ | |
| mcr_val |= DSPI_MCR_PCSIS(cs); | |
| dspi_write32(priv->flags, &priv->regs->mcr, mcr_val); | |
| dspi_halt(priv, 0); | |
| } | |
| static int fsl_dspi_cfg_ctar_mode(struct fsl_dspi_priv *priv, | |
| uint cs, uint mode) | |
| { | |
| uint bus_setup; | |
| bus_setup = dspi_read32(priv->flags, &priv->regs->ctar[0]); | |
| bus_setup &= ~DSPI_CTAR_SET_MODE_MASK; | |
| bus_setup |= priv->ctar_val[cs]; | |
| bus_setup &= ~(DSPI_CTAR_CPOL | DSPI_CTAR_CPHA | DSPI_CTAR_LSBFE); | |
| 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; | |
| dspi_write32(priv->flags, &priv->regs->ctar[0], bus_setup); | |
| priv->charbit = | |
| ((dspi_read32(priv->flags, &priv->regs->ctar[0]) & | |
| DSPI_CTAR_TRSZ(15)) == DSPI_CTAR_TRSZ(15)) ? 16 : 8; | |
| return 0; | |
| } | |
| static void fsl_dspi_clr_fifo(struct fsl_dspi_priv *priv) | |
| { | |
| uint mcr_val; | |
| dspi_halt(priv, 1); | |
| mcr_val = dspi_read32(priv->flags, &priv->regs->mcr); | |
| /* flush RX and TX FIFO */ | |
| mcr_val |= (DSPI_MCR_CTXF | DSPI_MCR_CRXF); | |
| dspi_write32(priv->flags, &priv->regs->mcr, mcr_val); | |
| dspi_halt(priv, 0); | |
| } | |
| static void dspi_tx(struct fsl_dspi_priv *priv, u32 ctrl, u16 data) | |
| { | |
| int timeout = DSPI_TXRX_WAIT_TIMEOUT; | |
| /* wait for empty entries in TXFIFO or timeout */ | |
| while (DSPI_SR_TXCTR(dspi_read32(priv->flags, &priv->regs->sr)) >= 4 && | |
| timeout--) | |
| udelay(1); | |
| if (timeout >= 0) | |
| dspi_write32(priv->flags, &priv->regs->tfr, (ctrl | data)); | |
| else | |
| debug("dspi_tx: waiting timeout!\n"); | |
| } | |
| static u16 dspi_rx(struct fsl_dspi_priv *priv) | |
| { | |
| int timeout = DSPI_TXRX_WAIT_TIMEOUT; | |
| /* wait for valid entries in RXFIFO or timeout */ | |
| while (DSPI_SR_RXCTR(dspi_read32(priv->flags, &priv->regs->sr)) == 0 && | |
| timeout--) | |
| udelay(1); | |
| if (timeout >= 0) | |
| return (u16)DSPI_RFR_RXDATA( | |
| dspi_read32(priv->flags, &priv->regs->rfr)); | |
| else { | |
| debug("dspi_rx: waiting timeout!\n"); | |
| return (u16)(~0); | |
| } | |
| } | |
| static int dspi_xfer(struct fsl_dspi_priv *priv, uint cs, unsigned int bitlen, | |
| const void *dout, void *din, unsigned long flags) | |
| { | |
| u16 *spi_rd16 = NULL, *spi_wr16 = NULL; | |
| u8 *spi_rd = NULL, *spi_wr = NULL; | |
| static u32 ctrl; | |
| uint len = bitlen >> 3; | |
| if (priv->charbit == 16) { | |
| bitlen >>= 1; | |
| spi_wr16 = (u16 *)dout; | |
| spi_rd16 = (u16 *)din; | |
| } else { | |
| spi_wr = (u8 *)dout; | |
| spi_rd = (u8 *)din; | |
| } | |
| if ((flags & SPI_XFER_BEGIN) == SPI_XFER_BEGIN) | |
| ctrl |= DSPI_TFR_CONT; | |
| ctrl = ctrl & DSPI_TFR_CONT; | |
| ctrl = ctrl | DSPI_TFR_CTAS(0) | DSPI_TFR_PCS(cs); | |
| if (len > 1) { | |
| int tmp_len = len - 1; | |
| while (tmp_len--) { | |
| if (dout != NULL) { | |
| if (priv->charbit == 16) | |
| dspi_tx(priv, ctrl, *spi_wr16++); | |
| else | |
| dspi_tx(priv, ctrl, *spi_wr++); | |
| dspi_rx(priv); | |
| } | |
| if (din != NULL) { | |
| dspi_tx(priv, ctrl, DSPI_IDLE_VAL); | |
| if (priv->charbit == 16) | |
| *spi_rd16++ = dspi_rx(priv); | |
| else | |
| *spi_rd++ = dspi_rx(priv); | |
| } | |
| } | |
| len = 1; /* remaining byte */ | |
| } | |
| if ((flags & SPI_XFER_END) == SPI_XFER_END) | |
| ctrl &= ~DSPI_TFR_CONT; | |
| if (len) { | |
| if (dout != NULL) { | |
| if (priv->charbit == 16) | |
| dspi_tx(priv, ctrl, *spi_wr16); | |
| else | |
| dspi_tx(priv, ctrl, *spi_wr); | |
| dspi_rx(priv); | |
| } | |
| if (din != NULL) { | |
| dspi_tx(priv, ctrl, DSPI_IDLE_VAL); | |
| if (priv->charbit == 16) | |
| *spi_rd16 = dspi_rx(priv); | |
| else | |
| *spi_rd = dspi_rx(priv); | |
| } | |
| } else { | |
| /* dummy read */ | |
| dspi_tx(priv, ctrl, DSPI_IDLE_VAL); | |
| dspi_rx(priv); | |
| } | |
| return 0; | |
| } | |
| /** | |
| * Calculate the divide value between input clk frequency and expected SCK frequency | |
| * Formula: SCK = (clkrate/pbr) x ((1+dbr)/br) | |
| * Dbr: use default value 0 | |
| * | |
| * @pbr: return Baud Rate Prescaler value | |
| * @br: return Baud Rate Scaler value | |
| * @speed_hz: expected SCK frequency | |
| * @clkrate: input clk frequency | |
| */ | |
| static int fsl_dspi_hz_to_spi_baud(int *pbr, int *br, | |
| int speed_hz, uint clkrate) | |
| { | |
| /* Valid baud rate pre-scaler values */ | |
| int pbr_tbl[4] = {2, 3, 5, 7}; | |
| int brs[16] = {2, 4, 6, 8, | |
| 16, 32, 64, 128, | |
| 256, 512, 1024, 2048, | |
| 4096, 8192, 16384, 32768}; | |
| int temp, i = 0, j = 0; | |
| temp = clkrate / speed_hz; | |
| for (i = 0; i < ARRAY_SIZE(pbr_tbl); i++) | |
| for (j = 0; j < ARRAY_SIZE(brs); j++) { | |
| if (pbr_tbl[i] * brs[j] >= temp) { | |
| *pbr = i; | |
| *br = j; | |
| return 0; | |
| } | |
| } | |
| debug("Can not find valid baud rate,speed_hz is %d, ", speed_hz); | |
| debug("clkrate is %d, we use the max prescaler value.\n", clkrate); | |
| *pbr = ARRAY_SIZE(pbr_tbl) - 1; | |
| *br = ARRAY_SIZE(brs) - 1; | |
| return -EINVAL; | |
| } | |
| static int fsl_dspi_cfg_speed(struct fsl_dspi_priv *priv, uint speed) | |
| { | |
| int ret; | |
| uint bus_setup; | |
| int best_i, best_j, bus_clk; | |
| bus_clk = priv->bus_clk; | |
| debug("DSPI set_speed: expected SCK speed %u, bus_clk %u.\n", | |
| speed, bus_clk); | |
| bus_setup = dspi_read32(priv->flags, &priv->regs->ctar[0]); | |
| bus_setup &= ~(DSPI_CTAR_DBR | DSPI_CTAR_PBR(0x3) | DSPI_CTAR_BR(0xf)); | |
| ret = fsl_dspi_hz_to_spi_baud(&best_i, &best_j, speed, bus_clk); | |
| if (ret) { | |
| speed = priv->speed_hz; | |
| debug("DSPI set_speed use default SCK rate %u.\n", speed); | |
| fsl_dspi_hz_to_spi_baud(&best_i, &best_j, speed, bus_clk); | |
| } | |
| bus_setup |= (DSPI_CTAR_PBR(best_i) | DSPI_CTAR_BR(best_j)); | |
| dspi_write32(priv->flags, &priv->regs->ctar[0], bus_setup); | |
| priv->speed_hz = speed; | |
| return 0; | |
| } | |
| #ifndef CONFIG_DM_SPI | |
| void spi_init(void) | |
| { | |
| /* Nothing to do */ | |
| } | |
| void spi_init_f(void) | |
| { | |
| /* Nothing to do */ | |
| } | |
| void spi_init_r(void) | |
| { | |
| /* Nothing to do */ | |
| } | |
| int spi_cs_is_valid(unsigned int bus, unsigned int cs) | |
| { | |
| if (((cs >= 0) && (cs < 8)) && ((bus >= 0) && (bus < 8))) | |
| return 1; | |
| else | |
| return 0; | |
| } | |
| struct spi_slave *spi_setup_slave(unsigned int bus, unsigned int cs, | |
| unsigned int max_hz, unsigned int mode) | |
| { | |
| struct fsl_dspi *dspi; | |
| uint mcr_cfg_val; | |
| dspi = spi_alloc_slave(struct fsl_dspi, bus, cs); | |
| if (!dspi) | |
| return NULL; | |
| cpu_dspi_port_conf(); | |
| #ifdef CONFIG_SYS_FSL_DSPI_BE | |
| dspi->priv.flags |= DSPI_FLAG_REGMAP_ENDIAN_BIG; | |
| #endif | |
| dspi->priv.regs = (struct dspi *)MMAP_DSPI; | |
| #ifdef CONFIG_M68K | |
| dspi->priv.bus_clk = gd->bus_clk; | |
| #else | |
| dspi->priv.bus_clk = mxc_get_clock(MXC_DSPI_CLK); | |
| #endif | |
| dspi->priv.speed_hz = FSL_DSPI_DEFAULT_SCK_FREQ; | |
| /* default: all CS signals inactive state is high */ | |
| mcr_cfg_val = DSPI_MCR_MSTR | DSPI_MCR_PCSIS_MASK | | |
| DSPI_MCR_CRXF | DSPI_MCR_CTXF; | |
| fsl_dspi_init_mcr(&dspi->priv, mcr_cfg_val); | |
| for (i = 0; i < FSL_DSPI_MAX_CHIPSELECT; i++) | |
| dspi->priv.ctar_val[i] = DSPI_CTAR_DEFAULT_VALUE; | |
| #ifdef CONFIG_SYS_DSPI_CTAR0 | |
| if (FSL_DSPI_MAX_CHIPSELECT > 0) | |
| dspi->priv.ctar_val[0] = CONFIG_SYS_DSPI_CTAR0; | |
| #endif | |
| #ifdef CONFIG_SYS_DSPI_CTAR1 | |
| if (FSL_DSPI_MAX_CHIPSELECT > 1) | |
| dspi->priv.ctar_val[1] = CONFIG_SYS_DSPI_CTAR1; | |
| #endif | |
| #ifdef CONFIG_SYS_DSPI_CTAR2 | |
| if (FSL_DSPI_MAX_CHIPSELECT > 2) | |
| dspi->priv.ctar_val[2] = CONFIG_SYS_DSPI_CTAR2; | |
| #endif | |
| #ifdef CONFIG_SYS_DSPI_CTAR3 | |
| if (FSL_DSPI_MAX_CHIPSELECT > 3) | |
| dspi->priv.ctar_val[3] = CONFIG_SYS_DSPI_CTAR3; | |
| #endif | |
| #ifdef CONFIG_SYS_DSPI_CTAR4 | |
| if (FSL_DSPI_MAX_CHIPSELECT > 4) | |
| dspi->priv.ctar_val[4] = CONFIG_SYS_DSPI_CTAR4; | |
| #endif | |
| #ifdef CONFIG_SYS_DSPI_CTAR5 | |
| if (FSL_DSPI_MAX_CHIPSELECT > 5) | |
| dspi->priv.ctar_val[5] = CONFIG_SYS_DSPI_CTAR5; | |
| #endif | |
| #ifdef CONFIG_SYS_DSPI_CTAR6 | |
| if (FSL_DSPI_MAX_CHIPSELECT > 6) | |
| dspi->priv.ctar_val[6] = CONFIG_SYS_DSPI_CTAR6; | |
| #endif | |
| #ifdef CONFIG_SYS_DSPI_CTAR7 | |
| if (FSL_DSPI_MAX_CHIPSELECT > 7) | |
| dspi->priv.ctar_val[7] = CONFIG_SYS_DSPI_CTAR7; | |
| #endif | |
| fsl_dspi_cfg_speed(&dspi->priv, max_hz); | |
| /* configure transfer mode */ | |
| fsl_dspi_cfg_ctar_mode(&dspi->priv, cs, mode); | |
| /* configure active state of CSX */ | |
| fsl_dspi_cfg_cs_active_state(&dspi->priv, cs, mode); | |
| return &dspi->slave; | |
| } | |
| void spi_free_slave(struct spi_slave *slave) | |
| { | |
| free(slave); | |
| } | |
| int spi_claim_bus(struct spi_slave *slave) | |
| { | |
| uint sr_val; | |
| struct fsl_dspi *dspi = (struct fsl_dspi *)slave; | |
| cpu_dspi_claim_bus(slave->bus, slave->cs); | |
| fsl_dspi_clr_fifo(&dspi->priv); | |
| /* check module TX and RX status */ | |
| sr_val = dspi_read32(dspi->priv.flags, &dspi->priv.regs->sr); | |
| if ((sr_val & DSPI_SR_TXRXS) != DSPI_SR_TXRXS) { | |
| debug("DSPI RX/TX not ready!\n"); | |
| return -EIO; | |
| } | |
| return 0; | |
| } | |
| void spi_release_bus(struct spi_slave *slave) | |
| { | |
| struct fsl_dspi *dspi = (struct fsl_dspi *)slave; | |
| dspi_halt(&dspi->priv, 1); | |
| cpu_dspi_release_bus(slave->bus.slave->cs); | |
| } | |
| int spi_xfer(struct spi_slave *slave, unsigned int bitlen, const void *dout, | |
| void *din, unsigned long flags) | |
| { | |
| struct fsl_dspi *dspi = (struct fsl_dspi *)slave; | |
| return dspi_xfer(&dspi->priv, slave->cs, bitlen, dout, din, flags); | |
| } | |
| #else | |
| static int fsl_dspi_child_pre_probe(struct udevice *dev) | |
| { | |
| struct dm_spi_slave_platdata *slave_plat = dev_get_parent_platdata(dev); | |
| struct fsl_dspi_priv *priv = dev_get_priv(dev->parent); | |
| if (slave_plat->cs >= priv->num_chipselect) { | |
| debug("DSPI invalid chipselect number %d(max %d)!\n", | |
| slave_plat->cs, priv->num_chipselect - 1); | |
| return -EINVAL; | |
| } | |
| priv->ctar_val[slave_plat->cs] = DSPI_CTAR_DEFAULT_VALUE; | |
| debug("DSPI pre_probe slave device on CS %u, max_hz %u, mode 0x%x.\n", | |
| slave_plat->cs, slave_plat->max_hz, slave_plat->mode); | |
| return 0; | |
| } | |
| static int fsl_dspi_probe(struct udevice *bus) | |
| { | |
| struct fsl_dspi_platdata *plat = dev_get_platdata(bus); | |
| struct fsl_dspi_priv *priv = dev_get_priv(bus); | |
| struct dm_spi_bus *dm_spi_bus; | |
| uint mcr_cfg_val; | |
| dm_spi_bus = bus->uclass_priv; | |
| /* cpu speical pin muxing configure */ | |
| cpu_dspi_port_conf(); | |
| /* get input clk frequency */ | |
| priv->regs = (struct dspi *)plat->regs_addr; | |
| priv->flags = plat->flags; | |
| #ifdef CONFIG_M68K | |
| priv->bus_clk = gd->bus_clk; | |
| #else | |
| priv->bus_clk = mxc_get_clock(MXC_DSPI_CLK); | |
| #endif | |
| priv->num_chipselect = plat->num_chipselect; | |
| priv->speed_hz = plat->speed_hz; | |
| /* frame data length in bits, default 8bits */ | |
| priv->charbit = 8; | |
| dm_spi_bus->max_hz = plat->speed_hz; | |
| /* default: all CS signals inactive state is high */ | |
| mcr_cfg_val = DSPI_MCR_MSTR | DSPI_MCR_PCSIS_MASK | | |
| DSPI_MCR_CRXF | DSPI_MCR_CTXF; | |
| fsl_dspi_init_mcr(priv, mcr_cfg_val); | |
| debug("%s probe done, bus-num %d.\n", bus->name, bus->seq); | |
| return 0; | |
| } | |
| static int fsl_dspi_claim_bus(struct udevice *dev) | |
| { | |
| uint sr_val; | |
| struct fsl_dspi_priv *priv; | |
| struct udevice *bus = dev->parent; | |
| struct dm_spi_slave_platdata *slave_plat = | |
| dev_get_parent_platdata(dev); | |
| priv = dev_get_priv(bus); | |
| /* processor special preparation work */ | |
| cpu_dspi_claim_bus(bus->seq, slave_plat->cs); | |
| /* configure transfer mode */ | |
| fsl_dspi_cfg_ctar_mode(priv, slave_plat->cs, priv->mode); | |
| /* configure active state of CSX */ | |
| fsl_dspi_cfg_cs_active_state(priv, slave_plat->cs, | |
| priv->mode); | |
| fsl_dspi_clr_fifo(priv); | |
| /* check module TX and RX status */ | |
| sr_val = dspi_read32(priv->flags, &priv->regs->sr); | |
| if ((sr_val & DSPI_SR_TXRXS) != DSPI_SR_TXRXS) { | |
| debug("DSPI RX/TX not ready!\n"); | |
| return -EIO; | |
| } | |
| return 0; | |
| } | |
| static int fsl_dspi_release_bus(struct udevice *dev) | |
| { | |
| struct udevice *bus = dev->parent; | |
| struct fsl_dspi_priv *priv = dev_get_priv(bus); | |
| struct dm_spi_slave_platdata *slave_plat = | |
| dev_get_parent_platdata(dev); | |
| /* halt module */ | |
| dspi_halt(priv, 1); | |
| /* processor special release work */ | |
| cpu_dspi_release_bus(bus->seq, slave_plat->cs); | |
| return 0; | |
| } | |
| /** | |
| * This function doesn't do anything except help with debugging | |
| */ | |
| static int fsl_dspi_bind(struct udevice *bus) | |
| { | |
| debug("%s assigned req_seq %d.\n", bus->name, bus->req_seq); | |
| return 0; | |
| } | |
| static int fsl_dspi_ofdata_to_platdata(struct udevice *bus) | |
| { | |
| fdt_addr_t addr; | |
| struct fsl_dspi_platdata *plat = bus->platdata; | |
| const void *blob = gd->fdt_blob; | |
| int node = dev_of_offset(bus); | |
| if (fdtdec_get_bool(blob, node, "big-endian")) | |
| plat->flags |= DSPI_FLAG_REGMAP_ENDIAN_BIG; | |
| plat->num_chipselect = | |
| fdtdec_get_int(blob, node, "num-cs", FSL_DSPI_MAX_CHIPSELECT); | |
| addr = dev_get_addr(bus); | |
| if (addr == FDT_ADDR_T_NONE) { | |
| debug("DSPI: Can't get base address or size\n"); | |
| return -ENOMEM; | |
| } | |
| plat->regs_addr = addr; | |
| plat->speed_hz = fdtdec_get_int(blob, | |
| node, "spi-max-frequency", FSL_DSPI_DEFAULT_SCK_FREQ); | |
| debug("DSPI: regs=%pa, max-frequency=%d, endianess=%s, num-cs=%d\n", | |
| &plat->regs_addr, plat->speed_hz, | |
| plat->flags & DSPI_FLAG_REGMAP_ENDIAN_BIG ? "be" : "le", | |
| plat->num_chipselect); | |
| return 0; | |
| } | |
| static int fsl_dspi_xfer(struct udevice *dev, unsigned int bitlen, | |
| const void *dout, void *din, unsigned long flags) | |
| { | |
| struct fsl_dspi_priv *priv; | |
| struct dm_spi_slave_platdata *slave_plat = dev_get_parent_platdata(dev); | |
| struct udevice *bus; | |
| bus = dev->parent; | |
| priv = dev_get_priv(bus); | |
| return dspi_xfer(priv, slave_plat->cs, bitlen, dout, din, flags); | |
| } | |
| static int fsl_dspi_set_speed(struct udevice *bus, uint speed) | |
| { | |
| struct fsl_dspi_priv *priv = dev_get_priv(bus); | |
| return fsl_dspi_cfg_speed(priv, speed); | |
| } | |
| static int fsl_dspi_set_mode(struct udevice *bus, uint mode) | |
| { | |
| struct fsl_dspi_priv *priv = dev_get_priv(bus); | |
| debug("DSPI set_mode: mode 0x%x.\n", mode); | |
| /* | |
| * We store some chipselect special configure value in priv->ctar_val, | |
| * and we can't get the correct chipselect number here, | |
| * so just store mode value. | |
| * Do really configuration when claim_bus. | |
| */ | |
| priv->mode = mode; | |
| return 0; | |
| } | |
| static const struct dm_spi_ops fsl_dspi_ops = { | |
| .claim_bus = fsl_dspi_claim_bus, | |
| .release_bus = fsl_dspi_release_bus, | |
| .xfer = fsl_dspi_xfer, | |
| .set_speed = fsl_dspi_set_speed, | |
| .set_mode = fsl_dspi_set_mode, | |
| }; | |
| static const struct udevice_id fsl_dspi_ids[] = { | |
| { .compatible = "fsl,vf610-dspi" }, | |
| { } | |
| }; | |
| U_BOOT_DRIVER(fsl_dspi) = { | |
| .name = "fsl_dspi", | |
| .id = UCLASS_SPI, | |
| .of_match = fsl_dspi_ids, | |
| .ops = &fsl_dspi_ops, | |
| .ofdata_to_platdata = fsl_dspi_ofdata_to_platdata, | |
| .platdata_auto_alloc_size = sizeof(struct fsl_dspi_platdata), | |
| .priv_auto_alloc_size = sizeof(struct fsl_dspi_priv), | |
| .probe = fsl_dspi_probe, | |
| .child_pre_probe = fsl_dspi_child_pre_probe, | |
| .bind = fsl_dspi_bind, | |
| }; | |
| #endif |