1 // SPDX-License-Identifier: GPL-2.0
72 static bool mpfs_mbox_busy(struct mpfs_mbox *mbox)  in mpfs_mbox_busy()  argument
76 	status = readl_relaxed(mbox->mbox_base + SERVICES_SR_OFFSET);  in mpfs_mbox_busy()
83 	struct mpfs_mbox *mbox = (struct mpfs_mbox *)chan->con_priv;  in mpfs_mbox_send_data()  local
89 	mbox->response = msg->response;  in mpfs_mbox_send_data()
90 	mbox->resp_offset = msg->resp_offset;  in mpfs_mbox_send_data()
92 	if (mpfs_mbox_busy(mbox))  in mpfs_mbox_send_data()
93 		return -EBUSY;  in mpfs_mbox_send_data()
95 	if (msg->cmd_data_size) {  in mpfs_mbox_send_data()
97 		u8 extra_bits = msg->cmd_data_size & 3;  in mpfs_mbox_send_data()
98 		u32 *word_buf = (u32 *)msg->cmd_data;  in mpfs_mbox_send_data()
100 		for (index = 0; index < (msg->cmd_data_size / 4); index++)  in mpfs_mbox_send_data()
102 				       mbox->mbox_base + MAILBOX_REG_OFFSET + index * 0x4);  in mpfs_mbox_send_data()
105 			u8 byte_off = ALIGN_DOWN(msg->cmd_data_size, 4);  in mpfs_mbox_send_data()
106 			u8 *byte_buf = msg->cmd_data + byte_off;  in mpfs_mbox_send_data()
108 			val = readl_relaxed(mbox->mbox_base +  in mpfs_mbox_send_data()
117 				       mbox->mbox_base + MAILBOX_REG_OFFSET + index * 0x4);  in mpfs_mbox_send_data()
121 	opt_sel = ((msg->mbox_offset << 7u) | (msg->cmd_opcode & 0x7fu));  in mpfs_mbox_send_data()
124 	writel_relaxed(tx_trigger, mbox->mbox_base + SERVICES_CR_OFFSET);  in mpfs_mbox_send_data()
131 	struct mpfs_mbox *mbox = (struct mpfs_mbox *)chan->con_priv;  in mpfs_mbox_rx_data()  local
132 	struct mpfs_mss_response *response = mbox->response;  in mpfs_mbox_rx_data()
133 	u16 num_words = ALIGN((response->resp_size), (4)) / 4U;  in mpfs_mbox_rx_data()
136 	if (!response->resp_msg) {  in mpfs_mbox_rx_data()
137 		dev_err(mbox->dev, "failed to assign memory for response %d\n", -ENOMEM);  in mpfs_mbox_rx_data()
141 	if (!mpfs_mbox_busy(mbox)) {  in mpfs_mbox_rx_data()
143 			response->resp_msg[i] =  in mpfs_mbox_rx_data()
144 				readl_relaxed(mbox->mbox_base + MAILBOX_REG_OFFSET  in mpfs_mbox_rx_data()
145 					      + mbox->resp_offset + i * 0x4);  in mpfs_mbox_rx_data()
155 	struct mpfs_mbox *mbox = (struct mpfs_mbox *)chan->con_priv;  in mpfs_mbox_inbox_isr()  local
157 	writel_relaxed(0, mbox->int_reg);  in mpfs_mbox_inbox_isr()
167 	struct mpfs_mbox *mbox = (struct mpfs_mbox *)chan->con_priv;  in mpfs_mbox_startup()  local
170 	if (!mbox)  in mpfs_mbox_startup()
171 		return -EINVAL;  in mpfs_mbox_startup()
173 	ret = devm_request_irq(mbox->dev, mbox->irq, mpfs_mbox_inbox_isr, 0, "mpfs-mailbox", chan);  in mpfs_mbox_startup()
175 		dev_err(mbox->dev, "failed to register mailbox interrupt:%d\n", ret);  in mpfs_mbox_startup()
182 	struct mpfs_mbox *mbox = (struct mpfs_mbox *)chan->con_priv;  in mpfs_mbox_shutdown()  local
184 	devm_free_irq(mbox->dev, mbox->irq, chan);  in mpfs_mbox_shutdown()
195 	struct mpfs_mbox *mbox;  in mpfs_mbox_probe()  local
199 	mbox = devm_kzalloc(&pdev->dev, sizeof(*mbox), GFP_KERNEL);  in mpfs_mbox_probe()
200 	if (!mbox)  in mpfs_mbox_probe()
201 		return -ENOMEM;  in mpfs_mbox_probe()
203 	mbox->mbox_base = devm_platform_get_and_ioremap_resource(pdev, 0, &regs);  in mpfs_mbox_probe()
204 	if (IS_ERR(mbox->mbox_base))  in mpfs_mbox_probe()
205 		return PTR_ERR(mbox->mbox_base);  in mpfs_mbox_probe()
207 	mbox->int_reg = devm_platform_get_and_ioremap_resource(pdev, 1, &regs);  in mpfs_mbox_probe()
208 	if (IS_ERR(mbox->int_reg))  in mpfs_mbox_probe()
209 		return PTR_ERR(mbox->int_reg);  in mpfs_mbox_probe()
211 	mbox->irq = platform_get_irq(pdev, 0);  in mpfs_mbox_probe()
212 	if (mbox->irq < 0)  in mpfs_mbox_probe()
213 		return mbox->irq;  in mpfs_mbox_probe()
215 	mbox->dev = &pdev->dev;  in mpfs_mbox_probe()
217 	mbox->chans[0].con_priv = mbox;  in mpfs_mbox_probe()
218 	mbox->controller.dev = mbox->dev;  in mpfs_mbox_probe()
219 	mbox->controller.num_chans = 1;  in mpfs_mbox_probe()
220 	mbox->controller.chans = mbox->chans;  in mpfs_mbox_probe()
221 	mbox->controller.ops = &mpfs_mbox_ops;  in mpfs_mbox_probe()
222 	mbox->controller.txdone_irq = true;  in mpfs_mbox_probe()
224 	ret = devm_mbox_controller_register(&pdev->dev, &mbox->controller);  in mpfs_mbox_probe()
226 		dev_err(&pdev->dev, "Registering MPFS mailbox controller failed\n");  in mpfs_mbox_probe()
229 	dev_info(&pdev->dev, "Registered MPFS mailbox controller driver\n");  in mpfs_mbox_probe()
235 	{.compatible = "microchip,polarfire-soc-mailbox", },
242 		.name = "mpfs-mailbox",