162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci//
362306a36Sopenharmony_ci// RPC-IF SPI/QSPI/Octa driver
462306a36Sopenharmony_ci//
562306a36Sopenharmony_ci// Copyright (C) 2018 ~ 2019 Renesas Solutions Corp.
662306a36Sopenharmony_ci// Copyright (C) 2019 Macronix International Co., Ltd.
762306a36Sopenharmony_ci// Copyright (C) 2019 - 2020 Cogent Embedded, Inc.
862306a36Sopenharmony_ci//
962306a36Sopenharmony_ci
1062306a36Sopenharmony_ci#include <linux/module.h>
1162306a36Sopenharmony_ci#include <linux/platform_device.h>
1262306a36Sopenharmony_ci#include <linux/spi/spi.h>
1362306a36Sopenharmony_ci#include <linux/spi/spi-mem.h>
1462306a36Sopenharmony_ci
1562306a36Sopenharmony_ci#include <memory/renesas-rpc-if.h>
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_ci#include <asm/unaligned.h>
1862306a36Sopenharmony_ci
1962306a36Sopenharmony_cistatic void rpcif_spi_mem_prepare(struct spi_device *spi_dev,
2062306a36Sopenharmony_ci				  const struct spi_mem_op *spi_op,
2162306a36Sopenharmony_ci				  u64 *offs, size_t *len)
2262306a36Sopenharmony_ci{
2362306a36Sopenharmony_ci	struct rpcif *rpc = spi_controller_get_devdata(spi_dev->controller);
2462306a36Sopenharmony_ci	struct rpcif_op rpc_op = { };
2562306a36Sopenharmony_ci
2662306a36Sopenharmony_ci	rpc_op.cmd.opcode = spi_op->cmd.opcode;
2762306a36Sopenharmony_ci	rpc_op.cmd.buswidth = spi_op->cmd.buswidth;
2862306a36Sopenharmony_ci
2962306a36Sopenharmony_ci	if (spi_op->addr.nbytes) {
3062306a36Sopenharmony_ci		rpc_op.addr.buswidth = spi_op->addr.buswidth;
3162306a36Sopenharmony_ci		rpc_op.addr.nbytes = spi_op->addr.nbytes;
3262306a36Sopenharmony_ci		rpc_op.addr.val = spi_op->addr.val;
3362306a36Sopenharmony_ci	}
3462306a36Sopenharmony_ci
3562306a36Sopenharmony_ci	if (spi_op->dummy.nbytes) {
3662306a36Sopenharmony_ci		rpc_op.dummy.buswidth = spi_op->dummy.buswidth;
3762306a36Sopenharmony_ci		rpc_op.dummy.ncycles  = spi_op->dummy.nbytes * 8 /
3862306a36Sopenharmony_ci					spi_op->dummy.buswidth;
3962306a36Sopenharmony_ci	}
4062306a36Sopenharmony_ci
4162306a36Sopenharmony_ci	if (spi_op->data.nbytes || (offs && len)) {
4262306a36Sopenharmony_ci		rpc_op.data.buswidth = spi_op->data.buswidth;
4362306a36Sopenharmony_ci		rpc_op.data.nbytes = spi_op->data.nbytes;
4462306a36Sopenharmony_ci		switch (spi_op->data.dir) {
4562306a36Sopenharmony_ci		case SPI_MEM_DATA_IN:
4662306a36Sopenharmony_ci			rpc_op.data.dir = RPCIF_DATA_IN;
4762306a36Sopenharmony_ci			rpc_op.data.buf.in = spi_op->data.buf.in;
4862306a36Sopenharmony_ci			break;
4962306a36Sopenharmony_ci		case SPI_MEM_DATA_OUT:
5062306a36Sopenharmony_ci			rpc_op.data.dir = RPCIF_DATA_OUT;
5162306a36Sopenharmony_ci			rpc_op.data.buf.out = spi_op->data.buf.out;
5262306a36Sopenharmony_ci			break;
5362306a36Sopenharmony_ci		case SPI_MEM_NO_DATA:
5462306a36Sopenharmony_ci			rpc_op.data.dir = RPCIF_NO_DATA;
5562306a36Sopenharmony_ci			break;
5662306a36Sopenharmony_ci		}
5762306a36Sopenharmony_ci	} else	{
5862306a36Sopenharmony_ci		rpc_op.data.dir = RPCIF_NO_DATA;
5962306a36Sopenharmony_ci	}
6062306a36Sopenharmony_ci
6162306a36Sopenharmony_ci	rpcif_prepare(rpc->dev, &rpc_op, offs, len);
6262306a36Sopenharmony_ci}
6362306a36Sopenharmony_ci
6462306a36Sopenharmony_cistatic bool rpcif_spi_mem_supports_op(struct spi_mem *mem,
6562306a36Sopenharmony_ci				      const struct spi_mem_op *op)
6662306a36Sopenharmony_ci{
6762306a36Sopenharmony_ci	if (!spi_mem_default_supports_op(mem, op))
6862306a36Sopenharmony_ci		return false;
6962306a36Sopenharmony_ci
7062306a36Sopenharmony_ci	if (op->data.buswidth > 4 || op->addr.buswidth > 4 ||
7162306a36Sopenharmony_ci	    op->dummy.buswidth > 4 || op->cmd.buswidth > 4 ||
7262306a36Sopenharmony_ci	    op->addr.nbytes > 4)
7362306a36Sopenharmony_ci		return false;
7462306a36Sopenharmony_ci
7562306a36Sopenharmony_ci	return true;
7662306a36Sopenharmony_ci}
7762306a36Sopenharmony_ci
7862306a36Sopenharmony_cistatic ssize_t rpcif_spi_mem_dirmap_read(struct spi_mem_dirmap_desc *desc,
7962306a36Sopenharmony_ci					 u64 offs, size_t len, void *buf)
8062306a36Sopenharmony_ci{
8162306a36Sopenharmony_ci	struct rpcif *rpc =
8262306a36Sopenharmony_ci		spi_controller_get_devdata(desc->mem->spi->controller);
8362306a36Sopenharmony_ci
8462306a36Sopenharmony_ci	if (offs + desc->info.offset + len > U32_MAX)
8562306a36Sopenharmony_ci		return -EINVAL;
8662306a36Sopenharmony_ci
8762306a36Sopenharmony_ci	rpcif_spi_mem_prepare(desc->mem->spi, &desc->info.op_tmpl, &offs, &len);
8862306a36Sopenharmony_ci
8962306a36Sopenharmony_ci	return rpcif_dirmap_read(rpc->dev, offs, len, buf);
9062306a36Sopenharmony_ci}
9162306a36Sopenharmony_ci
9262306a36Sopenharmony_cistatic int rpcif_spi_mem_dirmap_create(struct spi_mem_dirmap_desc *desc)
9362306a36Sopenharmony_ci{
9462306a36Sopenharmony_ci	struct rpcif *rpc =
9562306a36Sopenharmony_ci		spi_controller_get_devdata(desc->mem->spi->controller);
9662306a36Sopenharmony_ci
9762306a36Sopenharmony_ci	if (desc->info.offset + desc->info.length > U32_MAX)
9862306a36Sopenharmony_ci		return -ENOTSUPP;
9962306a36Sopenharmony_ci
10062306a36Sopenharmony_ci	if (!rpcif_spi_mem_supports_op(desc->mem, &desc->info.op_tmpl))
10162306a36Sopenharmony_ci		return -ENOTSUPP;
10262306a36Sopenharmony_ci
10362306a36Sopenharmony_ci	if (!rpc->dirmap && desc->info.op_tmpl.data.dir == SPI_MEM_DATA_IN)
10462306a36Sopenharmony_ci		return -ENOTSUPP;
10562306a36Sopenharmony_ci
10662306a36Sopenharmony_ci	if (desc->info.op_tmpl.data.dir == SPI_MEM_DATA_OUT)
10762306a36Sopenharmony_ci		return -ENOTSUPP;
10862306a36Sopenharmony_ci
10962306a36Sopenharmony_ci	return 0;
11062306a36Sopenharmony_ci}
11162306a36Sopenharmony_ci
11262306a36Sopenharmony_cistatic int rpcif_spi_mem_exec_op(struct spi_mem *mem,
11362306a36Sopenharmony_ci				 const struct spi_mem_op *op)
11462306a36Sopenharmony_ci{
11562306a36Sopenharmony_ci	struct rpcif *rpc =
11662306a36Sopenharmony_ci		spi_controller_get_devdata(mem->spi->controller);
11762306a36Sopenharmony_ci
11862306a36Sopenharmony_ci	rpcif_spi_mem_prepare(mem->spi, op, NULL, NULL);
11962306a36Sopenharmony_ci
12062306a36Sopenharmony_ci	return rpcif_manual_xfer(rpc->dev);
12162306a36Sopenharmony_ci}
12262306a36Sopenharmony_ci
12362306a36Sopenharmony_cistatic const struct spi_controller_mem_ops rpcif_spi_mem_ops = {
12462306a36Sopenharmony_ci	.supports_op	= rpcif_spi_mem_supports_op,
12562306a36Sopenharmony_ci	.exec_op	= rpcif_spi_mem_exec_op,
12662306a36Sopenharmony_ci	.dirmap_create	= rpcif_spi_mem_dirmap_create,
12762306a36Sopenharmony_ci	.dirmap_read	= rpcif_spi_mem_dirmap_read,
12862306a36Sopenharmony_ci};
12962306a36Sopenharmony_ci
13062306a36Sopenharmony_cistatic int rpcif_spi_probe(struct platform_device *pdev)
13162306a36Sopenharmony_ci{
13262306a36Sopenharmony_ci	struct device *parent = pdev->dev.parent;
13362306a36Sopenharmony_ci	struct spi_controller *ctlr;
13462306a36Sopenharmony_ci	struct rpcif *rpc;
13562306a36Sopenharmony_ci	int error;
13662306a36Sopenharmony_ci
13762306a36Sopenharmony_ci	ctlr = devm_spi_alloc_host(&pdev->dev, sizeof(*rpc));
13862306a36Sopenharmony_ci	if (!ctlr)
13962306a36Sopenharmony_ci		return -ENOMEM;
14062306a36Sopenharmony_ci
14162306a36Sopenharmony_ci	rpc = spi_controller_get_devdata(ctlr);
14262306a36Sopenharmony_ci	error = rpcif_sw_init(rpc, parent);
14362306a36Sopenharmony_ci	if (error)
14462306a36Sopenharmony_ci		return error;
14562306a36Sopenharmony_ci
14662306a36Sopenharmony_ci	platform_set_drvdata(pdev, ctlr);
14762306a36Sopenharmony_ci
14862306a36Sopenharmony_ci	ctlr->dev.of_node = parent->of_node;
14962306a36Sopenharmony_ci
15062306a36Sopenharmony_ci	pm_runtime_enable(rpc->dev);
15162306a36Sopenharmony_ci
15262306a36Sopenharmony_ci	ctlr->num_chipselect = 1;
15362306a36Sopenharmony_ci	ctlr->mem_ops = &rpcif_spi_mem_ops;
15462306a36Sopenharmony_ci
15562306a36Sopenharmony_ci	ctlr->bits_per_word_mask = SPI_BPW_MASK(8);
15662306a36Sopenharmony_ci	ctlr->mode_bits = SPI_CPOL | SPI_CPHA | SPI_TX_QUAD | SPI_RX_QUAD;
15762306a36Sopenharmony_ci	ctlr->flags = SPI_CONTROLLER_HALF_DUPLEX;
15862306a36Sopenharmony_ci
15962306a36Sopenharmony_ci	error = rpcif_hw_init(rpc->dev, false);
16062306a36Sopenharmony_ci	if (error)
16162306a36Sopenharmony_ci		goto out_disable_rpm;
16262306a36Sopenharmony_ci
16362306a36Sopenharmony_ci	error = spi_register_controller(ctlr);
16462306a36Sopenharmony_ci	if (error) {
16562306a36Sopenharmony_ci		dev_err(&pdev->dev, "spi_register_controller failed\n");
16662306a36Sopenharmony_ci		goto out_disable_rpm;
16762306a36Sopenharmony_ci	}
16862306a36Sopenharmony_ci
16962306a36Sopenharmony_ci	return 0;
17062306a36Sopenharmony_ci
17162306a36Sopenharmony_ciout_disable_rpm:
17262306a36Sopenharmony_ci	pm_runtime_disable(rpc->dev);
17362306a36Sopenharmony_ci	return error;
17462306a36Sopenharmony_ci}
17562306a36Sopenharmony_ci
17662306a36Sopenharmony_cistatic void rpcif_spi_remove(struct platform_device *pdev)
17762306a36Sopenharmony_ci{
17862306a36Sopenharmony_ci	struct spi_controller *ctlr = platform_get_drvdata(pdev);
17962306a36Sopenharmony_ci	struct rpcif *rpc = spi_controller_get_devdata(ctlr);
18062306a36Sopenharmony_ci
18162306a36Sopenharmony_ci	spi_unregister_controller(ctlr);
18262306a36Sopenharmony_ci	pm_runtime_disable(rpc->dev);
18362306a36Sopenharmony_ci}
18462306a36Sopenharmony_ci
18562306a36Sopenharmony_cistatic int __maybe_unused rpcif_spi_suspend(struct device *dev)
18662306a36Sopenharmony_ci{
18762306a36Sopenharmony_ci	struct spi_controller *ctlr = dev_get_drvdata(dev);
18862306a36Sopenharmony_ci
18962306a36Sopenharmony_ci	return spi_controller_suspend(ctlr);
19062306a36Sopenharmony_ci}
19162306a36Sopenharmony_ci
19262306a36Sopenharmony_cistatic int __maybe_unused rpcif_spi_resume(struct device *dev)
19362306a36Sopenharmony_ci{
19462306a36Sopenharmony_ci	struct spi_controller *ctlr = dev_get_drvdata(dev);
19562306a36Sopenharmony_ci
19662306a36Sopenharmony_ci	return spi_controller_resume(ctlr);
19762306a36Sopenharmony_ci}
19862306a36Sopenharmony_ci
19962306a36Sopenharmony_cistatic SIMPLE_DEV_PM_OPS(rpcif_spi_pm_ops, rpcif_spi_suspend, rpcif_spi_resume);
20062306a36Sopenharmony_ci
20162306a36Sopenharmony_cistatic struct platform_driver rpcif_spi_driver = {
20262306a36Sopenharmony_ci	.probe	= rpcif_spi_probe,
20362306a36Sopenharmony_ci	.remove_new = rpcif_spi_remove,
20462306a36Sopenharmony_ci	.driver = {
20562306a36Sopenharmony_ci		.name	= "rpc-if-spi",
20662306a36Sopenharmony_ci#ifdef CONFIG_PM_SLEEP
20762306a36Sopenharmony_ci		.pm	= &rpcif_spi_pm_ops,
20862306a36Sopenharmony_ci#endif
20962306a36Sopenharmony_ci	},
21062306a36Sopenharmony_ci};
21162306a36Sopenharmony_cimodule_platform_driver(rpcif_spi_driver);
21262306a36Sopenharmony_ci
21362306a36Sopenharmony_ciMODULE_DESCRIPTION("Renesas RPC-IF SPI driver");
21462306a36Sopenharmony_ciMODULE_LICENSE("GPL v2");
215