On 11/23/2018 01:45 AM, masonccyang@xxxxxxxxxxx wrote: > Hi Marek, Hi, >> > + >> > +struct rpc_spi { >> > + struct clk *clk_rpc; >> > + void __iomem *regs; >> > + struct { >> > + void __iomem *map; >> > + dma_addr_t dma; >> > + size_t size; >> > + } linear; >> >> Does this need it's own struct ? >> > > yup, I think it's better. > In case no "dirmap" in dtb and no direct mapping mode implemented. > > >> > + u32 cur_speed_hz; >> > + u32 cmd; >> > + u32 addr; >> > + u32 dummy; >> > + u32 smcr; >> > + u32 smenr; >> > + u32 xferlen; >> > + u32 totalxferlen; >> >> This register cache might be a good candidate for regmap ? > > I don't know what does it mean ? > Could you give me more information! See include/linux/regmap.h and git grep regmap drivers/ for examples. >> > + enum spi_mem_data_dir xfer_dir; >> > +}; >> > + >> > +static int rpc_spi_set_freq(struct rpc_spi *rpc, unsigned long freq) >> > +{ >> > + int ret; >> > + >> > + if (rpc->cur_speed_hz == freq) >> > + return 0; >> > + >> > + clk_disable_unprepare(rpc->clk_rpc); >> > + ret = clk_set_rate(rpc->clk_rpc, freq); >> > + if (ret) >> > + return ret; >> > + >> > + ret = clk_prepare_enable(rpc->clk_rpc); >> > + if (ret) >> > + return ret; >> >> Is this clock disable/update/enable really needed ? I'd think that >> clk_set_rate() would handle the rate update correctly. > > As Gerrt mentioned, I will remove them. > > >> > +static int wait_msg_xfer_end(struct rpc_spi *rpc) >> > +{ >> > + u32 sts; >> > + >> > + return readl_poll_timeout(rpc->regs + RPC_CMNSR, sts, >> > + sts & RPC_CMNSR_TEND, 0, USEC_PER_SEC); >> > +} >> > + >> > +static u8 rpc_bits_xfer(u32 nbytes) >> > +{ >> > + u8 databyte; >> > + >> > + switch (nbytes) { >> >> Did you ever test unaligned writes and reads ? There are some nasty edge >> cases in those. >> >> Also, I think you can calculate the number of set bits using a simple >> function, so the switch-case might not even be needed. >> > > Any example function ? Nope, you'd have to think of one. You need to fill $nbytes bits from top down. I think you can somehow use GENMASK() . >> > + case 1: >> > + databyte = 0x8; >> > + break; >> > + case 2: >> > + databyte = 0xc; >> > + break; >> > + default: >> > + databyte = 0xf; >> > + break; >> > + } >> > + >> > + return databyte; >> > +} >> > + >> > +static int rpc_spi_io_xfer(struct rpc_spi *rpc, >> > + const void *tx_buf, void *rx_buf) >> > +{ >> > + u32 smenr, smcr, data, pos = 0; >> > + int ret = 0; >> > + >> > + writel(RPC_CMNCR_MD | RPC_CMNCR_SFDE | RPC_CMNCR_MOIIO_HIZ | >> > + RPC_CMNCR_IOFV_HIZ | RPC_CMNCR_BSZ(0), rpc->regs + > RPC_CMNCR); >> > + writel(0x0, rpc->regs + RPC_SMDRENR); >> > + >> > + if (tx_buf) { >> > + writel(rpc->cmd, rpc->regs + RPC_SMCMR); >> > + writel(rpc->dummy, rpc->regs + RPC_SMDMCR); >> > + writel(rpc->addr, rpc->regs + RPC_SMADR); >> > + smenr = rpc->smenr; >> > + >> > + while (pos < rpc->xferlen) { >> > + u32 nbytes = rpc->xferlen - pos; >> > + >> > + writel(*(u32 *)(tx_buf + pos), rpc->regs + RPC_SMWDR0); >> > + >> > + if (nbytes > 4) { >> > + nbytes = 4; >> > + smcr = rpc->smcr | >> > + RPC_SMCR_SPIE | RPC_SMCR_SSLKP; >> > + } else { >> > + smcr = rpc->smcr | RPC_SMCR_SPIE; >> > + } >> > + >> > + writel(smenr, rpc->regs + RPC_SMENR); >> > + writel(smcr, rpc->regs + RPC_SMCR); >> > + ret = wait_msg_xfer_end(rpc); >> > + if (ret) >> > + goto out; >> > + >> > + pos += nbytes; >> > + smenr = rpc->smenr & ~RPC_SMENR_CDE & >> > + ~RPC_SMENR_ADE(0xf); >> > + } >> > + } else if (rx_buf) { >> > + while (pos < rpc->xferlen) { >> > + u32 nbytes = rpc->xferlen - pos; >> > + >> > + if (nbytes > 4) >> > + nbytes = 4; >> > + >> > + writel(rpc->cmd, rpc->regs + RPC_SMCMR); >> > + writel(rpc->dummy, rpc->regs + RPC_SMDMCR); >> > + writel(rpc->addr + pos, rpc->regs + RPC_SMADR); >> > + writel(rpc->smenr, rpc->regs + RPC_SMENR); >> > + writel(rpc->smcr | RPC_SMCR_SPIE, rpc->regs + RPC_SMCR); >> > + ret = wait_msg_xfer_end(rpc); >> > + if (ret) >> > + goto out; >> > + >> > + data = readl(rpc->regs + RPC_SMRDR0); >> > + memcpy_fromio(rx_buf + pos, (void *)&data, nbytes); >> > + pos += nbytes; >> > + } >> > + } else { >> > + writel(rpc->cmd, rpc->regs + RPC_SMCMR); >> > + writel(rpc->dummy, rpc->regs + RPC_SMDMCR); >> > + writel(rpc->addr + pos, rpc->regs + RPC_SMADR); >> > + writel(rpc->smenr, rpc->regs + RPC_SMENR); >> > + writel(rpc->smcr | RPC_SMCR_SPIE, rpc->regs + RPC_SMCR); >> > + ret = wait_msg_xfer_end(rpc); >> > + } >> > +out: >> >> Dont you need to stop the RPC somehow in case the transmission fails ? >> > > I can't find any RPC registers can do this ! > > Do you know how to do this ? It should be in the RPC datasheet ? It's likely going to involve SMCR, possibly clear SPIE bit and maybe some more. >> > + writel(rpc->cmd, rpc->regs + RPC_SMCMR); >> > + writel(offs, rpc->regs + RPC_SMADR); >> > + writel(rpc->smenr, rpc->regs + RPC_SMENR); >> > + writel(rpc->smcr | RPC_SMCR_SPIE, rpc->regs + RPC_SMCR); >> > + ret = wait_msg_xfer_end(rpc); >> > + if (ret) >> > + goto out; >> > + >> > + writel(RPC_DRCR_RCF, rpc->regs + RPC_DRCR); >> > + writel(RPC_PHYCNT_CAL | RPC_PHYCNT_STRTIM(0) | 0x260, >> > + rpc->regs + RPC_PHYCNT); >> > + >> > + return len; >> > +out: >> >> Shouldn't you shut the controller down if the xfer fails ? > > Any registers can shut down RPC controller ? > SW reset ? Possibly, can you research it ? >> > + return ret; >> > +} >> > + >> > +static int rpc_spi_mem_dirmap_create(struct spi_mem_dirmap_desc *desc) >> > +{ >> > + struct rpc_spi *rpc = > spi_master_get_devdata(desc->mem->spi->master); >> > + >> > + if (desc->info.offset + desc->info.length > U32_MAX) >> > + return -ENOTSUPP; >> > + >> > + if (!rpc_spi_mem_supports_op(desc->mem, &desc->info.op_tmpl)) >> > + return -ENOTSUPP; >> > + >> > + if (!rpc->linear.map && >> > + desc->info.op_tmpl.data.dir == SPI_MEM_DATA_IN) >> > + return -ENOTSUPP; >> > + >> > + return 0; >> > +} >> > + >> > +static int rpc_spi_mem_exec_op(struct spi_mem *mem, >> > + const struct spi_mem_op *op) >> > +{ >> > + struct rpc_spi *rpc = spi_master_get_devdata(mem->spi->master); >> > + int ret; >> > + >> > + ret = rpc_spi_set_freq(rpc, mem->spi->max_speed_hz); >> > + if (ret) >> > + return ret; >> > + >> > + rpc_spi_mem_set_prep_op_cfg(mem->spi, op, NULL, NULL); >> > + >> > + ret = rpc_spi_io_xfer(rpc, >> > + op->data.dir == SPI_MEM_DATA_OUT ? >> > + op->data.buf.out : NULL, >> > + op->data.dir == SPI_MEM_DATA_IN ? >> > + op->data.buf.in : NULL); >> > + >> > + return ret; >> > +} >> > + >> > +static const struct spi_controller_mem_ops rpc_spi_mem_ops = { >> > + .supports_op = rpc_spi_mem_supports_op, >> > + .exec_op = rpc_spi_mem_exec_op, >> > + .dirmap_create = rpc_spi_mem_dirmap_create, >> > + .dirmap_read = rpc_spi_mem_dirmap_read, >> > + .dirmap_write = rpc_spi_mem_dirmap_write, >> > +}; >> > + >> > +static void rpc_spi_transfer_setup(struct rpc_spi *rpc, >> > + struct spi_message *msg) >> > +{ >> > + struct spi_transfer *t, xfer[4] = { }; >> > + u32 i, xfercnt, xferpos = 0; >> > + >> > + rpc->totalxferlen = 0; >> > + list_for_each_entry(t, &msg->transfers, transfer_list) { >> > + if (t->tx_buf) { >> > + xfer[xferpos].tx_buf = t->tx_buf; >> > + xfer[xferpos].tx_nbits = t->tx_nbits; >> > + } >> > + >> > + if (t->rx_buf) { >> > + xfer[xferpos].rx_buf = t->rx_buf; >> > + xfer[xferpos].rx_nbits = t->rx_nbits; >> > + } >> > + >> > + if (t->len) { >> > + xfer[xferpos++].len = t->len; >> > + rpc->totalxferlen += t->len; >> > + } >> > + } >> > + >> > + xfercnt = xferpos; >> > + rpc->xferlen = xfer[--xferpos].len; >> > + rpc->cmd = RPC_SMCMR_CMD(((u8 *)xfer[0].tx_buf)[0]); >> >> Is the cast needed ? > > ? Sorry, I don't understand your question. To rephrase my original question, is the (u8 *) cast needed ? >> > + rpc->smenr = RPC_SMENR_CDE | RPC_SMENR_CDB(fls(xfer[0].tx_nbits >>> 1)); >> > + rpc->addr = 0; >> > + >> > + if (xfercnt > 2 && xfer[1].len && xfer[1].tx_buf) { >> > + rpc->smenr |= RPC_SMENR_ADB(fls(xfer[1].tx_nbits >> 1)); >> > + for (i = 0; i < xfer[1].len; i++) >> > + rpc->addr |= (u32)((u8 *)xfer[1].tx_buf)[i] >> > + << (8 * (xfer[1].len - i - 1)); >> > + >> > + if (xfer[1].len == 4) >> > + rpc->smenr |= RPC_SMENR_ADE(0xf); >> > + else >> > + rpc->smenr |= RPC_SMENR_ADE(0x7); >> > + } >> > + >> > + switch (xfercnt) { >> > + case 2: >> > + if (xfer[1].rx_buf) { >> > + rpc->smenr |= RPC_SMENR_SPIDE(rpc_bits_xfer >> > + (xfer[1].len)) | RPC_SMENR_SPIDB(fls >> > + (xfer[1].rx_nbits >> 1)); >> >> How much of this register value calculation could be somehow >> deduplicated ? It seems to be almost the same thing copied thrice here. > > I don't get your point! > > The 2'nd transfer may be > 1) spi-address > 2) tx_buf[] for write registers. > 3) rx_buf[] for read status. > > parse them and write to rpc->addr and so on. > Or you have a better way to do this ? Each of the case statement options has almost the same stuff in it. Can this be somehow reworked so that it wouldn't be three copies of almost the same ? [...] -- Best regards, Marek Vasut