122094814SBjorn Andersson // SPDX-License-Identifier: GPL-2.0
222094814SBjorn Andersson /*
322094814SBjorn Andersson * Copyright (c) 2019, Linaro Ltd
422094814SBjorn Andersson */
522094814SBjorn Andersson #include <linux/clk-provider.h>
622094814SBjorn Andersson #include <linux/interrupt.h>
722094814SBjorn Andersson #include <linux/io.h>
822094814SBjorn Andersson #include <linux/mailbox_client.h>
922094814SBjorn Andersson #include <linux/module.h>
108c75d585SDeepak Kumar Singh #include <linux/of_platform.h>
1122094814SBjorn Andersson #include <linux/platform_device.h>
1205589b30SThara Gopinath #include <linux/thermal.h>
1305589b30SThara Gopinath #include <linux/slab.h>
148c75d585SDeepak Kumar Singh #include <linux/soc/qcom/qcom_aoss.h>
1522094814SBjorn Andersson
1622094814SBjorn Andersson #define QMP_DESC_MAGIC 0x0
1722094814SBjorn Andersson #define QMP_DESC_VERSION 0x4
1822094814SBjorn Andersson #define QMP_DESC_FEATURES 0x8
1922094814SBjorn Andersson
2022094814SBjorn Andersson /* AOP-side offsets */
2122094814SBjorn Andersson #define QMP_DESC_UCORE_LINK_STATE 0xc
2222094814SBjorn Andersson #define QMP_DESC_UCORE_LINK_STATE_ACK 0x10
2322094814SBjorn Andersson #define QMP_DESC_UCORE_CH_STATE 0x14
2422094814SBjorn Andersson #define QMP_DESC_UCORE_CH_STATE_ACK 0x18
2522094814SBjorn Andersson #define QMP_DESC_UCORE_MBOX_SIZE 0x1c
2622094814SBjorn Andersson #define QMP_DESC_UCORE_MBOX_OFFSET 0x20
2722094814SBjorn Andersson
2822094814SBjorn Andersson /* Linux-side offsets */
2922094814SBjorn Andersson #define QMP_DESC_MCORE_LINK_STATE 0x24
3022094814SBjorn Andersson #define QMP_DESC_MCORE_LINK_STATE_ACK 0x28
3122094814SBjorn Andersson #define QMP_DESC_MCORE_CH_STATE 0x2c
3222094814SBjorn Andersson #define QMP_DESC_MCORE_CH_STATE_ACK 0x30
3322094814SBjorn Andersson #define QMP_DESC_MCORE_MBOX_SIZE 0x34
3422094814SBjorn Andersson #define QMP_DESC_MCORE_MBOX_OFFSET 0x38
3522094814SBjorn Andersson
3622094814SBjorn Andersson #define QMP_STATE_UP GENMASK(15, 0)
3722094814SBjorn Andersson #define QMP_STATE_DOWN GENMASK(31, 16)
3822094814SBjorn Andersson
3922094814SBjorn Andersson #define QMP_MAGIC 0x4d41494c /* mail */
4022094814SBjorn Andersson #define QMP_VERSION 1
4122094814SBjorn Andersson
4222094814SBjorn Andersson /* 64 bytes is enough to store the requests and provides padding to 4 bytes */
4322094814SBjorn Andersson #define QMP_MSG_LEN 64
4422094814SBjorn Andersson
4505589b30SThara Gopinath #define QMP_NUM_COOLING_RESOURCES 2
4605589b30SThara Gopinath
47c55b5c66SThara Gopinath static bool qmp_cdev_max_state = 1;
4805589b30SThara Gopinath
4905589b30SThara Gopinath struct qmp_cooling_device {
5005589b30SThara Gopinath struct thermal_cooling_device *cdev;
5105589b30SThara Gopinath struct qmp *qmp;
5205589b30SThara Gopinath char *name;
5305589b30SThara Gopinath bool state;
5405589b30SThara Gopinath };
5505589b30SThara Gopinath
5622094814SBjorn Andersson /**
5722094814SBjorn Andersson * struct qmp - driver state for QMP implementation
5822094814SBjorn Andersson * @msgram: iomem referencing the message RAM used for communication
5922094814SBjorn Andersson * @dev: reference to QMP device
6022094814SBjorn Andersson * @mbox_client: mailbox client used to ring the doorbell on transmit
6122094814SBjorn Andersson * @mbox_chan: mailbox channel used to ring the doorbell on transmit
6222094814SBjorn Andersson * @offset: offset within @msgram where messages should be written
6322094814SBjorn Andersson * @size: maximum size of the messages to be transmitted
6422094814SBjorn Andersson * @event: wait_queue for synchronization with the IRQ
6522094814SBjorn Andersson * @tx_lock: provides synchronization between multiple callers of qmp_send()
6622094814SBjorn Andersson * @qdss_clk: QDSS clock hw struct
6796ec310dSLee Jones * @cooling_devs: thermal cooling devices
6822094814SBjorn Andersson */
6922094814SBjorn Andersson struct qmp {
7022094814SBjorn Andersson void __iomem *msgram;
7122094814SBjorn Andersson struct device *dev;
7222094814SBjorn Andersson
7322094814SBjorn Andersson struct mbox_client mbox_client;
7422094814SBjorn Andersson struct mbox_chan *mbox_chan;
7522094814SBjorn Andersson
7622094814SBjorn Andersson size_t offset;
7722094814SBjorn Andersson size_t size;
7822094814SBjorn Andersson
7922094814SBjorn Andersson wait_queue_head_t event;
8022094814SBjorn Andersson
8122094814SBjorn Andersson struct mutex tx_lock;
8222094814SBjorn Andersson
8322094814SBjorn Andersson struct clk_hw qdss_clk;
8405589b30SThara Gopinath struct qmp_cooling_device *cooling_devs;
8522094814SBjorn Andersson };
8622094814SBjorn Andersson
qmp_kick(struct qmp * qmp)8722094814SBjorn Andersson static void qmp_kick(struct qmp *qmp)
8822094814SBjorn Andersson {
8922094814SBjorn Andersson mbox_send_message(qmp->mbox_chan, NULL);
9022094814SBjorn Andersson mbox_client_txdone(qmp->mbox_chan, 0);
9122094814SBjorn Andersson }
9222094814SBjorn Andersson
qmp_magic_valid(struct qmp * qmp)9322094814SBjorn Andersson static bool qmp_magic_valid(struct qmp *qmp)
9422094814SBjorn Andersson {
9522094814SBjorn Andersson return readl(qmp->msgram + QMP_DESC_MAGIC) == QMP_MAGIC;
9622094814SBjorn Andersson }
9722094814SBjorn Andersson
qmp_link_acked(struct qmp * qmp)9822094814SBjorn Andersson static bool qmp_link_acked(struct qmp *qmp)
9922094814SBjorn Andersson {
10022094814SBjorn Andersson return readl(qmp->msgram + QMP_DESC_MCORE_LINK_STATE_ACK) == QMP_STATE_UP;
10122094814SBjorn Andersson }
10222094814SBjorn Andersson
qmp_mcore_channel_acked(struct qmp * qmp)10322094814SBjorn Andersson static bool qmp_mcore_channel_acked(struct qmp *qmp)
10422094814SBjorn Andersson {
10522094814SBjorn Andersson return readl(qmp->msgram + QMP_DESC_MCORE_CH_STATE_ACK) == QMP_STATE_UP;
10622094814SBjorn Andersson }
10722094814SBjorn Andersson
qmp_ucore_channel_up(struct qmp * qmp)10822094814SBjorn Andersson static bool qmp_ucore_channel_up(struct qmp *qmp)
10922094814SBjorn Andersson {
11022094814SBjorn Andersson return readl(qmp->msgram + QMP_DESC_UCORE_CH_STATE) == QMP_STATE_UP;
11122094814SBjorn Andersson }
11222094814SBjorn Andersson
qmp_open(struct qmp * qmp)11322094814SBjorn Andersson static int qmp_open(struct qmp *qmp)
11422094814SBjorn Andersson {
11522094814SBjorn Andersson int ret;
11622094814SBjorn Andersson u32 val;
11722094814SBjorn Andersson
11822094814SBjorn Andersson if (!qmp_magic_valid(qmp)) {
11922094814SBjorn Andersson dev_err(qmp->dev, "QMP magic doesn't match\n");
12022094814SBjorn Andersson return -EINVAL;
12122094814SBjorn Andersson }
12222094814SBjorn Andersson
12322094814SBjorn Andersson val = readl(qmp->msgram + QMP_DESC_VERSION);
12422094814SBjorn Andersson if (val != QMP_VERSION) {
12522094814SBjorn Andersson dev_err(qmp->dev, "unsupported QMP version %d\n", val);
12622094814SBjorn Andersson return -EINVAL;
12722094814SBjorn Andersson }
12822094814SBjorn Andersson
12922094814SBjorn Andersson qmp->offset = readl(qmp->msgram + QMP_DESC_MCORE_MBOX_OFFSET);
13022094814SBjorn Andersson qmp->size = readl(qmp->msgram + QMP_DESC_MCORE_MBOX_SIZE);
13122094814SBjorn Andersson if (!qmp->size) {
13222094814SBjorn Andersson dev_err(qmp->dev, "invalid mailbox size\n");
13322094814SBjorn Andersson return -EINVAL;
13422094814SBjorn Andersson }
13522094814SBjorn Andersson
13622094814SBjorn Andersson /* Ack remote core's link state */
13722094814SBjorn Andersson val = readl(qmp->msgram + QMP_DESC_UCORE_LINK_STATE);
13822094814SBjorn Andersson writel(val, qmp->msgram + QMP_DESC_UCORE_LINK_STATE_ACK);
13922094814SBjorn Andersson
14022094814SBjorn Andersson /* Set local core's link state to up */
14122094814SBjorn Andersson writel(QMP_STATE_UP, qmp->msgram + QMP_DESC_MCORE_LINK_STATE);
14222094814SBjorn Andersson
14322094814SBjorn Andersson qmp_kick(qmp);
14422094814SBjorn Andersson
14522094814SBjorn Andersson ret = wait_event_timeout(qmp->event, qmp_link_acked(qmp), HZ);
14622094814SBjorn Andersson if (!ret) {
14722094814SBjorn Andersson dev_err(qmp->dev, "ucore didn't ack link\n");
14822094814SBjorn Andersson goto timeout_close_link;
14922094814SBjorn Andersson }
15022094814SBjorn Andersson
15122094814SBjorn Andersson writel(QMP_STATE_UP, qmp->msgram + QMP_DESC_MCORE_CH_STATE);
15222094814SBjorn Andersson
15322094814SBjorn Andersson qmp_kick(qmp);
15422094814SBjorn Andersson
15522094814SBjorn Andersson ret = wait_event_timeout(qmp->event, qmp_ucore_channel_up(qmp), HZ);
15622094814SBjorn Andersson if (!ret) {
15722094814SBjorn Andersson dev_err(qmp->dev, "ucore didn't open channel\n");
15822094814SBjorn Andersson goto timeout_close_channel;
15922094814SBjorn Andersson }
16022094814SBjorn Andersson
16122094814SBjorn Andersson /* Ack remote core's channel state */
16222094814SBjorn Andersson writel(QMP_STATE_UP, qmp->msgram + QMP_DESC_UCORE_CH_STATE_ACK);
16322094814SBjorn Andersson
16422094814SBjorn Andersson qmp_kick(qmp);
16522094814SBjorn Andersson
16622094814SBjorn Andersson ret = wait_event_timeout(qmp->event, qmp_mcore_channel_acked(qmp), HZ);
16722094814SBjorn Andersson if (!ret) {
16822094814SBjorn Andersson dev_err(qmp->dev, "ucore didn't ack channel\n");
16922094814SBjorn Andersson goto timeout_close_channel;
17022094814SBjorn Andersson }
17122094814SBjorn Andersson
17222094814SBjorn Andersson return 0;
17322094814SBjorn Andersson
17422094814SBjorn Andersson timeout_close_channel:
17522094814SBjorn Andersson writel(QMP_STATE_DOWN, qmp->msgram + QMP_DESC_MCORE_CH_STATE);
17622094814SBjorn Andersson
17722094814SBjorn Andersson timeout_close_link:
17822094814SBjorn Andersson writel(QMP_STATE_DOWN, qmp->msgram + QMP_DESC_MCORE_LINK_STATE);
17922094814SBjorn Andersson qmp_kick(qmp);
18022094814SBjorn Andersson
18122094814SBjorn Andersson return -ETIMEDOUT;
18222094814SBjorn Andersson }
18322094814SBjorn Andersson
qmp_close(struct qmp * qmp)18422094814SBjorn Andersson static void qmp_close(struct qmp *qmp)
18522094814SBjorn Andersson {
18622094814SBjorn Andersson writel(QMP_STATE_DOWN, qmp->msgram + QMP_DESC_MCORE_CH_STATE);
18722094814SBjorn Andersson writel(QMP_STATE_DOWN, qmp->msgram + QMP_DESC_MCORE_LINK_STATE);
18822094814SBjorn Andersson qmp_kick(qmp);
18922094814SBjorn Andersson }
19022094814SBjorn Andersson
qmp_intr(int irq,void * data)19122094814SBjorn Andersson static irqreturn_t qmp_intr(int irq, void *data)
19222094814SBjorn Andersson {
19322094814SBjorn Andersson struct qmp *qmp = data;
19422094814SBjorn Andersson
195df636eeaSArun Kumar Neelakantam wake_up_all(&qmp->event);
19622094814SBjorn Andersson
19722094814SBjorn Andersson return IRQ_HANDLED;
19822094814SBjorn Andersson }
19922094814SBjorn Andersson
qmp_message_empty(struct qmp * qmp)20022094814SBjorn Andersson static bool qmp_message_empty(struct qmp *qmp)
20122094814SBjorn Andersson {
20222094814SBjorn Andersson return readl(qmp->msgram + qmp->offset) == 0;
20322094814SBjorn Andersson }
20422094814SBjorn Andersson
20522094814SBjorn Andersson /**
20622094814SBjorn Andersson * qmp_send() - send a message to the AOSS
20722094814SBjorn Andersson * @qmp: qmp context
2088873d1e2SBjorn Andersson * @fmt: format string for message to be sent
2098873d1e2SBjorn Andersson * @...: arguments for the format string
21022094814SBjorn Andersson *
2118873d1e2SBjorn Andersson * Transmit message to AOSS and wait for the AOSS to acknowledge the message.
21259e09100SBjorn Andersson * data must not be longer than the mailbox size. Access is synchronized by
21359e09100SBjorn Andersson * this implementation.
21422094814SBjorn Andersson *
21522094814SBjorn Andersson * Return: 0 on success, negative errno on failure
21622094814SBjorn Andersson */
qmp_send(struct qmp * qmp,const char * fmt,...)2178873d1e2SBjorn Andersson int qmp_send(struct qmp *qmp, const char *fmt, ...)
21822094814SBjorn Andersson {
21959e09100SBjorn Andersson char buf[QMP_MSG_LEN];
22022094814SBjorn Andersson long time_left;
2218873d1e2SBjorn Andersson va_list args;
2228873d1e2SBjorn Andersson int len;
22322094814SBjorn Andersson int ret;
22422094814SBjorn Andersson
2258873d1e2SBjorn Andersson if (WARN_ON(IS_ERR_OR_NULL(qmp) || !fmt))
2268c75d585SDeepak Kumar Singh return -EINVAL;
2278c75d585SDeepak Kumar Singh
2288873d1e2SBjorn Andersson memset(buf, 0, sizeof(buf));
2298873d1e2SBjorn Andersson va_start(args, fmt);
2308873d1e2SBjorn Andersson len = vsnprintf(buf, sizeof(buf), fmt, args);
2318873d1e2SBjorn Andersson va_end(args);
23222094814SBjorn Andersson
2338873d1e2SBjorn Andersson if (WARN_ON(len >= sizeof(buf)))
2348873d1e2SBjorn Andersson return -EINVAL;
23522094814SBjorn Andersson
23622094814SBjorn Andersson mutex_lock(&qmp->tx_lock);
23722094814SBjorn Andersson
23822094814SBjorn Andersson /* The message RAM only implements 32-bit accesses */
23922094814SBjorn Andersson __iowrite32_copy(qmp->msgram + qmp->offset + sizeof(u32),
24059e09100SBjorn Andersson buf, sizeof(buf) / sizeof(u32));
24159e09100SBjorn Andersson writel(sizeof(buf), qmp->msgram + qmp->offset);
24289e7eddeSArun Kumar Neelakantam
24359e09100SBjorn Andersson /* Read back length to confirm data written in message RAM */
24454f8ebdaSLee Jones readl(qmp->msgram + qmp->offset);
24522094814SBjorn Andersson qmp_kick(qmp);
24622094814SBjorn Andersson
24722094814SBjorn Andersson time_left = wait_event_interruptible_timeout(qmp->event,
24822094814SBjorn Andersson qmp_message_empty(qmp), HZ);
24922094814SBjorn Andersson if (!time_left) {
25022094814SBjorn Andersson dev_err(qmp->dev, "ucore did not ack channel\n");
25122094814SBjorn Andersson ret = -ETIMEDOUT;
25222094814SBjorn Andersson
25322094814SBjorn Andersson /* Clear message from buffer */
25422094814SBjorn Andersson writel(0, qmp->msgram + qmp->offset);
25522094814SBjorn Andersson } else {
25622094814SBjorn Andersson ret = 0;
25722094814SBjorn Andersson }
25822094814SBjorn Andersson
25922094814SBjorn Andersson mutex_unlock(&qmp->tx_lock);
26022094814SBjorn Andersson
26122094814SBjorn Andersson return ret;
26222094814SBjorn Andersson }
2638c75d585SDeepak Kumar Singh EXPORT_SYMBOL(qmp_send);
26422094814SBjorn Andersson
qmp_qdss_clk_prepare(struct clk_hw * hw)26522094814SBjorn Andersson static int qmp_qdss_clk_prepare(struct clk_hw *hw)
26622094814SBjorn Andersson {
267*b4f63bbfSBjorn Andersson static const char *buf = "{class: clock, res: qdss, val: 1}";
26822094814SBjorn Andersson struct qmp *qmp = container_of(hw, struct qmp, qdss_clk);
26922094814SBjorn Andersson
27059e09100SBjorn Andersson return qmp_send(qmp, buf);
27122094814SBjorn Andersson }
27222094814SBjorn Andersson
qmp_qdss_clk_unprepare(struct clk_hw * hw)27322094814SBjorn Andersson static void qmp_qdss_clk_unprepare(struct clk_hw *hw)
27422094814SBjorn Andersson {
275*b4f63bbfSBjorn Andersson static const char *buf = "{class: clock, res: qdss, val: 0}";
27622094814SBjorn Andersson struct qmp *qmp = container_of(hw, struct qmp, qdss_clk);
27722094814SBjorn Andersson
27859e09100SBjorn Andersson qmp_send(qmp, buf);
27922094814SBjorn Andersson }
28022094814SBjorn Andersson
28122094814SBjorn Andersson static const struct clk_ops qmp_qdss_clk_ops = {
28222094814SBjorn Andersson .prepare = qmp_qdss_clk_prepare,
28322094814SBjorn Andersson .unprepare = qmp_qdss_clk_unprepare,
28422094814SBjorn Andersson };
28522094814SBjorn Andersson
qmp_qdss_clk_add(struct qmp * qmp)28622094814SBjorn Andersson static int qmp_qdss_clk_add(struct qmp *qmp)
28722094814SBjorn Andersson {
28822094814SBjorn Andersson static const struct clk_init_data qdss_init = {
28922094814SBjorn Andersson .ops = &qmp_qdss_clk_ops,
29022094814SBjorn Andersson .name = "qdss",
29122094814SBjorn Andersson };
29222094814SBjorn Andersson int ret;
29322094814SBjorn Andersson
29422094814SBjorn Andersson qmp->qdss_clk.init = &qdss_init;
29522094814SBjorn Andersson ret = clk_hw_register(qmp->dev, &qmp->qdss_clk);
29622094814SBjorn Andersson if (ret < 0) {
29722094814SBjorn Andersson dev_err(qmp->dev, "failed to register qdss clock\n");
29822094814SBjorn Andersson return ret;
29922094814SBjorn Andersson }
30022094814SBjorn Andersson
30122094814SBjorn Andersson ret = of_clk_add_hw_provider(qmp->dev->of_node, of_clk_hw_simple_get,
30222094814SBjorn Andersson &qmp->qdss_clk);
30322094814SBjorn Andersson if (ret < 0) {
30422094814SBjorn Andersson dev_err(qmp->dev, "unable to register of clk hw provider\n");
30522094814SBjorn Andersson clk_hw_unregister(&qmp->qdss_clk);
30622094814SBjorn Andersson }
30722094814SBjorn Andersson
30822094814SBjorn Andersson return ret;
30922094814SBjorn Andersson }
31022094814SBjorn Andersson
qmp_qdss_clk_remove(struct qmp * qmp)31122094814SBjorn Andersson static void qmp_qdss_clk_remove(struct qmp *qmp)
31222094814SBjorn Andersson {
31322094814SBjorn Andersson of_clk_del_provider(qmp->dev->of_node);
31422094814SBjorn Andersson clk_hw_unregister(&qmp->qdss_clk);
31522094814SBjorn Andersson }
31622094814SBjorn Andersson
qmp_cdev_get_max_state(struct thermal_cooling_device * cdev,unsigned long * state)31705589b30SThara Gopinath static int qmp_cdev_get_max_state(struct thermal_cooling_device *cdev,
31805589b30SThara Gopinath unsigned long *state)
31905589b30SThara Gopinath {
320c55b5c66SThara Gopinath *state = qmp_cdev_max_state;
32105589b30SThara Gopinath return 0;
32205589b30SThara Gopinath }
32305589b30SThara Gopinath
qmp_cdev_get_cur_state(struct thermal_cooling_device * cdev,unsigned long * state)32405589b30SThara Gopinath static int qmp_cdev_get_cur_state(struct thermal_cooling_device *cdev,
32505589b30SThara Gopinath unsigned long *state)
32605589b30SThara Gopinath {
32705589b30SThara Gopinath struct qmp_cooling_device *qmp_cdev = cdev->devdata;
32805589b30SThara Gopinath
32905589b30SThara Gopinath *state = qmp_cdev->state;
33005589b30SThara Gopinath return 0;
33105589b30SThara Gopinath }
33205589b30SThara Gopinath
qmp_cdev_set_cur_state(struct thermal_cooling_device * cdev,unsigned long state)33305589b30SThara Gopinath static int qmp_cdev_set_cur_state(struct thermal_cooling_device *cdev,
33405589b30SThara Gopinath unsigned long state)
33505589b30SThara Gopinath {
33605589b30SThara Gopinath struct qmp_cooling_device *qmp_cdev = cdev->devdata;
33705589b30SThara Gopinath bool cdev_state;
33805589b30SThara Gopinath int ret;
33905589b30SThara Gopinath
34005589b30SThara Gopinath /* Normalize state */
34105589b30SThara Gopinath cdev_state = !!state;
34205589b30SThara Gopinath
34305589b30SThara Gopinath if (qmp_cdev->state == state)
34405589b30SThara Gopinath return 0;
34505589b30SThara Gopinath
346*b4f63bbfSBjorn Andersson ret = qmp_send(qmp_cdev->qmp, "{class: volt_flr, event:zero_temp, res:%s, value:%s}",
347*b4f63bbfSBjorn Andersson qmp_cdev->name, cdev_state ? "on" : "off");
34805589b30SThara Gopinath if (!ret)
34905589b30SThara Gopinath qmp_cdev->state = cdev_state;
35005589b30SThara Gopinath
35105589b30SThara Gopinath return ret;
35205589b30SThara Gopinath }
35305589b30SThara Gopinath
3543925b909SRikard Falkeborn static const struct thermal_cooling_device_ops qmp_cooling_device_ops = {
35505589b30SThara Gopinath .get_max_state = qmp_cdev_get_max_state,
35605589b30SThara Gopinath .get_cur_state = qmp_cdev_get_cur_state,
35705589b30SThara Gopinath .set_cur_state = qmp_cdev_set_cur_state,
35805589b30SThara Gopinath };
35905589b30SThara Gopinath
qmp_cooling_device_add(struct qmp * qmp,struct qmp_cooling_device * qmp_cdev,struct device_node * node)36005589b30SThara Gopinath static int qmp_cooling_device_add(struct qmp *qmp,
36105589b30SThara Gopinath struct qmp_cooling_device *qmp_cdev,
36205589b30SThara Gopinath struct device_node *node)
36305589b30SThara Gopinath {
36405589b30SThara Gopinath char *cdev_name = (char *)node->name;
36505589b30SThara Gopinath
36605589b30SThara Gopinath qmp_cdev->qmp = qmp;
367c55b5c66SThara Gopinath qmp_cdev->state = !qmp_cdev_max_state;
36805589b30SThara Gopinath qmp_cdev->name = cdev_name;
36905589b30SThara Gopinath qmp_cdev->cdev = devm_thermal_of_cooling_device_register
37005589b30SThara Gopinath (qmp->dev, node,
37105589b30SThara Gopinath cdev_name,
37205589b30SThara Gopinath qmp_cdev, &qmp_cooling_device_ops);
37305589b30SThara Gopinath
37405589b30SThara Gopinath if (IS_ERR(qmp_cdev->cdev))
37505589b30SThara Gopinath dev_err(qmp->dev, "unable to register %s cooling device\n",
37605589b30SThara Gopinath cdev_name);
37705589b30SThara Gopinath
37805589b30SThara Gopinath return PTR_ERR_OR_ZERO(qmp_cdev->cdev);
37905589b30SThara Gopinath }
38005589b30SThara Gopinath
qmp_cooling_devices_register(struct qmp * qmp)38105589b30SThara Gopinath static int qmp_cooling_devices_register(struct qmp *qmp)
38205589b30SThara Gopinath {
38305589b30SThara Gopinath struct device_node *np, *child;
384a89f355eSManivannan Sadhasivam int count = 0;
38505589b30SThara Gopinath int ret;
38605589b30SThara Gopinath
38705589b30SThara Gopinath np = qmp->dev->of_node;
38805589b30SThara Gopinath
389a89f355eSManivannan Sadhasivam qmp->cooling_devs = devm_kcalloc(qmp->dev, QMP_NUM_COOLING_RESOURCES,
39005589b30SThara Gopinath sizeof(*qmp->cooling_devs),
39105589b30SThara Gopinath GFP_KERNEL);
39205589b30SThara Gopinath
39305589b30SThara Gopinath if (!qmp->cooling_devs)
39405589b30SThara Gopinath return -ENOMEM;
39505589b30SThara Gopinath
39605589b30SThara Gopinath for_each_available_child_of_node(np, child) {
3974a1b9f4eSRob Herring if (!of_property_present(child, "#cooling-cells"))
39805589b30SThara Gopinath continue;
39905589b30SThara Gopinath ret = qmp_cooling_device_add(qmp, &qmp->cooling_devs[count++],
40005589b30SThara Gopinath child);
401e6e09514SMiaoqian Lin if (ret) {
402e6e09514SMiaoqian Lin of_node_put(child);
40305589b30SThara Gopinath goto unroll;
40405589b30SThara Gopinath }
405e6e09514SMiaoqian Lin }
40605589b30SThara Gopinath
407a89f355eSManivannan Sadhasivam if (!count)
408a89f355eSManivannan Sadhasivam devm_kfree(qmp->dev, qmp->cooling_devs);
409a89f355eSManivannan Sadhasivam
41005589b30SThara Gopinath return 0;
41105589b30SThara Gopinath
41205589b30SThara Gopinath unroll:
41305589b30SThara Gopinath while (--count >= 0)
41405589b30SThara Gopinath thermal_cooling_device_unregister
41505589b30SThara Gopinath (qmp->cooling_devs[count].cdev);
416a89f355eSManivannan Sadhasivam devm_kfree(qmp->dev, qmp->cooling_devs);
41705589b30SThara Gopinath
41805589b30SThara Gopinath return ret;
41905589b30SThara Gopinath }
42005589b30SThara Gopinath
qmp_cooling_devices_remove(struct qmp * qmp)42105589b30SThara Gopinath static void qmp_cooling_devices_remove(struct qmp *qmp)
42205589b30SThara Gopinath {
42305589b30SThara Gopinath int i;
42405589b30SThara Gopinath
42505589b30SThara Gopinath for (i = 0; i < QMP_NUM_COOLING_RESOURCES; i++)
42605589b30SThara Gopinath thermal_cooling_device_unregister(qmp->cooling_devs[i].cdev);
42705589b30SThara Gopinath }
42805589b30SThara Gopinath
4298c75d585SDeepak Kumar Singh /**
4308c75d585SDeepak Kumar Singh * qmp_get() - get a qmp handle from a device
4318c75d585SDeepak Kumar Singh * @dev: client device pointer
4328c75d585SDeepak Kumar Singh *
4338c75d585SDeepak Kumar Singh * Return: handle to qmp device on success, ERR_PTR() on failure
4348c75d585SDeepak Kumar Singh */
qmp_get(struct device * dev)4358c75d585SDeepak Kumar Singh struct qmp *qmp_get(struct device *dev)
4368c75d585SDeepak Kumar Singh {
4378c75d585SDeepak Kumar Singh struct platform_device *pdev;
4388c75d585SDeepak Kumar Singh struct device_node *np;
4398c75d585SDeepak Kumar Singh struct qmp *qmp;
4408c75d585SDeepak Kumar Singh
4418c75d585SDeepak Kumar Singh if (!dev || !dev->of_node)
4428c75d585SDeepak Kumar Singh return ERR_PTR(-EINVAL);
4438c75d585SDeepak Kumar Singh
4448c75d585SDeepak Kumar Singh np = of_parse_phandle(dev->of_node, "qcom,qmp", 0);
4458c75d585SDeepak Kumar Singh if (!np)
4468c75d585SDeepak Kumar Singh return ERR_PTR(-ENODEV);
4478c75d585SDeepak Kumar Singh
4488c75d585SDeepak Kumar Singh pdev = of_find_device_by_node(np);
4498c75d585SDeepak Kumar Singh of_node_put(np);
4508c75d585SDeepak Kumar Singh if (!pdev)
4518c75d585SDeepak Kumar Singh return ERR_PTR(-EINVAL);
4528c75d585SDeepak Kumar Singh
4538c75d585SDeepak Kumar Singh qmp = platform_get_drvdata(pdev);
4548c75d585SDeepak Kumar Singh
4554b41a9d0SMiaoqian Lin if (!qmp) {
4564b41a9d0SMiaoqian Lin put_device(&pdev->dev);
4574b41a9d0SMiaoqian Lin return ERR_PTR(-EPROBE_DEFER);
4584b41a9d0SMiaoqian Lin }
4594b41a9d0SMiaoqian Lin return qmp;
4608c75d585SDeepak Kumar Singh }
4618c75d585SDeepak Kumar Singh EXPORT_SYMBOL(qmp_get);
4628c75d585SDeepak Kumar Singh
4638c75d585SDeepak Kumar Singh /**
4648c75d585SDeepak Kumar Singh * qmp_put() - release a qmp handle
4658c75d585SDeepak Kumar Singh * @qmp: qmp handle obtained from qmp_get()
4668c75d585SDeepak Kumar Singh */
qmp_put(struct qmp * qmp)4678c75d585SDeepak Kumar Singh void qmp_put(struct qmp *qmp)
4688c75d585SDeepak Kumar Singh {
4698c75d585SDeepak Kumar Singh /*
4708c75d585SDeepak Kumar Singh * Match get_device() inside of_find_device_by_node() in
4718c75d585SDeepak Kumar Singh * qmp_get()
4728c75d585SDeepak Kumar Singh */
4738c75d585SDeepak Kumar Singh if (!IS_ERR_OR_NULL(qmp))
4748c75d585SDeepak Kumar Singh put_device(qmp->dev);
4758c75d585SDeepak Kumar Singh }
4768c75d585SDeepak Kumar Singh EXPORT_SYMBOL(qmp_put);
4778c75d585SDeepak Kumar Singh
qmp_probe(struct platform_device * pdev)47822094814SBjorn Andersson static int qmp_probe(struct platform_device *pdev)
47922094814SBjorn Andersson {
48022094814SBjorn Andersson struct qmp *qmp;
48122094814SBjorn Andersson int irq;
48222094814SBjorn Andersson int ret;
48322094814SBjorn Andersson
48422094814SBjorn Andersson qmp = devm_kzalloc(&pdev->dev, sizeof(*qmp), GFP_KERNEL);
48522094814SBjorn Andersson if (!qmp)
48622094814SBjorn Andersson return -ENOMEM;
48722094814SBjorn Andersson
48822094814SBjorn Andersson qmp->dev = &pdev->dev;
48922094814SBjorn Andersson init_waitqueue_head(&qmp->event);
49022094814SBjorn Andersson mutex_init(&qmp->tx_lock);
49122094814SBjorn Andersson
492c318dcbcSCai Huoqing qmp->msgram = devm_platform_ioremap_resource(pdev, 0);
49322094814SBjorn Andersson if (IS_ERR(qmp->msgram))
49422094814SBjorn Andersson return PTR_ERR(qmp->msgram);
49522094814SBjorn Andersson
49622094814SBjorn Andersson qmp->mbox_client.dev = &pdev->dev;
49722094814SBjorn Andersson qmp->mbox_client.knows_txdone = true;
49822094814SBjorn Andersson qmp->mbox_chan = mbox_request_channel(&qmp->mbox_client, 0);
49922094814SBjorn Andersson if (IS_ERR(qmp->mbox_chan)) {
50022094814SBjorn Andersson dev_err(&pdev->dev, "failed to acquire ipc mailbox\n");
50122094814SBjorn Andersson return PTR_ERR(qmp->mbox_chan);
50222094814SBjorn Andersson }
50322094814SBjorn Andersson
50422094814SBjorn Andersson irq = platform_get_irq(pdev, 0);
5058030cb9aSDaniel Thompson ret = devm_request_irq(&pdev->dev, irq, qmp_intr, 0,
50622094814SBjorn Andersson "aoss-qmp", qmp);
50722094814SBjorn Andersson if (ret < 0) {
50822094814SBjorn Andersson dev_err(&pdev->dev, "failed to request interrupt\n");
50922094814SBjorn Andersson goto err_free_mbox;
51022094814SBjorn Andersson }
51122094814SBjorn Andersson
51222094814SBjorn Andersson ret = qmp_open(qmp);
51322094814SBjorn Andersson if (ret < 0)
51422094814SBjorn Andersson goto err_free_mbox;
51522094814SBjorn Andersson
51622094814SBjorn Andersson ret = qmp_qdss_clk_add(qmp);
51722094814SBjorn Andersson if (ret)
51822094814SBjorn Andersson goto err_close_qmp;
51922094814SBjorn Andersson
52005589b30SThara Gopinath ret = qmp_cooling_devices_register(qmp);
52105589b30SThara Gopinath if (ret)
52205589b30SThara Gopinath dev_err(&pdev->dev, "failed to register aoss cooling devices\n");
52305589b30SThara Gopinath
52422094814SBjorn Andersson platform_set_drvdata(pdev, qmp);
52522094814SBjorn Andersson
52622094814SBjorn Andersson return 0;
52722094814SBjorn Andersson
52822094814SBjorn Andersson err_close_qmp:
52922094814SBjorn Andersson qmp_close(qmp);
53022094814SBjorn Andersson err_free_mbox:
53122094814SBjorn Andersson mbox_free_channel(qmp->mbox_chan);
53222094814SBjorn Andersson
53322094814SBjorn Andersson return ret;
53422094814SBjorn Andersson }
53522094814SBjorn Andersson
qmp_remove(struct platform_device * pdev)53622094814SBjorn Andersson static int qmp_remove(struct platform_device *pdev)
53722094814SBjorn Andersson {
53822094814SBjorn Andersson struct qmp *qmp = platform_get_drvdata(pdev);
53922094814SBjorn Andersson
54022094814SBjorn Andersson qmp_qdss_clk_remove(qmp);
54105589b30SThara Gopinath qmp_cooling_devices_remove(qmp);
54222094814SBjorn Andersson
54322094814SBjorn Andersson qmp_close(qmp);
54422094814SBjorn Andersson mbox_free_channel(qmp->mbox_chan);
54522094814SBjorn Andersson
54622094814SBjorn Andersson return 0;
54722094814SBjorn Andersson }
54822094814SBjorn Andersson
54922094814SBjorn Andersson static const struct of_device_id qmp_dt_match[] = {
55017095102SSibi Sankar { .compatible = "qcom,sc7180-aoss-qmp", },
551ce6e674aSSai Prakash Ranjan { .compatible = "qcom,sc7280-aoss-qmp", },
55222094814SBjorn Andersson { .compatible = "qcom,sdm845-aoss-qmp", },
55317095102SSibi Sankar { .compatible = "qcom,sm8150-aoss-qmp", },
554ce187859SBjorn Andersson { .compatible = "qcom,sm8250-aoss-qmp", },
555e161ce8eSVinod Koul { .compatible = "qcom,sm8350-aoss-qmp", },
556d63486ddSBjorn Andersson { .compatible = "qcom,aoss-qmp", },
55722094814SBjorn Andersson {}
55822094814SBjorn Andersson };
55922094814SBjorn Andersson MODULE_DEVICE_TABLE(of, qmp_dt_match);
56022094814SBjorn Andersson
56122094814SBjorn Andersson static struct platform_driver qmp_driver = {
56222094814SBjorn Andersson .driver = {
56322094814SBjorn Andersson .name = "qcom_aoss_qmp",
56422094814SBjorn Andersson .of_match_table = qmp_dt_match,
5658c75d585SDeepak Kumar Singh .suppress_bind_attrs = true,
56622094814SBjorn Andersson },
56722094814SBjorn Andersson .probe = qmp_probe,
56822094814SBjorn Andersson .remove = qmp_remove,
56922094814SBjorn Andersson };
57022094814SBjorn Andersson module_platform_driver(qmp_driver);
57122094814SBjorn Andersson
57222094814SBjorn Andersson MODULE_DESCRIPTION("Qualcomm AOSS QMP driver");
57322094814SBjorn Andersson MODULE_LICENSE("GPL v2");
574