drivers/mailbox/mailbox-mpfs.c

74 static bool mpfs_mbox_busy(struct mpfs_mbox *mbox)
78 	status = readl_relaxed(mbox->ctrl_base + SERVICES_SR_OFFSET);
85 	struct mpfs_mbox *mbox = (struct mpfs_mbox *)chan->con_priv;
86 	struct mpfs_mss_response *response = mbox->response;
89 	if (mpfs_mbox_busy(mbox))
98 	val = readl_relaxed(mbox->ctrl_base + SERVICES_SR_OFFSET);
106 	struct mpfs_mbox *mbox = (struct mpfs_mbox *)chan->con_priv;
112 	mbox->response = msg->response;
113 	mbox->resp_offset = msg->resp_offset;
115 	if (mpfs_mbox_busy(mbox))
125 				       mbox->mbox_base + msg->mbox_offset + index * 0x4);
131 			val = readl_relaxed(mbox->mbox_base + msg->mbox_offset + index * 0x4);
138 			writel_relaxed(val, mbox->mbox_base + msg->mbox_offset + index * 0x4);
146 	writel_relaxed(tx_trigger, mbox->ctrl_base + SERVICES_CR_OFFSET);
153 	struct mpfs_mbox *mbox = (struct mpfs_mbox *)chan->con_priv;
154 	struct mpfs_mss_response *response = mbox->response;
159 		dev_err(mbox->dev, "failed to assign memory for response %d\n", -ENOMEM);
168 	if (mpfs_mbox_busy(mbox)) {
169 		dev_err(mbox->dev, "got an interrupt but system controller is busy\n");
176 			readl_relaxed(mbox->mbox_base
177 				      + mbox->resp_offset + i * 0x4);
186 	struct mpfs_mbox *mbox = (struct mpfs_mbox *)chan->con_priv;
188 	writel_relaxed(0, mbox->int_reg);
197 	struct mpfs_mbox *mbox = (struct mpfs_mbox *)chan->con_priv;
200 	if (!mbox)
203 	ret = devm_request_irq(mbox->dev, mbox->irq, mpfs_mbox_inbox_isr, 0, "mpfs-mailbox", chan);
205 		dev_err(mbox->dev, "failed to register mailbox interrupt:%d\n", ret);
212 	struct mpfs_mbox *mbox = (struct mpfs_mbox *)chan->con_priv;
214 	devm_free_irq(mbox->dev, mbox->irq, chan);
226 	struct mpfs_mbox *mbox;
230 	mbox = devm_kzalloc(&pdev->dev, sizeof(*mbox), GFP_KERNEL);
231 	if (!mbox)
234 	mbox->ctrl_base = devm_platform_get_and_ioremap_resource(pdev, 0, &regs);
235 	if (IS_ERR(mbox->ctrl_base))
236 		return PTR_ERR(mbox->ctrl_base);
238 	mbox->int_reg = devm_platform_get_and_ioremap_resource(pdev, 1, &regs);
239 	if (IS_ERR(mbox->int_reg))
240 		return PTR_ERR(mbox->int_reg);
242 	mbox->mbox_base = devm_platform_get_and_ioremap_resource(pdev, 2, &regs);
243 	if (IS_ERR(mbox->mbox_base)) // account for the old dt-binding w/ 2 regs
244 		mbox->mbox_base = mbox->ctrl_base + MAILBOX_REG_OFFSET;
246 	mbox->irq = platform_get_irq(pdev, 0);
247 	if (mbox->irq < 0)
248 		return mbox->irq;
250 	mbox->dev = &pdev->dev;
252 	mbox->chans[0].con_priv = mbox;
253 	mbox->controller.dev = mbox->dev;
254 	mbox->controller.num_chans = 1;
255 	mbox->controller.chans = mbox->chans;
256 	mbox->controller.ops = &mpfs_mbox_ops;
257 	mbox->controller.txdone_poll = true;
258 	mbox->controller.txpoll_period = 10u;
260 	ret = devm_mbox_controller_register(&pdev->dev, &mbox->controller);