^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Xilinx Inter Processor Interrupt(IPI) Mailbox Driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (C) 2018 Xilinx, Inc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/arm-smccc.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/interrupt.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/mailbox_controller.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/mailbox/zynqmp-ipi-message.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/of.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/of_address.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <linux/of_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <linux/of_irq.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) /* IPI agent ID any */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #define IPI_ID_ANY 0xFFUL
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) /* indicate if ZynqMP IPI mailbox driver uses SMC calls or HVC calls */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #define USE_SMC 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #define USE_HVC 1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) /* Default IPI SMC function IDs */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) #define SMC_IPI_MAILBOX_OPEN 0x82001000U
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) #define SMC_IPI_MAILBOX_RELEASE 0x82001001U
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) #define SMC_IPI_MAILBOX_STATUS_ENQUIRY 0x82001002U
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #define SMC_IPI_MAILBOX_NOTIFY 0x82001003U
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) #define SMC_IPI_MAILBOX_ACK 0x82001004U
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #define SMC_IPI_MAILBOX_ENABLE_IRQ 0x82001005U
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) #define SMC_IPI_MAILBOX_DISABLE_IRQ 0x82001006U
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) /* IPI SMC Macros */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #define IPI_SMC_ENQUIRY_DIRQ_MASK 0x00000001UL /* Flag to indicate if
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) * notification interrupt
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) * to be disabled.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) #define IPI_SMC_ACK_EIRQ_MASK 0x00000001UL /* Flag to indicate if
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) * notification interrupt
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) * to be enabled.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) /* IPI mailbox status */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) #define IPI_MB_STATUS_IDLE 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) #define IPI_MB_STATUS_SEND_PENDING 1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) #define IPI_MB_STATUS_RECV_PENDING 2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) #define IPI_MB_CHNL_TX 0 /* IPI mailbox TX channel */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) #define IPI_MB_CHNL_RX 1 /* IPI mailbox RX channel */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) * struct zynqmp_ipi_mchan - Description of a Xilinx ZynqMP IPI mailbox channel
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) * @is_opened: indicate if the IPI channel is opened
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) * @req_buf: local to remote request buffer start address
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) * @resp_buf: local to remote response buffer start address
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) * @req_buf_size: request buffer size
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) * @resp_buf_size: response buffer size
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) * @rx_buf: receive buffer to pass received message to client
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) * @chan_type: channel type
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) struct zynqmp_ipi_mchan {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) int is_opened;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) void __iomem *req_buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) void __iomem *resp_buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) void *rx_buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) size_t req_buf_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) size_t resp_buf_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) unsigned int chan_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) * struct zynqmp_ipi_mbox - Description of a ZynqMP IPI mailbox
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) * platform data.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) * @pdata: pointer to the IPI private data
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) * @dev: device pointer corresponding to the Xilinx ZynqMP
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) * IPI mailbox
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) * @remote_id: remote IPI agent ID
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) * @mbox: mailbox Controller
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) * @mchans: array for channels, tx channel and rx channel.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) * @irq: IPI agent interrupt ID
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) struct zynqmp_ipi_mbox {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) struct zynqmp_ipi_pdata *pdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) struct device dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) u32 remote_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) struct mbox_controller mbox;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) struct zynqmp_ipi_mchan mchans[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) * struct zynqmp_ipi_pdata - Description of z ZynqMP IPI agent platform data.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) * @dev: device pointer corresponding to the Xilinx ZynqMP
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) * IPI agent
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) * @irq: IPI agent interrupt ID
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) * @method: IPI SMC or HVC is going to be used
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) * @local_id: local IPI agent ID
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) * @num_mboxes: number of mailboxes of this IPI agent
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) * @ipi_mboxes: IPI mailboxes of this IPI agent
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) struct zynqmp_ipi_pdata {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) struct device *dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) int irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) unsigned int method;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) u32 local_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) int num_mboxes;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) struct zynqmp_ipi_mbox *ipi_mboxes;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) static struct device_driver zynqmp_ipi_mbox_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) .name = "zynqmp-ipi-mbox",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) static void zynqmp_ipi_fw_call(struct zynqmp_ipi_mbox *ipi_mbox,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) unsigned long a0, unsigned long a3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) struct arm_smccc_res *res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) struct zynqmp_ipi_pdata *pdata = ipi_mbox->pdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) unsigned long a1, a2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) a1 = pdata->local_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) a2 = ipi_mbox->remote_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) if (pdata->method == USE_SMC)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) arm_smccc_smc(a0, a1, a2, a3, 0, 0, 0, 0, res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) arm_smccc_hvc(a0, a1, a2, a3, 0, 0, 0, 0, res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) * zynqmp_ipi_interrupt - Interrupt handler for IPI notification
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) * @irq: Interrupt number
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) * @data: ZynqMP IPI mailbox platform data.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) * Return: -EINVAL if there is no instance
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) * IRQ_NONE if the interrupt is not ours.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) * IRQ_HANDLED if the rx interrupt was successfully handled.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) static irqreturn_t zynqmp_ipi_interrupt(int irq, void *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) struct zynqmp_ipi_pdata *pdata = data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) struct mbox_chan *chan;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) struct zynqmp_ipi_mbox *ipi_mbox;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) struct zynqmp_ipi_mchan *mchan;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) struct zynqmp_ipi_message *msg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) u64 arg0, arg3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) struct arm_smccc_res res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) int ret, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) (void)irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) arg0 = SMC_IPI_MAILBOX_STATUS_ENQUIRY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) arg3 = IPI_SMC_ENQUIRY_DIRQ_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) for (i = 0; i < pdata->num_mboxes; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) ipi_mbox = &pdata->ipi_mboxes[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) mchan = &ipi_mbox->mchans[IPI_MB_CHNL_RX];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) chan = &ipi_mbox->mbox.chans[IPI_MB_CHNL_RX];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) zynqmp_ipi_fw_call(ipi_mbox, arg0, arg3, &res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) ret = (int)(res.a0 & 0xFFFFFFFF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) if (ret > 0 && ret & IPI_MB_STATUS_RECV_PENDING) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) if (mchan->is_opened) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) msg = mchan->rx_buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) msg->len = mchan->req_buf_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) memcpy_fromio(msg->data, mchan->req_buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) msg->len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) mbox_chan_received_data(chan, (void *)msg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) return IRQ_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) return IRQ_NONE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) * zynqmp_ipi_peek_data - Peek to see if there are any rx messages.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) * @chan: Channel Pointer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) * Return: 'true' if there is pending rx data, 'false' if there is none.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) static bool zynqmp_ipi_peek_data(struct mbox_chan *chan)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) struct device *dev = chan->mbox->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) struct zynqmp_ipi_mbox *ipi_mbox = dev_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) struct zynqmp_ipi_mchan *mchan = chan->con_priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) u64 arg0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) struct arm_smccc_res res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) if (WARN_ON(!ipi_mbox)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) dev_err(dev, "no platform drv data??\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) return false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) arg0 = SMC_IPI_MAILBOX_STATUS_ENQUIRY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) zynqmp_ipi_fw_call(ipi_mbox, arg0, 0, &res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) ret = (int)(res.a0 & 0xFFFFFFFF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) if (mchan->chan_type == IPI_MB_CHNL_TX) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) /* TX channel, check if the message has been acked
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) * by the remote, if yes, response is available.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) if (ret < 0 || ret & IPI_MB_STATUS_SEND_PENDING)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) return false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) return true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) } else if (ret > 0 && ret & IPI_MB_STATUS_RECV_PENDING) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) /* RX channel, check if there is message arrived. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) return true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) return false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) * zynqmp_ipi_last_tx_done - See if the last tx message is sent
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) * @chan: Channel pointer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) * Return: 'true' is no pending tx data, 'false' if there are any.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) static bool zynqmp_ipi_last_tx_done(struct mbox_chan *chan)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) struct device *dev = chan->mbox->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) struct zynqmp_ipi_mbox *ipi_mbox = dev_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) struct zynqmp_ipi_mchan *mchan = chan->con_priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) u64 arg0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) struct arm_smccc_res res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) if (WARN_ON(!ipi_mbox)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) dev_err(dev, "no platform drv data??\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) return false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) if (mchan->chan_type == IPI_MB_CHNL_TX) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) /* We only need to check if the message been taken
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) * by the remote in the TX channel
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) arg0 = SMC_IPI_MAILBOX_STATUS_ENQUIRY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) zynqmp_ipi_fw_call(ipi_mbox, arg0, 0, &res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) /* Check the SMC call status, a0 of the result */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) ret = (int)(res.a0 & 0xFFFFFFFF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) if (ret < 0 || ret & IPI_MB_STATUS_SEND_PENDING)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) return false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) return true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) /* Always true for the response message in RX channel */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) return true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) * zynqmp_ipi_send_data - Send data
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) * @chan: Channel Pointer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) * @data: Message Pointer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) * Return: 0 if all goes good, else appropriate error messages.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) static int zynqmp_ipi_send_data(struct mbox_chan *chan, void *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) struct device *dev = chan->mbox->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) struct zynqmp_ipi_mbox *ipi_mbox = dev_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) struct zynqmp_ipi_mchan *mchan = chan->con_priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) struct zynqmp_ipi_message *msg = data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) u64 arg0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) struct arm_smccc_res res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) if (WARN_ON(!ipi_mbox)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) dev_err(dev, "no platform drv data??\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) if (mchan->chan_type == IPI_MB_CHNL_TX) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) /* Send request message */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) if (msg && msg->len > mchan->req_buf_size) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) dev_err(dev, "channel %d message length %u > max %lu\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) mchan->chan_type, (unsigned int)msg->len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) mchan->req_buf_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) if (msg && msg->len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) memcpy_toio(mchan->req_buf, msg->data, msg->len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) /* Kick IPI mailbox to send message */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) arg0 = SMC_IPI_MAILBOX_NOTIFY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) zynqmp_ipi_fw_call(ipi_mbox, arg0, 0, &res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) /* Send response message */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) if (msg && msg->len > mchan->resp_buf_size) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) dev_err(dev, "channel %d message length %u > max %lu\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) mchan->chan_type, (unsigned int)msg->len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) mchan->resp_buf_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) if (msg && msg->len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) memcpy_toio(mchan->resp_buf, msg->data, msg->len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) arg0 = SMC_IPI_MAILBOX_ACK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) zynqmp_ipi_fw_call(ipi_mbox, arg0, IPI_SMC_ACK_EIRQ_MASK,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) &res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) * zynqmp_ipi_startup - Startup the IPI channel
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) * @chan: Channel pointer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) * Return: 0 if all goes good, else return corresponding error message
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) static int zynqmp_ipi_startup(struct mbox_chan *chan)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) struct device *dev = chan->mbox->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) struct zynqmp_ipi_mbox *ipi_mbox = dev_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) struct zynqmp_ipi_mchan *mchan = chan->con_priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) u64 arg0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) struct arm_smccc_res res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) unsigned int nchan_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) if (mchan->is_opened)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) /* If no channel has been opened, open the IPI mailbox */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) nchan_type = (mchan->chan_type + 1) % 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) if (!ipi_mbox->mchans[nchan_type].is_opened) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) arg0 = SMC_IPI_MAILBOX_OPEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) zynqmp_ipi_fw_call(ipi_mbox, arg0, 0, &res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) /* Check the SMC call status, a0 of the result */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) ret = (int)(res.a0 & 0xFFFFFFFF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) dev_err(dev, "SMC to open the IPI channel failed.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) /* If it is RX channel, enable the IPI notification interrupt */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) if (mchan->chan_type == IPI_MB_CHNL_RX) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) arg0 = SMC_IPI_MAILBOX_ENABLE_IRQ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) zynqmp_ipi_fw_call(ipi_mbox, arg0, 0, &res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) mchan->is_opened = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) * zynqmp_ipi_shutdown - Shutdown the IPI channel
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) * @chan: Channel pointer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) static void zynqmp_ipi_shutdown(struct mbox_chan *chan)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) struct device *dev = chan->mbox->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) struct zynqmp_ipi_mbox *ipi_mbox = dev_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) struct zynqmp_ipi_mchan *mchan = chan->con_priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) u64 arg0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) struct arm_smccc_res res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) unsigned int chan_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) if (!mchan->is_opened)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) /* If it is RX channel, disable notification interrupt */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) chan_type = mchan->chan_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) if (chan_type == IPI_MB_CHNL_RX) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) arg0 = SMC_IPI_MAILBOX_DISABLE_IRQ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) zynqmp_ipi_fw_call(ipi_mbox, arg0, 0, &res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) /* Release IPI mailbox if no other channel is opened */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) chan_type = (chan_type + 1) % 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) if (!ipi_mbox->mchans[chan_type].is_opened) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) arg0 = SMC_IPI_MAILBOX_RELEASE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) zynqmp_ipi_fw_call(ipi_mbox, arg0, 0, &res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) mchan->is_opened = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) /* ZynqMP IPI mailbox operations */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) static const struct mbox_chan_ops zynqmp_ipi_chan_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) .startup = zynqmp_ipi_startup,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) .shutdown = zynqmp_ipi_shutdown,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) .peek_data = zynqmp_ipi_peek_data,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) .last_tx_done = zynqmp_ipi_last_tx_done,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) .send_data = zynqmp_ipi_send_data,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) * zynqmp_ipi_of_xlate - Translate of phandle to IPI mailbox channel
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) * @mbox: mailbox controller pointer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) * @p: phandle pointer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) * Return: Mailbox channel, else return error pointer.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) static struct mbox_chan *zynqmp_ipi_of_xlate(struct mbox_controller *mbox,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) const struct of_phandle_args *p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) struct mbox_chan *chan;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) struct device *dev = mbox->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) unsigned int chan_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) /* Only supports TX and RX channels */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) chan_type = p->args[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) if (chan_type != IPI_MB_CHNL_TX && chan_type != IPI_MB_CHNL_RX) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) dev_err(dev, "req chnl failure: invalid chnl type %u.\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) chan_type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) return ERR_PTR(-EINVAL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) chan = &mbox->chans[chan_type];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) return chan;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) static const struct of_device_id zynqmp_ipi_of_match[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) { .compatible = "xlnx,zynqmp-ipi-mailbox" },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) {},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) MODULE_DEVICE_TABLE(of, zynqmp_ipi_of_match);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) * zynqmp_ipi_mbox_get_buf_res - Get buffer resource from the IPI dev node
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) * @node: IPI mbox device child node
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) * @name: name of the IPI buffer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) * @res: pointer to where the resource information will be stored.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) * Return: 0 for success, negative value for failure
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) static int zynqmp_ipi_mbox_get_buf_res(struct device_node *node,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) const char *name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) struct resource *res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) int ret, index;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) index = of_property_match_string(node, "reg-names", name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) if (index >= 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) ret = of_address_to_resource(node, index, res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) * zynqmp_ipi_mbox_dev_release() - release the existence of a ipi mbox dev
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) * @dev: the ipi mailbox device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) * This is to avoid the no device release() function kernel warning.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) static void zynqmp_ipi_mbox_dev_release(struct device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) (void)dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) * zynqmp_ipi_mbox_probe - probe IPI mailbox resource from device node
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) * @ipi_mbox: pointer to IPI mailbox private data structure
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) * @node: IPI mailbox device node
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) * Return: 0 for success, negative value for failure
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) static int zynqmp_ipi_mbox_probe(struct zynqmp_ipi_mbox *ipi_mbox,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) struct device_node *node)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) struct zynqmp_ipi_mchan *mchan;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) struct mbox_chan *chans;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) struct mbox_controller *mbox;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) struct resource res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) struct device *dev, *mdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) const char *name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) dev = ipi_mbox->pdata->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) /* Initialize dev for IPI mailbox */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) ipi_mbox->dev.parent = dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) ipi_mbox->dev.release = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) ipi_mbox->dev.of_node = node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) dev_set_name(&ipi_mbox->dev, "%s", of_node_full_name(node));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) dev_set_drvdata(&ipi_mbox->dev, ipi_mbox);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) ipi_mbox->dev.release = zynqmp_ipi_mbox_dev_release;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) ipi_mbox->dev.driver = &zynqmp_ipi_mbox_driver;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) ret = device_register(&ipi_mbox->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) dev_err(dev, "Failed to register ipi mbox dev.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) mdev = &ipi_mbox->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) mchan = &ipi_mbox->mchans[IPI_MB_CHNL_TX];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) name = "local_request_region";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) ret = zynqmp_ipi_mbox_get_buf_res(node, name, &res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) if (!ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) mchan->req_buf_size = resource_size(&res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) mchan->req_buf = devm_ioremap(mdev, res.start,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) mchan->req_buf_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) if (!mchan->req_buf) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) dev_err(mdev, "Unable to map IPI buffer I/O memory\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) } else if (ret != -ENODEV) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) dev_err(mdev, "Unmatched resource %s, %d.\n", name, ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) name = "remote_response_region";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) ret = zynqmp_ipi_mbox_get_buf_res(node, name, &res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) if (!ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) mchan->resp_buf_size = resource_size(&res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) mchan->resp_buf = devm_ioremap(mdev, res.start,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) mchan->resp_buf_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) if (!mchan->resp_buf) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) dev_err(mdev, "Unable to map IPI buffer I/O memory\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) } else if (ret != -ENODEV) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) dev_err(mdev, "Unmatched resource %s.\n", name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) mchan->rx_buf = devm_kzalloc(mdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) mchan->resp_buf_size +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) sizeof(struct zynqmp_ipi_message),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) if (!mchan->rx_buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) mchan = &ipi_mbox->mchans[IPI_MB_CHNL_RX];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) name = "remote_request_region";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) ret = zynqmp_ipi_mbox_get_buf_res(node, name, &res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) if (!ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) mchan->req_buf_size = resource_size(&res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) mchan->req_buf = devm_ioremap(mdev, res.start,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) mchan->req_buf_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) if (!mchan->req_buf) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) dev_err(mdev, "Unable to map IPI buffer I/O memory\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) } else if (ret != -ENODEV) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) dev_err(mdev, "Unmatched resource %s.\n", name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) name = "local_response_region";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) ret = zynqmp_ipi_mbox_get_buf_res(node, name, &res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) if (!ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) mchan->resp_buf_size = resource_size(&res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) mchan->resp_buf = devm_ioremap(mdev, res.start,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) mchan->resp_buf_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) if (!mchan->resp_buf) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) dev_err(mdev, "Unable to map IPI buffer I/O memory\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) } else if (ret != -ENODEV) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) dev_err(mdev, "Unmatched resource %s.\n", name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) mchan->rx_buf = devm_kzalloc(mdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) mchan->resp_buf_size +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) sizeof(struct zynqmp_ipi_message),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) if (!mchan->rx_buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) /* Get the IPI remote agent ID */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) ret = of_property_read_u32(node, "xlnx,ipi-id", &ipi_mbox->remote_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) dev_err(dev, "No IPI remote ID is specified.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) mbox = &ipi_mbox->mbox;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) mbox->dev = mdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) mbox->ops = &zynqmp_ipi_chan_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) mbox->num_chans = 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) mbox->txdone_irq = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) mbox->txdone_poll = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) mbox->txpoll_period = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) mbox->of_xlate = zynqmp_ipi_of_xlate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) chans = devm_kzalloc(mdev, 2 * sizeof(*chans), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) if (!chans)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) mbox->chans = chans;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) chans[IPI_MB_CHNL_TX].con_priv = &ipi_mbox->mchans[IPI_MB_CHNL_TX];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) chans[IPI_MB_CHNL_RX].con_priv = &ipi_mbox->mchans[IPI_MB_CHNL_RX];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) ipi_mbox->mchans[IPI_MB_CHNL_TX].chan_type = IPI_MB_CHNL_TX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) ipi_mbox->mchans[IPI_MB_CHNL_RX].chan_type = IPI_MB_CHNL_RX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) ret = devm_mbox_controller_register(mdev, mbox);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) dev_err(mdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) "Failed to register mbox_controller(%d)\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) dev_info(mdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) "Registered ZynqMP IPI mbox with TX/RX channels.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) * zynqmp_ipi_free_mboxes - Free IPI mailboxes devices
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) * @pdata: IPI private data
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) static void zynqmp_ipi_free_mboxes(struct zynqmp_ipi_pdata *pdata)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) struct zynqmp_ipi_mbox *ipi_mbox;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) i = pdata->num_mboxes;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) for (; i >= 0; i--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) ipi_mbox = &pdata->ipi_mboxes[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) if (ipi_mbox->dev.parent) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) mbox_controller_unregister(&ipi_mbox->mbox);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) device_unregister(&ipi_mbox->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) static int zynqmp_ipi_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) struct device *dev = &pdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) struct device_node *nc, *np = pdev->dev.of_node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) struct zynqmp_ipi_pdata *pdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) struct zynqmp_ipi_mbox *mbox;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) int num_mboxes, ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) num_mboxes = of_get_child_count(np);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) pdata = devm_kzalloc(dev, sizeof(*pdata) + (num_mboxes * sizeof(*mbox)),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) if (!pdata)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) pdata->dev = dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642) /* Get the IPI local agents ID */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) ret = of_property_read_u32(np, "xlnx,ipi-id", &pdata->local_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) dev_err(dev, "No IPI local ID is specified.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649) pdata->num_mboxes = num_mboxes;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) pdata->ipi_mboxes = (struct zynqmp_ipi_mbox *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) ((char *)pdata + sizeof(*pdata));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) mbox = pdata->ipi_mboxes;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) for_each_available_child_of_node(np, nc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) mbox->pdata = pdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656) ret = zynqmp_ipi_mbox_probe(mbox, nc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) dev_err(dev, "failed to probe subdev.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) goto free_mbox_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) mbox++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) /* IPI IRQ */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666) ret = platform_get_irq(pdev, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668) goto free_mbox_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) pdata->irq = ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) ret = devm_request_irq(dev, pdata->irq, zynqmp_ipi_interrupt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) IRQF_SHARED, dev_name(dev), pdata);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) dev_err(dev, "IRQ %d is not requested successfully.\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) pdata->irq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) goto free_mbox_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679) platform_set_drvdata(pdev, pdata);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) free_mbox_dev:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) zynqmp_ipi_free_mboxes(pdata);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) static int zynqmp_ipi_remove(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) struct zynqmp_ipi_pdata *pdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) pdata = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) zynqmp_ipi_free_mboxes(pdata);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697) static struct platform_driver zynqmp_ipi_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) .probe = zynqmp_ipi_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699) .remove = zynqmp_ipi_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701) .name = "zynqmp-ipi",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702) .of_match_table = of_match_ptr(zynqmp_ipi_of_match),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) static int __init zynqmp_ipi_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708) return platform_driver_register(&zynqmp_ipi_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710) subsys_initcall(zynqmp_ipi_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712) static void __exit zynqmp_ipi_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) platform_driver_unregister(&zynqmp_ipi_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716) module_exit(zynqmp_ipi_exit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718) MODULE_LICENSE("GPL v2");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) MODULE_DESCRIPTION("Xilinx ZynqMP IPI Mailbox driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720) MODULE_AUTHOR("Xilinx Inc.");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags