drivers/soc/renesas/rcar-mfis.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Renesas R-Car MFIS (Multifunctional Interface) driver
 *
 * Copyright (C) Renesas Solutions Corp.
 * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
 * Wolfram Sang <wsa+renesas@sang-engineering.com>
 */
#include <dt-bindings/soc/renesas,r8a78000-mfis.h>
#include <linux/device.h>
#include <linux/interrupt.h>
#include <linux/io.h>
#include <linux/kernel.h>
#include <linux/mailbox_controller.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/of_irq.h>
#include <linux/of_platform.h>
#include <linux/platform_device.h>
#include <linux/spinlock.h>

#define MFISWPCNTR	0x0900
#define MFISWACNTR	0x0904

#define MFIS_X5H_IICR(i) ((i) * 0x1000 + 0x00)
#define MFIS_X5H_EICR(i) ((i) * 0x1000 + 0x04)

#define MFIS_UNPROTECT_KEY 0xACCE0000

struct mfis_priv;

struct mfis_reg {
	void __iomem *base;
	resource_size_t start;
	struct mfis_priv *priv;
};

struct mfis_info {
	u32 unprotect_mask;
	unsigned int mb_num_channels;
	unsigned int mb_reg_comes_from_dt:1;
	unsigned int mb_tx_uses_eicr:1;
	unsigned int mb_channels_are_unidir:1;
	u32 (*mb_calc_reg)(u32 chan_num, bool tx_uses_eicr, bool is_only_rx);
};

struct mfis_chan_priv {
	u32 reg;
	int irq;
};

struct mfis_priv {
	spinlock_t unprotect_lock; /* guards access to the unprotection reg */
	struct device *dev;
	struct mfis_reg common_reg;
	struct mfis_reg mbox_reg;
	const struct mfis_info *info;

	/* mailbox private data */
	struct mbox_controller mbox;
	struct mfis_chan_priv *chan_privs;
};

static u32 mfis_read(struct mfis_reg *mreg, unsigned int reg)
{
	return ioread32(mreg->base + reg);
}

static void mfis_write(struct mfis_reg *mreg, u32 reg, u32 val)
{
	struct mfis_priv *priv = mreg->priv;
	u32 unprotect_mask = priv->info->unprotect_mask;
	unsigned long flags;
	u32 unprotect_code;

	/*
	 * [Gen4] key: 0xACCE0000, mask: 0x0000FFFF
	 * [Gen5] key: 0xACC00000, mask: 0x000FFFFF
	 */
	unprotect_code = (MFIS_UNPROTECT_KEY & ~unprotect_mask) |
			 ((mreg->start + reg) & unprotect_mask);

	spin_lock_irqsave(&priv->unprotect_lock, flags);
	iowrite32(unprotect_code, priv->common_reg.base + MFISWACNTR);
	iowrite32(val, mreg->base + reg);
	spin_unlock_irqrestore(&priv->unprotect_lock, flags);
}

/********************************************************
 *			Mailbox				*
 ********************************************************/

#define mfis_mb_mbox_to_priv(_m) container_of((_m), struct mfis_priv, mbox)

static irqreturn_t mfis_mb_iicr_interrupt(int irq, void *data)
{
	struct mbox_chan *chan = data;
	struct mfis_priv *priv = mfis_mb_mbox_to_priv(chan->mbox);
	struct mfis_chan_priv *chan_priv = chan->con_priv;

	mbox_chan_received_data(chan, NULL);
	/* Stop remote(!) doorbell */
	mfis_write(&priv->mbox_reg, chan_priv->reg, 0);

	return IRQ_HANDLED;
}

static int mfis_mb_startup(struct mbox_chan *chan)
{
	struct mfis_chan_priv *chan_priv = chan->con_priv;

	if (!chan_priv->irq)
		return 0;

	return request_irq(chan_priv->irq, mfis_mb_iicr_interrupt, 0,
			   dev_name(chan->mbox->dev), chan);
}

static void mfis_mb_shutdown(struct mbox_chan *chan)
{
	struct mfis_chan_priv *chan_priv = chan->con_priv;

	if (chan_priv->irq)
		free_irq(chan_priv->irq, chan);
}

static int mfis_mb_iicr_send_data(struct mbox_chan *chan, void *data)
{
	struct mfis_priv *priv = mfis_mb_mbox_to_priv(chan->mbox);
	struct mfis_chan_priv *chan_priv = chan->con_priv;

	/* Our doorbell still active? */
	if (mfis_read(&priv->mbox_reg, chan_priv->reg) & BIT(0))
		return -EBUSY;

	/* Start our doorbell */
	mfis_write(&priv->mbox_reg, chan_priv->reg, BIT(0));

	return 0;
}

static bool mfis_mb_iicr_last_tx_done(struct mbox_chan *chan)
{
	struct mfis_priv *priv = mfis_mb_mbox_to_priv(chan->mbox);
	struct mfis_chan_priv *chan_priv = chan->con_priv;

	/* Our doorbell still active? */
	return !(mfis_read(&priv->mbox_reg, chan_priv->reg) & BIT(0));
}

/* For MFIS variants using the IICR/EICR register pair */
static const struct mbox_chan_ops mfis_iicr_ops = {
	.startup = mfis_mb_startup,
	.shutdown = mfis_mb_shutdown,
	.send_data = mfis_mb_iicr_send_data,
	.last_tx_done = mfis_mb_iicr_last_tx_done,
};

static u32 mfis_mb_r8a779g0_calc_reg(u32 chan_num, bool tx_uses_eicr, bool is_only_rx)
{
	unsigned int i, k;
	u32 reg;

	i = chan_num & 3;
	k = chan_num >> 2;

	if (is_only_rx) {
		if (k < 2)
			reg = 0x9404 + 0x1020 * k + 0x08 * i;
		else
			reg = 0xb504 + 0x08 * i;
	} else {
		if (k < 2)
			reg = 0x1400 + 0x1008 * i + 0x20 * k;
		else
			reg = 0x1500 + 0x1008 * i;
	}

	return reg;
}

static u32 mfis_mb_r8a78000_calc_reg(u32 chan_num, bool tx_uses_eicr, bool is_only_rx)
{
	return (tx_uses_eicr ^ is_only_rx) ? MFIS_X5H_EICR(chan_num) :
					     MFIS_X5H_IICR(chan_num);
}

static struct mbox_chan *mfis_mb_of_xlate(struct mbox_controller *mbox,
					  const struct of_phandle_args *sp)
{
	struct mfis_priv *priv = mfis_mb_mbox_to_priv(mbox);
	struct mfis_chan_priv *chan_priv;
	bool tx_uses_eicr, is_only_rx;
	u32 chan_num, chan_flags;
	struct mbox_chan *chan;

	if (sp->args_count != 2)
		return ERR_PTR(-EINVAL);

	chan_num = sp->args[0];
	chan_flags = sp->args[1];

	if (chan_num >= priv->info->mb_num_channels)
		return ERR_PTR(-EINVAL);

	/* Channel layout is described in mfis_mb_probe() */
	if (priv->info->mb_channels_are_unidir) {
		is_only_rx = chan_flags & MFIS_CHANNEL_RX;
		chan = mbox->chans + 2 * chan_num + is_only_rx;
	} else {
		is_only_rx = false;
		chan = mbox->chans + chan_num;
	}

	if (priv->info->mb_reg_comes_from_dt) {
		tx_uses_eicr = chan_flags & MFIS_CHANNEL_EICR;
		if (tx_uses_eicr)
			chan += mbox->num_chans / 2;
	} else {
		tx_uses_eicr = priv->info->mb_tx_uses_eicr;
	}

	chan_priv = chan->con_priv;
	chan_priv->reg = priv->info->mb_calc_reg(chan_num, tx_uses_eicr, is_only_rx);

	if (!priv->info->mb_channels_are_unidir || is_only_rx) {
		char irqname[8];
		char suffix = tx_uses_eicr ? 'i' : 'e';

		/* "ch0i" or "ch0e" */
		scnprintf(irqname, sizeof(irqname), "ch%u%c", chan_num, suffix);

		chan_priv->irq = of_irq_get_byname(mbox->dev->of_node, irqname);
		if (chan_priv->irq < 0)
			return ERR_PTR(chan_priv->irq);
		if (chan_priv->irq == 0)
			return ERR_PTR(-ENOENT);
	}

	return chan;
}

static int mfis_mb_probe(struct mfis_priv *priv)
{
	unsigned int num_chan = priv->info->mb_num_channels;
	struct device *dev = priv->dev;
	struct mbox_controller *mbox;
	struct mbox_chan *chan;

	if (priv->info->mb_channels_are_unidir) {
		/* Channel layout: Ch0-TX, Ch0-RX, Ch1-TX... */
		num_chan *= 2;
	}

	if (priv->info->mb_reg_comes_from_dt) {
		/* Channel layout: <n> IICR channels, <n> EICR channels */
		num_chan *= 2;
	}

	chan  = devm_kcalloc(dev, num_chan, sizeof(*chan), GFP_KERNEL);
	if (!chan)
		return -ENOMEM;

	priv->chan_privs = devm_kcalloc(dev, num_chan, sizeof(*priv->chan_privs),
					    GFP_KERNEL);
	if (!priv->chan_privs)
		return -ENOMEM;

	mbox = &priv->mbox;

	for (unsigned int i = 0; i < num_chan; i++)
		chan[i].con_priv = &priv->chan_privs[i];

	mbox->chans = chan;
	mbox->num_chans = num_chan;
	mbox->txdone_poll = true;
	mbox->ops = &mfis_iicr_ops;
	mbox->dev = dev;
	mbox->of_xlate = mfis_mb_of_xlate;

	return devm_mbox_controller_register(dev, mbox);
}

/********************************************************
 *			Common				*
 ********************************************************/
static int mfis_reg_probe(struct platform_device *pdev, struct mfis_priv *priv,
			  struct mfis_reg *mreg, const char *name, bool required)
{
	struct resource *res;
	void __iomem *base;

	res = platform_get_resource_byname(pdev, IORESOURCE_MEM, name);

	/* If there is no mailbox resource, registers are in the common space */
	if (!res && !required) {
		*mreg = priv->common_reg;
	} else {
		base = devm_ioremap_resource(&pdev->dev, res);
		if (IS_ERR(base))
			return PTR_ERR(base);

		mreg->base = base;
		mreg->start = res->start;
		mreg->priv = priv;
	}

	return 0;
}

static int mfis_probe(struct platform_device *pdev)
{
	struct device *dev = &pdev->dev;
	struct mfis_priv *priv;
	int ret;

	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
	if (!priv)
		return -ENOMEM;

	priv->dev = dev;
	priv->info = of_device_get_match_data(dev);
	if (!priv->info)
		return -ENOENT;

	spin_lock_init(&priv->unprotect_lock);

	ret = mfis_reg_probe(pdev, priv, &priv->common_reg, "common", true);
	if (ret)
		return ret;

	ret = mfis_reg_probe(pdev, priv, &priv->mbox_reg, "mboxes", false);
	if (ret)
		return ret;

	return mfis_mb_probe(priv);
}

static const struct mfis_info mfis_info_r8a779g0 = {
	.unprotect_mask	= 0x0000ffff,
	.mb_num_channels = 12,
	.mb_channels_are_unidir = true,
	.mb_calc_reg = mfis_mb_r8a779g0_calc_reg,
};

static const struct mfis_info mfis_info_r8a78000 = {
	.unprotect_mask	= 0x000fffff,
	.mb_num_channels = 64,
	.mb_reg_comes_from_dt = true,
	.mb_channels_are_unidir = true,
	.mb_calc_reg = mfis_mb_r8a78000_calc_reg,
};

static const struct mfis_info mfis_info_r8a78000_scp = {
	.unprotect_mask	= 0x000fffff,
	.mb_num_channels = 32,
	.mb_tx_uses_eicr = true,
	.mb_channels_are_unidir = true,
	.mb_calc_reg = mfis_mb_r8a78000_calc_reg,
};

static const struct of_device_id mfis_mfd_of_match[] = {
	{ .compatible = "renesas,r8a779g0-mfis", .data = &mfis_info_r8a779g0, },
	{ .compatible = "renesas,r8a779h0-mfis", .data = &mfis_info_r8a779g0, },
	{ .compatible = "renesas,r8a78000-mfis", .data = &mfis_info_r8a78000, },
	{ .compatible = "renesas,r8a78000-mfis-scp", .data = &mfis_info_r8a78000_scp, },
	{}
};
MODULE_DEVICE_TABLE(of, mfis_mfd_of_match);

static struct platform_driver mfis_driver = {
	.driver = {
		.name = "rcar-mfis",
		.of_match_table = mfis_mfd_of_match,
		.suppress_bind_attrs = true,
	},
	.probe	= mfis_probe,
};
module_platform_driver(mfis_driver);

MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>");
MODULE_AUTHOR("Wolfram Sang <wsa+renesas@sang-engineering.com>");
MODULE_LICENSE("GPL");
MODULE_DESCRIPTION("Renesas R-Car MFIS driver");