|  | // SPDX-License-Identifier: GPL-2.0 | 
|  | /* | 
|  | * Broadcom BCM74110 Mailbox Driver | 
|  | * | 
|  | * Copyright (c) 2025 Broadcom | 
|  | */ | 
|  | #include <linux/list.h> | 
|  | #include <linux/types.h> | 
|  | #include <linux/workqueue.h> | 
|  | #include <linux/io-64-nonatomic-hi-lo.h> | 
|  | #include <linux/interrupt.h> | 
|  | #include <linux/module.h> | 
|  | #include <linux/platform_device.h> | 
|  | #include <linux/of.h> | 
|  | #include <linux/delay.h> | 
|  | #include <linux/mailbox_controller.h> | 
|  | #include <linux/bitfield.h> | 
|  | #include <linux/slab.h> | 
|  |  | 
|  | #define BCM_MBOX_BASE(sel)		((sel) * 0x40) | 
|  | #define BCM_MBOX_IRQ_BASE(sel)		(((sel) * 0x20) + 0x800) | 
|  |  | 
|  | #define BCM_MBOX_CFGA			0x0 | 
|  | #define BCM_MBOX_CFGB			0x4 | 
|  | #define BCM_MBOX_CFGC			0x8 | 
|  | #define BCM_MBOX_CFGD			0xc | 
|  | #define BCM_MBOX_CTRL			0x10 | 
|  | #define  BCM_MBOX_CTRL_EN		BIT(0) | 
|  | #define  BCM_MBOX_CTRL_CLR		BIT(1) | 
|  | #define BCM_MBOX_STATUS0		0x14 | 
|  | #define  BCM_MBOX_STATUS0_NOT_EMPTY	BIT(28) | 
|  | #define  BCM_MBOX_STATUS0_FULL		BIT(29) | 
|  | #define BCM_MBOX_STATUS1		0x18 | 
|  | #define BCM_MBOX_STATUS2		0x1c | 
|  | #define BCM_MBOX_WDATA			0x20 | 
|  | #define BCM_MBOX_RDATA			0x28 | 
|  |  | 
|  | #define BCM_MBOX_IRQ_STATUS		0x0 | 
|  | #define BCM_MBOX_IRQ_SET		0x4 | 
|  | #define BCM_MBOX_IRQ_CLEAR		0x8 | 
|  | #define BCM_MBOX_IRQ_MASK_STATUS	0xc | 
|  | #define BCM_MBOX_IRQ_MASK_SET		0x10 | 
|  | #define BCM_MBOX_IRQ_MASK_CLEAR		0x14 | 
|  | #define  BCM_MBOX_IRQ_TIMEOUT		BIT(0) | 
|  | #define  BCM_MBOX_IRQ_NOT_EMPTY		BIT(1) | 
|  | #define  BCM_MBOX_IRQ_FULL		BIT(2) | 
|  | #define  BCM_MBOX_IRQ_LOW_WM		BIT(3) | 
|  | #define  BCM_MBOX_IRQ_HIGH_WM		BIT(4) | 
|  |  | 
|  | #define BCM_LINK_CODE0			0xbe0 | 
|  | #define BCM_LINK_CODE1			0xbe1 | 
|  | #define BCM_LINK_CODE2			0xbe2 | 
|  |  | 
|  | enum { | 
|  | BCM_MSG_FUNC_LINK_START = 0, | 
|  | BCM_MSG_FUNC_LINK_STOP, | 
|  | BCM_MSG_FUNC_SHMEM_TX, | 
|  | BCM_MSG_FUNC_SHMEM_RX, | 
|  | BCM_MSG_FUNC_SHMEM_STOP, | 
|  | BCM_MSG_FUNC_MAX, | 
|  | }; | 
|  |  | 
|  | enum { | 
|  | BCM_MSG_SVC_INIT = 0, | 
|  | BCM_MSG_SVC_PMC, | 
|  | BCM_MSG_SVC_SCMI, | 
|  | BCM_MSG_SVC_DPFE, | 
|  | BCM_MSG_SVC_MAX, | 
|  | }; | 
|  |  | 
|  | struct bcm74110_mbox_msg { | 
|  | struct list_head		list_entry; | 
|  | #define BCM_MSG_VERSION_MASK		GENMASK(31, 29) | 
|  | #define  BCM_MSG_VERSION		0x1 | 
|  | #define BCM_MSG_REQ_MASK		BIT(28) | 
|  | #define BCM_MSG_RPLY_MASK		BIT(27) | 
|  | #define BCM_MSG_SVC_MASK		GENMASK(26, 24) | 
|  | #define BCM_MSG_FUNC_MASK		GENMASK(23, 16) | 
|  | #define BCM_MSG_LENGTH_MASK		GENMASK(15, 4) | 
|  | #define BCM_MSG_SLOT_MASK		GENMASK(3, 0) | 
|  |  | 
|  | #define BCM_MSG_SET_FIELD(hdr, field, val)			\ | 
|  | do {							\ | 
|  | hdr &= ~BCM_MSG_##field##_MASK;			\ | 
|  | hdr |= FIELD_PREP(BCM_MSG_##field##_MASK, val);	\ | 
|  | } while (0) | 
|  |  | 
|  | #define BCM_MSG_GET_FIELD(hdr, field)				\ | 
|  | FIELD_GET(BCM_MSG_##field##_MASK, hdr) | 
|  | u32				msg; | 
|  | }; | 
|  |  | 
|  | struct bcm74110_mbox_chan { | 
|  | struct bcm74110_mbox		*mbox; | 
|  | bool				en; | 
|  | int				slot; | 
|  | int				type; | 
|  | }; | 
|  |  | 
|  | struct bcm74110_mbox { | 
|  | struct platform_device		*pdev; | 
|  | void __iomem			*base; | 
|  |  | 
|  | int				tx_chan; | 
|  | int				rx_chan; | 
|  | int				rx_irq; | 
|  | struct list_head		rx_svc_init_list; | 
|  | spinlock_t			rx_svc_list_lock; | 
|  |  | 
|  | struct mbox_controller		controller; | 
|  | struct bcm74110_mbox_chan	*mbox_chan; | 
|  | }; | 
|  |  | 
|  | #define BCM74110_OFFSET_IO_WRITEL_MACRO(name, offset_base)	\ | 
|  | static void bcm74110_##name##_writel(struct bcm74110_mbox *mbox,\ | 
|  | u32 val, u32 off)		\ | 
|  | {								\ | 
|  | writel_relaxed(val, mbox->base + offset_base + off);	\ | 
|  | } | 
|  | BCM74110_OFFSET_IO_WRITEL_MACRO(tx, BCM_MBOX_BASE(mbox->tx_chan)); | 
|  | BCM74110_OFFSET_IO_WRITEL_MACRO(irq, BCM_MBOX_IRQ_BASE(mbox->rx_chan)); | 
|  |  | 
|  | #define BCM74110_OFFSET_IO_READL_MACRO(name, offset_base)	\ | 
|  | static u32 bcm74110_##name##_readl(struct bcm74110_mbox *mbox,	\ | 
|  | u32 off)			\ | 
|  | {								\ | 
|  | return readl_relaxed(mbox->base + offset_base + off);	\ | 
|  | } | 
|  | BCM74110_OFFSET_IO_READL_MACRO(tx, BCM_MBOX_BASE(mbox->tx_chan)); | 
|  | BCM74110_OFFSET_IO_READL_MACRO(rx, BCM_MBOX_BASE(mbox->rx_chan)); | 
|  | BCM74110_OFFSET_IO_READL_MACRO(irq, BCM_MBOX_IRQ_BASE(mbox->rx_chan)); | 
|  |  | 
|  | static inline struct bcm74110_mbox *bcm74110_mbox_from_cntrl( | 
|  | struct mbox_controller *cntrl) | 
|  | { | 
|  | return container_of(cntrl, struct bcm74110_mbox, controller); | 
|  | } | 
|  |  | 
|  | static void bcm74110_rx_push_init_msg(struct bcm74110_mbox *mbox, u32 val) | 
|  | { | 
|  | struct bcm74110_mbox_msg *msg; | 
|  |  | 
|  | msg = kzalloc(sizeof(*msg), GFP_ATOMIC); | 
|  | if (!msg) | 
|  | return; | 
|  |  | 
|  | INIT_LIST_HEAD(&msg->list_entry); | 
|  | msg->msg = val; | 
|  |  | 
|  | spin_lock(&mbox->rx_svc_list_lock); | 
|  | list_add_tail(&msg->list_entry, &mbox->rx_svc_init_list); | 
|  | spin_unlock(&mbox->rx_svc_list_lock); | 
|  | } | 
|  |  | 
|  | static void bcm74110_rx_process_msg(struct bcm74110_mbox *mbox) | 
|  | { | 
|  | struct device *dev = &mbox->pdev->dev; | 
|  | struct bcm74110_mbox_chan *chan_priv; | 
|  | struct mbox_chan *chan; | 
|  | u32 msg, status; | 
|  | int type; | 
|  |  | 
|  | do { | 
|  | msg = bcm74110_rx_readl(mbox, BCM_MBOX_RDATA); | 
|  | status = bcm74110_rx_readl(mbox, BCM_MBOX_STATUS0); | 
|  |  | 
|  | dev_dbg(dev, "rx: [{req=%lu|rply=%lu|srv=%lu|fn=%lu|length=%lu|slot=%lu]\n", | 
|  | BCM_MSG_GET_FIELD(msg, REQ), BCM_MSG_GET_FIELD(msg, RPLY), | 
|  | BCM_MSG_GET_FIELD(msg, SVC), BCM_MSG_GET_FIELD(msg, FUNC), | 
|  | BCM_MSG_GET_FIELD(msg, LENGTH), BCM_MSG_GET_FIELD(msg, SLOT)); | 
|  |  | 
|  | type = BCM_MSG_GET_FIELD(msg, SVC); | 
|  | switch (type) { | 
|  | case BCM_MSG_SVC_INIT: | 
|  | bcm74110_rx_push_init_msg(mbox, msg); | 
|  | break; | 
|  | case BCM_MSG_SVC_PMC: | 
|  | case BCM_MSG_SVC_SCMI: | 
|  | case BCM_MSG_SVC_DPFE: | 
|  | chan = &mbox->controller.chans[type]; | 
|  | chan_priv = chan->con_priv; | 
|  | if (chan_priv->en) | 
|  | mbox_chan_received_data(chan, NULL); | 
|  | else | 
|  | dev_warn(dev, "Channel not enabled\n"); | 
|  | break; | 
|  | default: | 
|  | dev_warn(dev, "Unsupported msg received\n"); | 
|  | } | 
|  | } while (status & BCM_MBOX_STATUS0_NOT_EMPTY); | 
|  | } | 
|  |  | 
|  | static irqreturn_t bcm74110_mbox_isr(int irq, void *data) | 
|  | { | 
|  | struct bcm74110_mbox *mbox = data; | 
|  | u32 status; | 
|  |  | 
|  | status = bcm74110_irq_readl(mbox, BCM_MBOX_IRQ_STATUS); | 
|  |  | 
|  | bcm74110_irq_writel(mbox, 0xffffffff, BCM_MBOX_IRQ_CLEAR); | 
|  |  | 
|  | if (status & BCM_MBOX_IRQ_NOT_EMPTY) | 
|  | bcm74110_rx_process_msg(mbox); | 
|  | else | 
|  | dev_warn(&mbox->pdev->dev, "Spurious interrupt\n"); | 
|  |  | 
|  | return IRQ_HANDLED; | 
|  | } | 
|  |  | 
|  | static void bcm74110_mbox_mask_and_clear(struct bcm74110_mbox *mbox) | 
|  | { | 
|  | bcm74110_irq_writel(mbox, 0xffffffff, BCM_MBOX_IRQ_MASK_SET); | 
|  | bcm74110_irq_writel(mbox, 0xffffffff, BCM_MBOX_IRQ_CLEAR); | 
|  | } | 
|  |  | 
|  | static int bcm74110_rx_pop_init_msg(struct bcm74110_mbox *mbox, u32 func_type, | 
|  | u32 *val) | 
|  | { | 
|  | struct bcm74110_mbox_msg *msg, *msg_tmp; | 
|  | unsigned long flags; | 
|  | bool found = false; | 
|  |  | 
|  | spin_lock_irqsave(&mbox->rx_svc_list_lock, flags); | 
|  | list_for_each_entry_safe(msg, msg_tmp, &mbox->rx_svc_init_list, | 
|  | list_entry) { | 
|  | if (BCM_MSG_GET_FIELD(msg->msg, FUNC) == func_type) { | 
|  | list_del(&msg->list_entry); | 
|  | found = true; | 
|  | break; | 
|  | } | 
|  | } | 
|  | spin_unlock_irqrestore(&mbox->rx_svc_list_lock, flags); | 
|  |  | 
|  | if (!found) | 
|  | return -EINVAL; | 
|  |  | 
|  | *val = msg->msg; | 
|  | kfree(msg); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static void bcm74110_rx_flush_msg(struct bcm74110_mbox *mbox) | 
|  | { | 
|  | struct bcm74110_mbox_msg *msg, *msg_tmp; | 
|  | LIST_HEAD(list_temp); | 
|  | unsigned long flags; | 
|  |  | 
|  | spin_lock_irqsave(&mbox->rx_svc_list_lock, flags); | 
|  | list_splice_init(&mbox->rx_svc_init_list, &list_temp); | 
|  | spin_unlock_irqrestore(&mbox->rx_svc_list_lock, flags); | 
|  |  | 
|  | list_for_each_entry_safe(msg, msg_tmp, &list_temp, list_entry) { | 
|  | list_del(&msg->list_entry); | 
|  | kfree(msg); | 
|  | } | 
|  | } | 
|  |  | 
|  | #define BCM_DEQUEUE_TIMEOUT_MS 30 | 
|  | static int bcm74110_rx_pop_init_msg_block(struct bcm74110_mbox *mbox, u32 func_type, | 
|  | u32 *val) | 
|  | { | 
|  | int ret, timeout = 0; | 
|  |  | 
|  | do { | 
|  | ret = bcm74110_rx_pop_init_msg(mbox, func_type, val); | 
|  |  | 
|  | if (!ret) | 
|  | return 0; | 
|  |  | 
|  | /* TODO: Figure out what is a good sleep here. */ | 
|  | usleep_range(1000, 2000); | 
|  | timeout++; | 
|  | } while (timeout < BCM_DEQUEUE_TIMEOUT_MS); | 
|  |  | 
|  | dev_warn(&mbox->pdev->dev, "Timeout waiting for service init response\n"); | 
|  | return -ETIMEDOUT; | 
|  | } | 
|  |  | 
|  | static int bcm74110_mbox_create_msg(int req, int rply, int svc, int func, | 
|  | int length, int slot) | 
|  | { | 
|  | u32 msg = 0; | 
|  |  | 
|  | BCM_MSG_SET_FIELD(msg, REQ, req); | 
|  | BCM_MSG_SET_FIELD(msg, RPLY, rply); | 
|  | BCM_MSG_SET_FIELD(msg, SVC, svc); | 
|  | BCM_MSG_SET_FIELD(msg, FUNC, func); | 
|  | BCM_MSG_SET_FIELD(msg, LENGTH, length); | 
|  | BCM_MSG_SET_FIELD(msg, SLOT, slot); | 
|  |  | 
|  | return msg; | 
|  | } | 
|  |  | 
|  | static int bcm74110_mbox_tx_msg(struct bcm74110_mbox *mbox, u32 msg) | 
|  | { | 
|  | int val; | 
|  |  | 
|  | /* We can potentially poll with timeout here instead */ | 
|  | val = bcm74110_tx_readl(mbox, BCM_MBOX_STATUS0); | 
|  | if (val & BCM_MBOX_STATUS0_FULL) { | 
|  | dev_err(&mbox->pdev->dev, "Mailbox full\n"); | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | dev_dbg(&mbox->pdev->dev, "tx: [{req=%lu|rply=%lu|srv=%lu|fn=%lu|length=%lu|slot=%lu]\n", | 
|  | BCM_MSG_GET_FIELD(msg, REQ), BCM_MSG_GET_FIELD(msg, RPLY), | 
|  | BCM_MSG_GET_FIELD(msg, SVC), BCM_MSG_GET_FIELD(msg, FUNC), | 
|  | BCM_MSG_GET_FIELD(msg, LENGTH), BCM_MSG_GET_FIELD(msg, SLOT)); | 
|  |  | 
|  | bcm74110_tx_writel(mbox, msg, BCM_MBOX_WDATA); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | #define BCM_MBOX_LINK_TRAINING_RETRIES	5 | 
|  | static int bcm74110_mbox_link_training(struct bcm74110_mbox *mbox) | 
|  | { | 
|  | int ret, retries = 0; | 
|  | u32 msg = 0, orig_len = 0, len = BCM_LINK_CODE0; | 
|  |  | 
|  | do { | 
|  | switch (len) { | 
|  | case 0: | 
|  | retries++; | 
|  | dev_warn(&mbox->pdev->dev, | 
|  | "Link train failed, trying again... %d\n", | 
|  | retries); | 
|  | if (retries > BCM_MBOX_LINK_TRAINING_RETRIES) | 
|  | return -EINVAL; | 
|  | len = BCM_LINK_CODE0; | 
|  | fallthrough; | 
|  | case BCM_LINK_CODE0: | 
|  | case BCM_LINK_CODE1: | 
|  | case BCM_LINK_CODE2: | 
|  | msg = bcm74110_mbox_create_msg(1, 0, BCM_MSG_SVC_INIT, | 
|  | BCM_MSG_FUNC_LINK_START, | 
|  | len, BCM_MSG_SVC_INIT); | 
|  | break; | 
|  | default: | 
|  | break; | 
|  | } | 
|  |  | 
|  | bcm74110_mbox_tx_msg(mbox, msg); | 
|  |  | 
|  | /* No response expected for LINK_CODE2 */ | 
|  | if (len == BCM_LINK_CODE2) | 
|  | return 0; | 
|  |  | 
|  | orig_len = len; | 
|  |  | 
|  | ret = bcm74110_rx_pop_init_msg_block(mbox, | 
|  | BCM_MSG_GET_FIELD(msg, FUNC), | 
|  | &msg); | 
|  | if (ret) { | 
|  | len = 0; | 
|  | continue; | 
|  | } | 
|  |  | 
|  | if ((BCM_MSG_GET_FIELD(msg, SVC) != BCM_MSG_SVC_INIT) || | 
|  | (BCM_MSG_GET_FIELD(msg, FUNC) != BCM_MSG_FUNC_LINK_START) || | 
|  | (BCM_MSG_GET_FIELD(msg, SLOT) != 0) || | 
|  | (BCM_MSG_GET_FIELD(msg, RPLY) != 1) || | 
|  | (BCM_MSG_GET_FIELD(msg, REQ) != 0)) { | 
|  | len = 0; | 
|  | continue; | 
|  | } | 
|  |  | 
|  | len = BCM_MSG_GET_FIELD(msg, LENGTH); | 
|  |  | 
|  | /* Make sure sequence is good */ | 
|  | if (len != (orig_len + 1)) { | 
|  | len = 0; | 
|  | continue; | 
|  | } | 
|  | } while (1); | 
|  |  | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | static int bcm74110_mbox_tx_msg_and_wait_ack(struct bcm74110_mbox *mbox, u32 msg) | 
|  | { | 
|  | int ret; | 
|  | u32 recv_msg; | 
|  |  | 
|  | ret = bcm74110_mbox_tx_msg(mbox, msg); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | ret = bcm74110_rx_pop_init_msg_block(mbox, BCM_MSG_GET_FIELD(msg, FUNC), | 
|  | &recv_msg); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | /* | 
|  | * Modify tx message to verify rx ack. | 
|  | * Flip RPLY/REQ for synchronous messages | 
|  | */ | 
|  | if (BCM_MSG_GET_FIELD(msg, REQ) == 1) { | 
|  | BCM_MSG_SET_FIELD(msg, RPLY, 1); | 
|  | BCM_MSG_SET_FIELD(msg, REQ, 0); | 
|  | } | 
|  |  | 
|  | if (msg != recv_msg) { | 
|  | dev_err(&mbox->pdev->dev, "Found ack, but ack is invalid\n"); | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* Each index points to 0x100 of HAB MEM. IDX size counts from 0 */ | 
|  | #define BCM_MBOX_HAB_MEM_IDX_START	0x30 | 
|  | #define BCM_MBOX_HAB_MEM_IDX_SIZE	0x0 | 
|  | static int bcm74110_mbox_shmem_init(struct bcm74110_mbox *mbox) | 
|  | { | 
|  | u32 msg = 0; | 
|  | int ret; | 
|  |  | 
|  | msg = bcm74110_mbox_create_msg(1, 0, BCM_MSG_SVC_INIT, | 
|  | BCM_MSG_FUNC_SHMEM_STOP, | 
|  | 0, BCM_MSG_SVC_INIT); | 
|  | ret = bcm74110_mbox_tx_msg_and_wait_ack(mbox, msg); | 
|  | if (ret) | 
|  | return -EINVAL; | 
|  |  | 
|  | msg = bcm74110_mbox_create_msg(1, 0, BCM_MSG_SVC_INIT, | 
|  | BCM_MSG_FUNC_SHMEM_TX, | 
|  | BCM_MBOX_HAB_MEM_IDX_START, | 
|  | BCM_MBOX_HAB_MEM_IDX_SIZE); | 
|  | ret = bcm74110_mbox_tx_msg_and_wait_ack(mbox, msg); | 
|  | if (ret) | 
|  | return -EINVAL; | 
|  |  | 
|  | msg = bcm74110_mbox_create_msg(1, 0, BCM_MSG_SVC_INIT, | 
|  | BCM_MSG_FUNC_SHMEM_RX, | 
|  | BCM_MBOX_HAB_MEM_IDX_START, | 
|  | BCM_MBOX_HAB_MEM_IDX_SIZE); | 
|  | ret = bcm74110_mbox_tx_msg_and_wait_ack(mbox, msg); | 
|  | if (ret) | 
|  | return -EINVAL; | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int bcm74110_mbox_init(struct bcm74110_mbox *mbox) | 
|  | { | 
|  | int ret = 0; | 
|  |  | 
|  | /* Disable queues tx/rx */ | 
|  | bcm74110_tx_writel(mbox, 0x0, BCM_MBOX_CTRL); | 
|  |  | 
|  | /* Clear status & restart tx/rx*/ | 
|  | bcm74110_tx_writel(mbox, BCM_MBOX_CTRL_EN | BCM_MBOX_CTRL_CLR, | 
|  | BCM_MBOX_CTRL); | 
|  |  | 
|  | /* Unmask irq */ | 
|  | bcm74110_irq_writel(mbox, BCM_MBOX_IRQ_NOT_EMPTY, BCM_MBOX_IRQ_MASK_CLEAR); | 
|  |  | 
|  | ret = bcm74110_mbox_link_training(mbox); | 
|  | if (ret) { | 
|  | dev_err(&mbox->pdev->dev, "Training failed\n"); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | return bcm74110_mbox_shmem_init(mbox); | 
|  | } | 
|  |  | 
|  | static int bcm74110_mbox_send_data(struct mbox_chan *chan, void *data) | 
|  | { | 
|  | struct bcm74110_mbox_chan *chan_priv = chan->con_priv; | 
|  | u32 msg; | 
|  |  | 
|  | switch (chan_priv->type) { | 
|  | case BCM_MSG_SVC_PMC: | 
|  | case BCM_MSG_SVC_SCMI: | 
|  | case BCM_MSG_SVC_DPFE: | 
|  | msg = bcm74110_mbox_create_msg(1, 0, chan_priv->type, 0, | 
|  | 128 + 28, chan_priv->slot); | 
|  | break; | 
|  | default: | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | return bcm74110_mbox_tx_msg(chan_priv->mbox, msg); | 
|  | } | 
|  |  | 
|  | static int bcm74110_mbox_chan_startup(struct mbox_chan *chan) | 
|  | { | 
|  | struct bcm74110_mbox_chan *chan_priv = chan->con_priv; | 
|  |  | 
|  | chan_priv->en = true; | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static void bcm74110_mbox_chan_shutdown(struct mbox_chan *chan) | 
|  | { | 
|  | struct bcm74110_mbox_chan *chan_priv = chan->con_priv; | 
|  |  | 
|  | chan_priv->en = false; | 
|  | } | 
|  |  | 
|  | static const struct mbox_chan_ops bcm74110_mbox_chan_ops = { | 
|  | .send_data = bcm74110_mbox_send_data, | 
|  | .startup = bcm74110_mbox_chan_startup, | 
|  | .shutdown = bcm74110_mbox_chan_shutdown, | 
|  | }; | 
|  |  | 
|  | static void bcm74110_mbox_shutdown(struct platform_device *pdev) | 
|  | { | 
|  | struct bcm74110_mbox *mbox = dev_get_drvdata(&pdev->dev); | 
|  | u32 msg; | 
|  |  | 
|  | msg = bcm74110_mbox_create_msg(1, 0, BCM_MSG_SVC_INIT, | 
|  | BCM_MSG_FUNC_LINK_STOP, | 
|  | 0, 0); | 
|  |  | 
|  | bcm74110_mbox_tx_msg_and_wait_ack(mbox, msg); | 
|  |  | 
|  | /* Even if we don't receive ACK, lets shut it down */ | 
|  |  | 
|  | bcm74110_mbox_mask_and_clear(mbox); | 
|  |  | 
|  | /* Disable queues tx/rx */ | 
|  | bcm74110_tx_writel(mbox, 0x0, BCM_MBOX_CTRL); | 
|  |  | 
|  | /* Flush queues */ | 
|  | bcm74110_rx_flush_msg(mbox); | 
|  | } | 
|  |  | 
|  | static struct mbox_chan *bcm74110_mbox_of_xlate(struct mbox_controller *cntrl, | 
|  | const struct of_phandle_args *p) | 
|  | { | 
|  | struct bcm74110_mbox *mbox = bcm74110_mbox_from_cntrl(cntrl); | 
|  | struct device *dev = &mbox->pdev->dev; | 
|  | struct bcm74110_mbox_chan *chan_priv; | 
|  | int slot, type; | 
|  |  | 
|  | if (p->args_count != 2) { | 
|  | dev_err(dev, "Invalid arguments\n"); | 
|  | return ERR_PTR(-EINVAL); | 
|  | } | 
|  |  | 
|  | type = p->args[0]; | 
|  | slot = p->args[1]; | 
|  |  | 
|  | switch (type) { | 
|  | case BCM_MSG_SVC_PMC: | 
|  | case BCM_MSG_SVC_SCMI: | 
|  | case BCM_MSG_SVC_DPFE: | 
|  | if (slot > BCM_MBOX_HAB_MEM_IDX_SIZE) { | 
|  | dev_err(dev, "Not enough shared memory\n"); | 
|  | return ERR_PTR(-EINVAL); | 
|  | } | 
|  | chan_priv = cntrl->chans[type].con_priv; | 
|  | chan_priv->slot = slot; | 
|  | chan_priv->type = type; | 
|  | break; | 
|  | default: | 
|  | dev_err(dev, "Invalid channel type: %d\n", type); | 
|  | return ERR_PTR(-EINVAL); | 
|  | } | 
|  |  | 
|  | return &cntrl->chans[type]; | 
|  | } | 
|  |  | 
|  | static int bcm74110_mbox_probe(struct platform_device *pdev) | 
|  | { | 
|  | struct device *dev = &pdev->dev; | 
|  | struct bcm74110_mbox *mbox; | 
|  | int i, ret; | 
|  |  | 
|  | mbox = devm_kzalloc(dev, sizeof(*mbox), GFP_KERNEL); | 
|  | if (!mbox) | 
|  | return -ENOMEM; | 
|  |  | 
|  | mbox->pdev = pdev; | 
|  | platform_set_drvdata(pdev, mbox); | 
|  |  | 
|  | mbox->base = devm_platform_ioremap_resource(pdev, 0); | 
|  | if (IS_ERR(mbox->base)) | 
|  | return dev_err_probe(dev, PTR_ERR(mbox->base), "Failed to iomap\n"); | 
|  |  | 
|  | ret = of_property_read_u32(dev->of_node, "brcm,tx", &mbox->tx_chan); | 
|  | if (ret) | 
|  | return dev_err_probe(dev, ret, "Failed to find tx channel\n"); | 
|  |  | 
|  | ret = of_property_read_u32(dev->of_node, "brcm,rx", &mbox->rx_chan); | 
|  | if (ret) | 
|  | return dev_err_probe(dev, ret, "Failed to find rx channel\n"); | 
|  |  | 
|  | mbox->rx_irq = platform_get_irq(pdev, 0); | 
|  | if (mbox->rx_irq < 0) | 
|  | return mbox->rx_irq; | 
|  |  | 
|  | INIT_LIST_HEAD(&mbox->rx_svc_init_list); | 
|  | spin_lock_init(&mbox->rx_svc_list_lock); | 
|  | bcm74110_mbox_mask_and_clear(mbox); | 
|  |  | 
|  | ret = devm_request_irq(dev, mbox->rx_irq, bcm74110_mbox_isr, | 
|  | IRQF_NO_SUSPEND, pdev->name, mbox); | 
|  | if (ret) | 
|  | return dev_err_probe(dev, ret, "Failed to request irq\n"); | 
|  |  | 
|  | mbox->controller.ops = &bcm74110_mbox_chan_ops; | 
|  | mbox->controller.dev = dev; | 
|  | mbox->controller.num_chans = BCM_MSG_SVC_MAX; | 
|  | mbox->controller.of_xlate = &bcm74110_mbox_of_xlate; | 
|  | mbox->controller.chans = devm_kcalloc(dev, BCM_MSG_SVC_MAX, | 
|  | sizeof(*mbox->controller.chans), | 
|  | GFP_KERNEL); | 
|  | if (!mbox->controller.chans) | 
|  | return -ENOMEM; | 
|  |  | 
|  | mbox->mbox_chan = devm_kcalloc(dev, BCM_MSG_SVC_MAX, | 
|  | sizeof(*mbox->mbox_chan), | 
|  | GFP_KERNEL); | 
|  | if (!mbox->mbox_chan) | 
|  | return -ENOMEM; | 
|  |  | 
|  | for (i = 0; i < BCM_MSG_SVC_MAX; i++) { | 
|  | mbox->mbox_chan[i].mbox = mbox; | 
|  | mbox->controller.chans[i].con_priv = &mbox->mbox_chan[i]; | 
|  | } | 
|  |  | 
|  | ret = devm_mbox_controller_register(dev, &mbox->controller); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | ret = bcm74110_mbox_init(mbox); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static const struct of_device_id bcm74110_mbox_of_match[] = { | 
|  | { .compatible = "brcm,bcm74110-mbox", }, | 
|  | { /* sentinel */ }, | 
|  | }; | 
|  | MODULE_DEVICE_TABLE(of, bcm74110_mbox_of_match); | 
|  |  | 
|  | static struct platform_driver bcm74110_mbox_driver = { | 
|  | .driver = { | 
|  | .name = "bcm74110-mbox", | 
|  | .of_match_table = bcm74110_mbox_of_match, | 
|  | }, | 
|  | .probe = bcm74110_mbox_probe, | 
|  | .shutdown = bcm74110_mbox_shutdown, | 
|  | }; | 
|  | module_platform_driver(bcm74110_mbox_driver); | 
|  |  | 
|  | MODULE_AUTHOR("Justin Chen <justin.chen@broadcom.com>"); | 
|  | MODULE_DESCRIPTION("BCM74110 mailbox driver"); | 
|  | MODULE_LICENSE("GPL"); |