1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * Copyright (c) 2017, Linaro Ltd.
4*4882a593Smuzhiyun */
5*4882a593Smuzhiyun #include <linux/firmware.h>
6*4882a593Smuzhiyun #include <linux/module.h>
7*4882a593Smuzhiyun #include <linux/notifier.h>
8*4882a593Smuzhiyun #include <linux/slab.h>
9*4882a593Smuzhiyun #include <linux/interrupt.h>
10*4882a593Smuzhiyun #include <linux/io.h>
11*4882a593Smuzhiyun #include <linux/of_irq.h>
12*4882a593Smuzhiyun #include <linux/of_platform.h>
13*4882a593Smuzhiyun #include <linux/platform_device.h>
14*4882a593Smuzhiyun #include <linux/remoteproc/qcom_rproc.h>
15*4882a593Smuzhiyun #include <linux/rpmsg.h>
16*4882a593Smuzhiyun
17*4882a593Smuzhiyun #include "qcom_common.h"
18*4882a593Smuzhiyun
19*4882a593Smuzhiyun static BLOCKING_NOTIFIER_HEAD(sysmon_notifiers);
20*4882a593Smuzhiyun
21*4882a593Smuzhiyun struct qcom_sysmon {
22*4882a593Smuzhiyun struct rproc_subdev subdev;
23*4882a593Smuzhiyun struct rproc *rproc;
24*4882a593Smuzhiyun
25*4882a593Smuzhiyun int state;
26*4882a593Smuzhiyun struct mutex state_lock;
27*4882a593Smuzhiyun
28*4882a593Smuzhiyun struct list_head node;
29*4882a593Smuzhiyun
30*4882a593Smuzhiyun const char *name;
31*4882a593Smuzhiyun
32*4882a593Smuzhiyun int shutdown_irq;
33*4882a593Smuzhiyun int ssctl_version;
34*4882a593Smuzhiyun int ssctl_instance;
35*4882a593Smuzhiyun
36*4882a593Smuzhiyun struct notifier_block nb;
37*4882a593Smuzhiyun
38*4882a593Smuzhiyun struct device *dev;
39*4882a593Smuzhiyun
40*4882a593Smuzhiyun struct rpmsg_endpoint *ept;
41*4882a593Smuzhiyun struct completion comp;
42*4882a593Smuzhiyun struct completion ind_comp;
43*4882a593Smuzhiyun struct completion shutdown_comp;
44*4882a593Smuzhiyun struct completion ssctl_comp;
45*4882a593Smuzhiyun struct mutex lock;
46*4882a593Smuzhiyun
47*4882a593Smuzhiyun bool ssr_ack;
48*4882a593Smuzhiyun
49*4882a593Smuzhiyun struct qmi_handle qmi;
50*4882a593Smuzhiyun struct sockaddr_qrtr ssctl;
51*4882a593Smuzhiyun };
52*4882a593Smuzhiyun
53*4882a593Smuzhiyun enum {
54*4882a593Smuzhiyun SSCTL_SSR_EVENT_BEFORE_POWERUP,
55*4882a593Smuzhiyun SSCTL_SSR_EVENT_AFTER_POWERUP,
56*4882a593Smuzhiyun SSCTL_SSR_EVENT_BEFORE_SHUTDOWN,
57*4882a593Smuzhiyun SSCTL_SSR_EVENT_AFTER_SHUTDOWN,
58*4882a593Smuzhiyun };
59*4882a593Smuzhiyun
60*4882a593Smuzhiyun static const char * const sysmon_state_string[] = {
61*4882a593Smuzhiyun [SSCTL_SSR_EVENT_BEFORE_POWERUP] = "before_powerup",
62*4882a593Smuzhiyun [SSCTL_SSR_EVENT_AFTER_POWERUP] = "after_powerup",
63*4882a593Smuzhiyun [SSCTL_SSR_EVENT_BEFORE_SHUTDOWN] = "before_shutdown",
64*4882a593Smuzhiyun [SSCTL_SSR_EVENT_AFTER_SHUTDOWN] = "after_shutdown",
65*4882a593Smuzhiyun };
66*4882a593Smuzhiyun
67*4882a593Smuzhiyun struct sysmon_event {
68*4882a593Smuzhiyun const char *subsys_name;
69*4882a593Smuzhiyun u32 ssr_event;
70*4882a593Smuzhiyun };
71*4882a593Smuzhiyun
72*4882a593Smuzhiyun static DEFINE_MUTEX(sysmon_lock);
73*4882a593Smuzhiyun static LIST_HEAD(sysmon_list);
74*4882a593Smuzhiyun
75*4882a593Smuzhiyun /**
76*4882a593Smuzhiyun * sysmon_send_event() - send notification of other remote's SSR event
77*4882a593Smuzhiyun * @sysmon: sysmon context
78*4882a593Smuzhiyun * @event: sysmon event context
79*4882a593Smuzhiyun */
sysmon_send_event(struct qcom_sysmon * sysmon,const struct sysmon_event * event)80*4882a593Smuzhiyun static void sysmon_send_event(struct qcom_sysmon *sysmon,
81*4882a593Smuzhiyun const struct sysmon_event *event)
82*4882a593Smuzhiyun {
83*4882a593Smuzhiyun char req[50];
84*4882a593Smuzhiyun int len;
85*4882a593Smuzhiyun int ret;
86*4882a593Smuzhiyun
87*4882a593Smuzhiyun len = snprintf(req, sizeof(req), "ssr:%s:%s", event->subsys_name,
88*4882a593Smuzhiyun sysmon_state_string[event->ssr_event]);
89*4882a593Smuzhiyun if (len >= sizeof(req))
90*4882a593Smuzhiyun return;
91*4882a593Smuzhiyun
92*4882a593Smuzhiyun mutex_lock(&sysmon->lock);
93*4882a593Smuzhiyun reinit_completion(&sysmon->comp);
94*4882a593Smuzhiyun sysmon->ssr_ack = false;
95*4882a593Smuzhiyun
96*4882a593Smuzhiyun ret = rpmsg_send(sysmon->ept, req, len);
97*4882a593Smuzhiyun if (ret < 0) {
98*4882a593Smuzhiyun dev_err(sysmon->dev, "failed to send sysmon event\n");
99*4882a593Smuzhiyun goto out_unlock;
100*4882a593Smuzhiyun }
101*4882a593Smuzhiyun
102*4882a593Smuzhiyun ret = wait_for_completion_timeout(&sysmon->comp,
103*4882a593Smuzhiyun msecs_to_jiffies(5000));
104*4882a593Smuzhiyun if (!ret) {
105*4882a593Smuzhiyun dev_err(sysmon->dev, "timeout waiting for sysmon ack\n");
106*4882a593Smuzhiyun goto out_unlock;
107*4882a593Smuzhiyun }
108*4882a593Smuzhiyun
109*4882a593Smuzhiyun if (!sysmon->ssr_ack)
110*4882a593Smuzhiyun dev_err(sysmon->dev, "unexpected response to sysmon event\n");
111*4882a593Smuzhiyun
112*4882a593Smuzhiyun out_unlock:
113*4882a593Smuzhiyun mutex_unlock(&sysmon->lock);
114*4882a593Smuzhiyun }
115*4882a593Smuzhiyun
116*4882a593Smuzhiyun /**
117*4882a593Smuzhiyun * sysmon_request_shutdown() - request graceful shutdown of remote
118*4882a593Smuzhiyun * @sysmon: sysmon context
119*4882a593Smuzhiyun */
sysmon_request_shutdown(struct qcom_sysmon * sysmon)120*4882a593Smuzhiyun static void sysmon_request_shutdown(struct qcom_sysmon *sysmon)
121*4882a593Smuzhiyun {
122*4882a593Smuzhiyun char *req = "ssr:shutdown";
123*4882a593Smuzhiyun int ret;
124*4882a593Smuzhiyun
125*4882a593Smuzhiyun mutex_lock(&sysmon->lock);
126*4882a593Smuzhiyun reinit_completion(&sysmon->comp);
127*4882a593Smuzhiyun sysmon->ssr_ack = false;
128*4882a593Smuzhiyun
129*4882a593Smuzhiyun ret = rpmsg_send(sysmon->ept, req, strlen(req) + 1);
130*4882a593Smuzhiyun if (ret < 0) {
131*4882a593Smuzhiyun dev_err(sysmon->dev, "send sysmon shutdown request failed\n");
132*4882a593Smuzhiyun goto out_unlock;
133*4882a593Smuzhiyun }
134*4882a593Smuzhiyun
135*4882a593Smuzhiyun ret = wait_for_completion_timeout(&sysmon->comp,
136*4882a593Smuzhiyun msecs_to_jiffies(5000));
137*4882a593Smuzhiyun if (!ret) {
138*4882a593Smuzhiyun dev_err(sysmon->dev, "timeout waiting for sysmon ack\n");
139*4882a593Smuzhiyun goto out_unlock;
140*4882a593Smuzhiyun }
141*4882a593Smuzhiyun
142*4882a593Smuzhiyun if (!sysmon->ssr_ack)
143*4882a593Smuzhiyun dev_err(sysmon->dev,
144*4882a593Smuzhiyun "unexpected response to sysmon shutdown request\n");
145*4882a593Smuzhiyun
146*4882a593Smuzhiyun out_unlock:
147*4882a593Smuzhiyun mutex_unlock(&sysmon->lock);
148*4882a593Smuzhiyun }
149*4882a593Smuzhiyun
sysmon_callback(struct rpmsg_device * rpdev,void * data,int count,void * priv,u32 addr)150*4882a593Smuzhiyun static int sysmon_callback(struct rpmsg_device *rpdev, void *data, int count,
151*4882a593Smuzhiyun void *priv, u32 addr)
152*4882a593Smuzhiyun {
153*4882a593Smuzhiyun struct qcom_sysmon *sysmon = priv;
154*4882a593Smuzhiyun const char *ssr_ack = "ssr:ack";
155*4882a593Smuzhiyun const int ssr_ack_len = strlen(ssr_ack) + 1;
156*4882a593Smuzhiyun
157*4882a593Smuzhiyun if (!sysmon)
158*4882a593Smuzhiyun return -EINVAL;
159*4882a593Smuzhiyun
160*4882a593Smuzhiyun if (count >= ssr_ack_len && !memcmp(data, ssr_ack, ssr_ack_len))
161*4882a593Smuzhiyun sysmon->ssr_ack = true;
162*4882a593Smuzhiyun
163*4882a593Smuzhiyun complete(&sysmon->comp);
164*4882a593Smuzhiyun
165*4882a593Smuzhiyun return 0;
166*4882a593Smuzhiyun }
167*4882a593Smuzhiyun
168*4882a593Smuzhiyun #define SSCTL_SHUTDOWN_REQ 0x21
169*4882a593Smuzhiyun #define SSCTL_SHUTDOWN_READY_IND 0x21
170*4882a593Smuzhiyun #define SSCTL_SUBSYS_EVENT_REQ 0x23
171*4882a593Smuzhiyun
172*4882a593Smuzhiyun #define SSCTL_MAX_MSG_LEN 7
173*4882a593Smuzhiyun
174*4882a593Smuzhiyun #define SSCTL_SUBSYS_NAME_LENGTH 15
175*4882a593Smuzhiyun
176*4882a593Smuzhiyun enum {
177*4882a593Smuzhiyun SSCTL_SSR_EVENT_FORCED,
178*4882a593Smuzhiyun SSCTL_SSR_EVENT_GRACEFUL,
179*4882a593Smuzhiyun };
180*4882a593Smuzhiyun
181*4882a593Smuzhiyun struct ssctl_shutdown_resp {
182*4882a593Smuzhiyun struct qmi_response_type_v01 resp;
183*4882a593Smuzhiyun };
184*4882a593Smuzhiyun
185*4882a593Smuzhiyun static struct qmi_elem_info ssctl_shutdown_resp_ei[] = {
186*4882a593Smuzhiyun {
187*4882a593Smuzhiyun .data_type = QMI_STRUCT,
188*4882a593Smuzhiyun .elem_len = 1,
189*4882a593Smuzhiyun .elem_size = sizeof(struct qmi_response_type_v01),
190*4882a593Smuzhiyun .array_type = NO_ARRAY,
191*4882a593Smuzhiyun .tlv_type = 0x02,
192*4882a593Smuzhiyun .offset = offsetof(struct ssctl_shutdown_resp, resp),
193*4882a593Smuzhiyun .ei_array = qmi_response_type_v01_ei,
194*4882a593Smuzhiyun },
195*4882a593Smuzhiyun {}
196*4882a593Smuzhiyun };
197*4882a593Smuzhiyun
198*4882a593Smuzhiyun struct ssctl_subsys_event_req {
199*4882a593Smuzhiyun u8 subsys_name_len;
200*4882a593Smuzhiyun char subsys_name[SSCTL_SUBSYS_NAME_LENGTH];
201*4882a593Smuzhiyun u32 event;
202*4882a593Smuzhiyun u8 evt_driven_valid;
203*4882a593Smuzhiyun u32 evt_driven;
204*4882a593Smuzhiyun };
205*4882a593Smuzhiyun
206*4882a593Smuzhiyun static struct qmi_elem_info ssctl_subsys_event_req_ei[] = {
207*4882a593Smuzhiyun {
208*4882a593Smuzhiyun .data_type = QMI_DATA_LEN,
209*4882a593Smuzhiyun .elem_len = 1,
210*4882a593Smuzhiyun .elem_size = sizeof(uint8_t),
211*4882a593Smuzhiyun .array_type = NO_ARRAY,
212*4882a593Smuzhiyun .tlv_type = 0x01,
213*4882a593Smuzhiyun .offset = offsetof(struct ssctl_subsys_event_req,
214*4882a593Smuzhiyun subsys_name_len),
215*4882a593Smuzhiyun .ei_array = NULL,
216*4882a593Smuzhiyun },
217*4882a593Smuzhiyun {
218*4882a593Smuzhiyun .data_type = QMI_UNSIGNED_1_BYTE,
219*4882a593Smuzhiyun .elem_len = SSCTL_SUBSYS_NAME_LENGTH,
220*4882a593Smuzhiyun .elem_size = sizeof(char),
221*4882a593Smuzhiyun .array_type = VAR_LEN_ARRAY,
222*4882a593Smuzhiyun .tlv_type = 0x01,
223*4882a593Smuzhiyun .offset = offsetof(struct ssctl_subsys_event_req,
224*4882a593Smuzhiyun subsys_name),
225*4882a593Smuzhiyun .ei_array = NULL,
226*4882a593Smuzhiyun },
227*4882a593Smuzhiyun {
228*4882a593Smuzhiyun .data_type = QMI_SIGNED_4_BYTE_ENUM,
229*4882a593Smuzhiyun .elem_len = 1,
230*4882a593Smuzhiyun .elem_size = sizeof(uint32_t),
231*4882a593Smuzhiyun .array_type = NO_ARRAY,
232*4882a593Smuzhiyun .tlv_type = 0x02,
233*4882a593Smuzhiyun .offset = offsetof(struct ssctl_subsys_event_req,
234*4882a593Smuzhiyun event),
235*4882a593Smuzhiyun .ei_array = NULL,
236*4882a593Smuzhiyun },
237*4882a593Smuzhiyun {
238*4882a593Smuzhiyun .data_type = QMI_OPT_FLAG,
239*4882a593Smuzhiyun .elem_len = 1,
240*4882a593Smuzhiyun .elem_size = sizeof(uint8_t),
241*4882a593Smuzhiyun .array_type = NO_ARRAY,
242*4882a593Smuzhiyun .tlv_type = 0x10,
243*4882a593Smuzhiyun .offset = offsetof(struct ssctl_subsys_event_req,
244*4882a593Smuzhiyun evt_driven_valid),
245*4882a593Smuzhiyun .ei_array = NULL,
246*4882a593Smuzhiyun },
247*4882a593Smuzhiyun {
248*4882a593Smuzhiyun .data_type = QMI_SIGNED_4_BYTE_ENUM,
249*4882a593Smuzhiyun .elem_len = 1,
250*4882a593Smuzhiyun .elem_size = sizeof(uint32_t),
251*4882a593Smuzhiyun .array_type = NO_ARRAY,
252*4882a593Smuzhiyun .tlv_type = 0x10,
253*4882a593Smuzhiyun .offset = offsetof(struct ssctl_subsys_event_req,
254*4882a593Smuzhiyun evt_driven),
255*4882a593Smuzhiyun .ei_array = NULL,
256*4882a593Smuzhiyun },
257*4882a593Smuzhiyun {}
258*4882a593Smuzhiyun };
259*4882a593Smuzhiyun
260*4882a593Smuzhiyun struct ssctl_subsys_event_resp {
261*4882a593Smuzhiyun struct qmi_response_type_v01 resp;
262*4882a593Smuzhiyun };
263*4882a593Smuzhiyun
264*4882a593Smuzhiyun static struct qmi_elem_info ssctl_subsys_event_resp_ei[] = {
265*4882a593Smuzhiyun {
266*4882a593Smuzhiyun .data_type = QMI_STRUCT,
267*4882a593Smuzhiyun .elem_len = 1,
268*4882a593Smuzhiyun .elem_size = sizeof(struct qmi_response_type_v01),
269*4882a593Smuzhiyun .array_type = NO_ARRAY,
270*4882a593Smuzhiyun .tlv_type = 0x02,
271*4882a593Smuzhiyun .offset = offsetof(struct ssctl_subsys_event_resp,
272*4882a593Smuzhiyun resp),
273*4882a593Smuzhiyun .ei_array = qmi_response_type_v01_ei,
274*4882a593Smuzhiyun },
275*4882a593Smuzhiyun {}
276*4882a593Smuzhiyun };
277*4882a593Smuzhiyun
278*4882a593Smuzhiyun static struct qmi_elem_info ssctl_shutdown_ind_ei[] = {
279*4882a593Smuzhiyun {}
280*4882a593Smuzhiyun };
281*4882a593Smuzhiyun
sysmon_ind_cb(struct qmi_handle * qmi,struct sockaddr_qrtr * sq,struct qmi_txn * txn,const void * data)282*4882a593Smuzhiyun static void sysmon_ind_cb(struct qmi_handle *qmi, struct sockaddr_qrtr *sq,
283*4882a593Smuzhiyun struct qmi_txn *txn, const void *data)
284*4882a593Smuzhiyun {
285*4882a593Smuzhiyun struct qcom_sysmon *sysmon = container_of(qmi, struct qcom_sysmon, qmi);
286*4882a593Smuzhiyun
287*4882a593Smuzhiyun complete(&sysmon->ind_comp);
288*4882a593Smuzhiyun }
289*4882a593Smuzhiyun
290*4882a593Smuzhiyun static struct qmi_msg_handler qmi_indication_handler[] = {
291*4882a593Smuzhiyun {
292*4882a593Smuzhiyun .type = QMI_INDICATION,
293*4882a593Smuzhiyun .msg_id = SSCTL_SHUTDOWN_READY_IND,
294*4882a593Smuzhiyun .ei = ssctl_shutdown_ind_ei,
295*4882a593Smuzhiyun .decoded_size = 0,
296*4882a593Smuzhiyun .fn = sysmon_ind_cb
297*4882a593Smuzhiyun },
298*4882a593Smuzhiyun {}
299*4882a593Smuzhiyun };
300*4882a593Smuzhiyun
301*4882a593Smuzhiyun /**
302*4882a593Smuzhiyun * ssctl_request_shutdown() - request shutdown via SSCTL QMI service
303*4882a593Smuzhiyun * @sysmon: sysmon context
304*4882a593Smuzhiyun */
ssctl_request_shutdown(struct qcom_sysmon * sysmon)305*4882a593Smuzhiyun static void ssctl_request_shutdown(struct qcom_sysmon *sysmon)
306*4882a593Smuzhiyun {
307*4882a593Smuzhiyun struct ssctl_shutdown_resp resp;
308*4882a593Smuzhiyun struct qmi_txn txn;
309*4882a593Smuzhiyun int ret;
310*4882a593Smuzhiyun
311*4882a593Smuzhiyun reinit_completion(&sysmon->ind_comp);
312*4882a593Smuzhiyun reinit_completion(&sysmon->shutdown_comp);
313*4882a593Smuzhiyun ret = qmi_txn_init(&sysmon->qmi, &txn, ssctl_shutdown_resp_ei, &resp);
314*4882a593Smuzhiyun if (ret < 0) {
315*4882a593Smuzhiyun dev_err(sysmon->dev, "failed to allocate QMI txn\n");
316*4882a593Smuzhiyun return;
317*4882a593Smuzhiyun }
318*4882a593Smuzhiyun
319*4882a593Smuzhiyun ret = qmi_send_request(&sysmon->qmi, &sysmon->ssctl, &txn,
320*4882a593Smuzhiyun SSCTL_SHUTDOWN_REQ, 0, NULL, NULL);
321*4882a593Smuzhiyun if (ret < 0) {
322*4882a593Smuzhiyun dev_err(sysmon->dev, "failed to send shutdown request\n");
323*4882a593Smuzhiyun qmi_txn_cancel(&txn);
324*4882a593Smuzhiyun return;
325*4882a593Smuzhiyun }
326*4882a593Smuzhiyun
327*4882a593Smuzhiyun ret = qmi_txn_wait(&txn, 5 * HZ);
328*4882a593Smuzhiyun if (ret < 0)
329*4882a593Smuzhiyun dev_err(sysmon->dev, "failed receiving QMI response\n");
330*4882a593Smuzhiyun else if (resp.resp.result)
331*4882a593Smuzhiyun dev_err(sysmon->dev, "shutdown request failed\n");
332*4882a593Smuzhiyun else
333*4882a593Smuzhiyun dev_dbg(sysmon->dev, "shutdown request completed\n");
334*4882a593Smuzhiyun
335*4882a593Smuzhiyun if (sysmon->shutdown_irq > 0) {
336*4882a593Smuzhiyun ret = wait_for_completion_timeout(&sysmon->shutdown_comp,
337*4882a593Smuzhiyun 10 * HZ);
338*4882a593Smuzhiyun if (!ret) {
339*4882a593Smuzhiyun ret = try_wait_for_completion(&sysmon->ind_comp);
340*4882a593Smuzhiyun if (!ret)
341*4882a593Smuzhiyun dev_err(sysmon->dev,
342*4882a593Smuzhiyun "timeout waiting for shutdown ack\n");
343*4882a593Smuzhiyun }
344*4882a593Smuzhiyun }
345*4882a593Smuzhiyun }
346*4882a593Smuzhiyun
347*4882a593Smuzhiyun /**
348*4882a593Smuzhiyun * ssctl_send_event() - send notification of other remote's SSR event
349*4882a593Smuzhiyun * @sysmon: sysmon context
350*4882a593Smuzhiyun * @event: sysmon event context
351*4882a593Smuzhiyun */
ssctl_send_event(struct qcom_sysmon * sysmon,const struct sysmon_event * event)352*4882a593Smuzhiyun static void ssctl_send_event(struct qcom_sysmon *sysmon,
353*4882a593Smuzhiyun const struct sysmon_event *event)
354*4882a593Smuzhiyun {
355*4882a593Smuzhiyun struct ssctl_subsys_event_resp resp;
356*4882a593Smuzhiyun struct ssctl_subsys_event_req req;
357*4882a593Smuzhiyun struct qmi_txn txn;
358*4882a593Smuzhiyun int ret;
359*4882a593Smuzhiyun
360*4882a593Smuzhiyun memset(&resp, 0, sizeof(resp));
361*4882a593Smuzhiyun ret = qmi_txn_init(&sysmon->qmi, &txn, ssctl_subsys_event_resp_ei, &resp);
362*4882a593Smuzhiyun if (ret < 0) {
363*4882a593Smuzhiyun dev_err(sysmon->dev, "failed to allocate QMI txn\n");
364*4882a593Smuzhiyun return;
365*4882a593Smuzhiyun }
366*4882a593Smuzhiyun
367*4882a593Smuzhiyun memset(&req, 0, sizeof(req));
368*4882a593Smuzhiyun strlcpy(req.subsys_name, event->subsys_name, sizeof(req.subsys_name));
369*4882a593Smuzhiyun req.subsys_name_len = strlen(req.subsys_name);
370*4882a593Smuzhiyun req.event = event->ssr_event;
371*4882a593Smuzhiyun req.evt_driven_valid = true;
372*4882a593Smuzhiyun req.evt_driven = SSCTL_SSR_EVENT_FORCED;
373*4882a593Smuzhiyun
374*4882a593Smuzhiyun ret = qmi_send_request(&sysmon->qmi, &sysmon->ssctl, &txn,
375*4882a593Smuzhiyun SSCTL_SUBSYS_EVENT_REQ, 40,
376*4882a593Smuzhiyun ssctl_subsys_event_req_ei, &req);
377*4882a593Smuzhiyun if (ret < 0) {
378*4882a593Smuzhiyun dev_err(sysmon->dev, "failed to send shutdown request\n");
379*4882a593Smuzhiyun qmi_txn_cancel(&txn);
380*4882a593Smuzhiyun return;
381*4882a593Smuzhiyun }
382*4882a593Smuzhiyun
383*4882a593Smuzhiyun ret = qmi_txn_wait(&txn, 5 * HZ);
384*4882a593Smuzhiyun if (ret < 0)
385*4882a593Smuzhiyun dev_err(sysmon->dev, "failed receiving QMI response\n");
386*4882a593Smuzhiyun else if (resp.resp.result)
387*4882a593Smuzhiyun dev_err(sysmon->dev, "ssr event send failed\n");
388*4882a593Smuzhiyun else
389*4882a593Smuzhiyun dev_dbg(sysmon->dev, "ssr event send completed\n");
390*4882a593Smuzhiyun }
391*4882a593Smuzhiyun
392*4882a593Smuzhiyun /**
393*4882a593Smuzhiyun * ssctl_new_server() - QMI callback indicating a new service
394*4882a593Smuzhiyun * @qmi: QMI handle
395*4882a593Smuzhiyun * @svc: service information
396*4882a593Smuzhiyun *
397*4882a593Smuzhiyun * Return: 0 if we're interested in this service, -EINVAL otherwise.
398*4882a593Smuzhiyun */
ssctl_new_server(struct qmi_handle * qmi,struct qmi_service * svc)399*4882a593Smuzhiyun static int ssctl_new_server(struct qmi_handle *qmi, struct qmi_service *svc)
400*4882a593Smuzhiyun {
401*4882a593Smuzhiyun struct qcom_sysmon *sysmon = container_of(qmi, struct qcom_sysmon, qmi);
402*4882a593Smuzhiyun
403*4882a593Smuzhiyun switch (svc->version) {
404*4882a593Smuzhiyun case 1:
405*4882a593Smuzhiyun if (svc->instance != 0)
406*4882a593Smuzhiyun return -EINVAL;
407*4882a593Smuzhiyun if (strcmp(sysmon->name, "modem"))
408*4882a593Smuzhiyun return -EINVAL;
409*4882a593Smuzhiyun break;
410*4882a593Smuzhiyun case 2:
411*4882a593Smuzhiyun if (svc->instance != sysmon->ssctl_instance)
412*4882a593Smuzhiyun return -EINVAL;
413*4882a593Smuzhiyun break;
414*4882a593Smuzhiyun default:
415*4882a593Smuzhiyun return -EINVAL;
416*4882a593Smuzhiyun }
417*4882a593Smuzhiyun
418*4882a593Smuzhiyun sysmon->ssctl_version = svc->version;
419*4882a593Smuzhiyun
420*4882a593Smuzhiyun sysmon->ssctl.sq_family = AF_QIPCRTR;
421*4882a593Smuzhiyun sysmon->ssctl.sq_node = svc->node;
422*4882a593Smuzhiyun sysmon->ssctl.sq_port = svc->port;
423*4882a593Smuzhiyun
424*4882a593Smuzhiyun svc->priv = sysmon;
425*4882a593Smuzhiyun
426*4882a593Smuzhiyun complete(&sysmon->ssctl_comp);
427*4882a593Smuzhiyun
428*4882a593Smuzhiyun return 0;
429*4882a593Smuzhiyun }
430*4882a593Smuzhiyun
431*4882a593Smuzhiyun /**
432*4882a593Smuzhiyun * ssctl_del_server() - QMI callback indicating that @svc is removed
433*4882a593Smuzhiyun * @qmi: QMI handle
434*4882a593Smuzhiyun * @svc: service information
435*4882a593Smuzhiyun */
ssctl_del_server(struct qmi_handle * qmi,struct qmi_service * svc)436*4882a593Smuzhiyun static void ssctl_del_server(struct qmi_handle *qmi, struct qmi_service *svc)
437*4882a593Smuzhiyun {
438*4882a593Smuzhiyun struct qcom_sysmon *sysmon = svc->priv;
439*4882a593Smuzhiyun
440*4882a593Smuzhiyun sysmon->ssctl_version = 0;
441*4882a593Smuzhiyun }
442*4882a593Smuzhiyun
443*4882a593Smuzhiyun static const struct qmi_ops ssctl_ops = {
444*4882a593Smuzhiyun .new_server = ssctl_new_server,
445*4882a593Smuzhiyun .del_server = ssctl_del_server,
446*4882a593Smuzhiyun };
447*4882a593Smuzhiyun
sysmon_prepare(struct rproc_subdev * subdev)448*4882a593Smuzhiyun static int sysmon_prepare(struct rproc_subdev *subdev)
449*4882a593Smuzhiyun {
450*4882a593Smuzhiyun struct qcom_sysmon *sysmon = container_of(subdev, struct qcom_sysmon,
451*4882a593Smuzhiyun subdev);
452*4882a593Smuzhiyun struct sysmon_event event = {
453*4882a593Smuzhiyun .subsys_name = sysmon->name,
454*4882a593Smuzhiyun .ssr_event = SSCTL_SSR_EVENT_BEFORE_POWERUP
455*4882a593Smuzhiyun };
456*4882a593Smuzhiyun
457*4882a593Smuzhiyun mutex_lock(&sysmon->state_lock);
458*4882a593Smuzhiyun sysmon->state = SSCTL_SSR_EVENT_BEFORE_POWERUP;
459*4882a593Smuzhiyun blocking_notifier_call_chain(&sysmon_notifiers, 0, (void *)&event);
460*4882a593Smuzhiyun mutex_unlock(&sysmon->state_lock);
461*4882a593Smuzhiyun
462*4882a593Smuzhiyun return 0;
463*4882a593Smuzhiyun }
464*4882a593Smuzhiyun
465*4882a593Smuzhiyun /**
466*4882a593Smuzhiyun * sysmon_start() - start callback for the sysmon remoteproc subdevice
467*4882a593Smuzhiyun * @subdev: instance of the sysmon subdevice
468*4882a593Smuzhiyun *
469*4882a593Smuzhiyun * Inform all the listners of sysmon notifications that the rproc associated
470*4882a593Smuzhiyun * to @subdev has booted up. The rproc that booted up also needs to know
471*4882a593Smuzhiyun * which rprocs are already up and running, so send start notifications
472*4882a593Smuzhiyun * on behalf of all the online rprocs.
473*4882a593Smuzhiyun */
sysmon_start(struct rproc_subdev * subdev)474*4882a593Smuzhiyun static int sysmon_start(struct rproc_subdev *subdev)
475*4882a593Smuzhiyun {
476*4882a593Smuzhiyun struct qcom_sysmon *sysmon = container_of(subdev, struct qcom_sysmon,
477*4882a593Smuzhiyun subdev);
478*4882a593Smuzhiyun struct qcom_sysmon *target;
479*4882a593Smuzhiyun struct sysmon_event event = {
480*4882a593Smuzhiyun .subsys_name = sysmon->name,
481*4882a593Smuzhiyun .ssr_event = SSCTL_SSR_EVENT_AFTER_POWERUP
482*4882a593Smuzhiyun };
483*4882a593Smuzhiyun
484*4882a593Smuzhiyun reinit_completion(&sysmon->ssctl_comp);
485*4882a593Smuzhiyun mutex_lock(&sysmon->state_lock);
486*4882a593Smuzhiyun sysmon->state = SSCTL_SSR_EVENT_AFTER_POWERUP;
487*4882a593Smuzhiyun blocking_notifier_call_chain(&sysmon_notifiers, 0, (void *)&event);
488*4882a593Smuzhiyun mutex_unlock(&sysmon->state_lock);
489*4882a593Smuzhiyun
490*4882a593Smuzhiyun mutex_lock(&sysmon_lock);
491*4882a593Smuzhiyun list_for_each_entry(target, &sysmon_list, node) {
492*4882a593Smuzhiyun if (target == sysmon)
493*4882a593Smuzhiyun continue;
494*4882a593Smuzhiyun
495*4882a593Smuzhiyun mutex_lock(&target->state_lock);
496*4882a593Smuzhiyun event.subsys_name = target->name;
497*4882a593Smuzhiyun event.ssr_event = target->state;
498*4882a593Smuzhiyun
499*4882a593Smuzhiyun if (sysmon->ssctl_version == 2)
500*4882a593Smuzhiyun ssctl_send_event(sysmon, &event);
501*4882a593Smuzhiyun else if (sysmon->ept)
502*4882a593Smuzhiyun sysmon_send_event(sysmon, &event);
503*4882a593Smuzhiyun mutex_unlock(&target->state_lock);
504*4882a593Smuzhiyun }
505*4882a593Smuzhiyun mutex_unlock(&sysmon_lock);
506*4882a593Smuzhiyun
507*4882a593Smuzhiyun return 0;
508*4882a593Smuzhiyun }
509*4882a593Smuzhiyun
sysmon_stop(struct rproc_subdev * subdev,bool crashed)510*4882a593Smuzhiyun static void sysmon_stop(struct rproc_subdev *subdev, bool crashed)
511*4882a593Smuzhiyun {
512*4882a593Smuzhiyun struct qcom_sysmon *sysmon = container_of(subdev, struct qcom_sysmon, subdev);
513*4882a593Smuzhiyun struct sysmon_event event = {
514*4882a593Smuzhiyun .subsys_name = sysmon->name,
515*4882a593Smuzhiyun .ssr_event = SSCTL_SSR_EVENT_BEFORE_SHUTDOWN
516*4882a593Smuzhiyun };
517*4882a593Smuzhiyun
518*4882a593Smuzhiyun mutex_lock(&sysmon->state_lock);
519*4882a593Smuzhiyun sysmon->state = SSCTL_SSR_EVENT_BEFORE_SHUTDOWN;
520*4882a593Smuzhiyun blocking_notifier_call_chain(&sysmon_notifiers, 0, (void *)&event);
521*4882a593Smuzhiyun mutex_unlock(&sysmon->state_lock);
522*4882a593Smuzhiyun
523*4882a593Smuzhiyun /* Don't request graceful shutdown if we've crashed */
524*4882a593Smuzhiyun if (crashed)
525*4882a593Smuzhiyun return;
526*4882a593Smuzhiyun
527*4882a593Smuzhiyun if (sysmon->ssctl_instance) {
528*4882a593Smuzhiyun if (!wait_for_completion_timeout(&sysmon->ssctl_comp, HZ / 2))
529*4882a593Smuzhiyun dev_err(sysmon->dev, "timeout waiting for ssctl service\n");
530*4882a593Smuzhiyun }
531*4882a593Smuzhiyun
532*4882a593Smuzhiyun if (sysmon->ssctl_version)
533*4882a593Smuzhiyun ssctl_request_shutdown(sysmon);
534*4882a593Smuzhiyun else if (sysmon->ept)
535*4882a593Smuzhiyun sysmon_request_shutdown(sysmon);
536*4882a593Smuzhiyun }
537*4882a593Smuzhiyun
sysmon_unprepare(struct rproc_subdev * subdev)538*4882a593Smuzhiyun static void sysmon_unprepare(struct rproc_subdev *subdev)
539*4882a593Smuzhiyun {
540*4882a593Smuzhiyun struct qcom_sysmon *sysmon = container_of(subdev, struct qcom_sysmon,
541*4882a593Smuzhiyun subdev);
542*4882a593Smuzhiyun struct sysmon_event event = {
543*4882a593Smuzhiyun .subsys_name = sysmon->name,
544*4882a593Smuzhiyun .ssr_event = SSCTL_SSR_EVENT_AFTER_SHUTDOWN
545*4882a593Smuzhiyun };
546*4882a593Smuzhiyun
547*4882a593Smuzhiyun mutex_lock(&sysmon->state_lock);
548*4882a593Smuzhiyun sysmon->state = SSCTL_SSR_EVENT_AFTER_SHUTDOWN;
549*4882a593Smuzhiyun blocking_notifier_call_chain(&sysmon_notifiers, 0, (void *)&event);
550*4882a593Smuzhiyun mutex_unlock(&sysmon->state_lock);
551*4882a593Smuzhiyun }
552*4882a593Smuzhiyun
553*4882a593Smuzhiyun /**
554*4882a593Smuzhiyun * sysmon_notify() - notify sysmon target of another's SSR
555*4882a593Smuzhiyun * @nb: notifier_block associated with sysmon instance
556*4882a593Smuzhiyun * @event: unused
557*4882a593Smuzhiyun * @data: SSR identifier of the remote that is going down
558*4882a593Smuzhiyun */
sysmon_notify(struct notifier_block * nb,unsigned long event,void * data)559*4882a593Smuzhiyun static int sysmon_notify(struct notifier_block *nb, unsigned long event,
560*4882a593Smuzhiyun void *data)
561*4882a593Smuzhiyun {
562*4882a593Smuzhiyun struct qcom_sysmon *sysmon = container_of(nb, struct qcom_sysmon, nb);
563*4882a593Smuzhiyun struct sysmon_event *sysmon_event = data;
564*4882a593Smuzhiyun
565*4882a593Smuzhiyun /* Skip non-running rprocs and the originating instance */
566*4882a593Smuzhiyun if (sysmon->state != SSCTL_SSR_EVENT_AFTER_POWERUP ||
567*4882a593Smuzhiyun !strcmp(sysmon_event->subsys_name, sysmon->name)) {
568*4882a593Smuzhiyun dev_dbg(sysmon->dev, "not notifying %s\n", sysmon->name);
569*4882a593Smuzhiyun return NOTIFY_DONE;
570*4882a593Smuzhiyun }
571*4882a593Smuzhiyun
572*4882a593Smuzhiyun /* Only SSCTL version 2 supports SSR events */
573*4882a593Smuzhiyun if (sysmon->ssctl_version == 2)
574*4882a593Smuzhiyun ssctl_send_event(sysmon, sysmon_event);
575*4882a593Smuzhiyun else if (sysmon->ept)
576*4882a593Smuzhiyun sysmon_send_event(sysmon, sysmon_event);
577*4882a593Smuzhiyun
578*4882a593Smuzhiyun return NOTIFY_DONE;
579*4882a593Smuzhiyun }
580*4882a593Smuzhiyun
sysmon_shutdown_interrupt(int irq,void * data)581*4882a593Smuzhiyun static irqreturn_t sysmon_shutdown_interrupt(int irq, void *data)
582*4882a593Smuzhiyun {
583*4882a593Smuzhiyun struct qcom_sysmon *sysmon = data;
584*4882a593Smuzhiyun
585*4882a593Smuzhiyun complete(&sysmon->shutdown_comp);
586*4882a593Smuzhiyun
587*4882a593Smuzhiyun return IRQ_HANDLED;
588*4882a593Smuzhiyun }
589*4882a593Smuzhiyun
590*4882a593Smuzhiyun /**
591*4882a593Smuzhiyun * qcom_add_sysmon_subdev() - create a sysmon subdev for the given remoteproc
592*4882a593Smuzhiyun * @rproc: rproc context to associate the subdev with
593*4882a593Smuzhiyun * @name: name of this subdev, to use in SSR
594*4882a593Smuzhiyun * @ssctl_instance: instance id of the ssctl QMI service
595*4882a593Smuzhiyun *
596*4882a593Smuzhiyun * Return: A new qcom_sysmon object, or NULL on failure
597*4882a593Smuzhiyun */
qcom_add_sysmon_subdev(struct rproc * rproc,const char * name,int ssctl_instance)598*4882a593Smuzhiyun struct qcom_sysmon *qcom_add_sysmon_subdev(struct rproc *rproc,
599*4882a593Smuzhiyun const char *name,
600*4882a593Smuzhiyun int ssctl_instance)
601*4882a593Smuzhiyun {
602*4882a593Smuzhiyun struct qcom_sysmon *sysmon;
603*4882a593Smuzhiyun int ret;
604*4882a593Smuzhiyun
605*4882a593Smuzhiyun sysmon = kzalloc(sizeof(*sysmon), GFP_KERNEL);
606*4882a593Smuzhiyun if (!sysmon)
607*4882a593Smuzhiyun return ERR_PTR(-ENOMEM);
608*4882a593Smuzhiyun
609*4882a593Smuzhiyun sysmon->dev = rproc->dev.parent;
610*4882a593Smuzhiyun sysmon->rproc = rproc;
611*4882a593Smuzhiyun
612*4882a593Smuzhiyun sysmon->name = name;
613*4882a593Smuzhiyun sysmon->ssctl_instance = ssctl_instance;
614*4882a593Smuzhiyun
615*4882a593Smuzhiyun init_completion(&sysmon->comp);
616*4882a593Smuzhiyun init_completion(&sysmon->ind_comp);
617*4882a593Smuzhiyun init_completion(&sysmon->shutdown_comp);
618*4882a593Smuzhiyun init_completion(&sysmon->ssctl_comp);
619*4882a593Smuzhiyun mutex_init(&sysmon->lock);
620*4882a593Smuzhiyun mutex_init(&sysmon->state_lock);
621*4882a593Smuzhiyun
622*4882a593Smuzhiyun sysmon->shutdown_irq = of_irq_get_byname(sysmon->dev->of_node,
623*4882a593Smuzhiyun "shutdown-ack");
624*4882a593Smuzhiyun if (sysmon->shutdown_irq < 0) {
625*4882a593Smuzhiyun if (sysmon->shutdown_irq != -ENODATA) {
626*4882a593Smuzhiyun dev_err(sysmon->dev,
627*4882a593Smuzhiyun "failed to retrieve shutdown-ack IRQ\n");
628*4882a593Smuzhiyun return ERR_PTR(sysmon->shutdown_irq);
629*4882a593Smuzhiyun }
630*4882a593Smuzhiyun } else {
631*4882a593Smuzhiyun ret = devm_request_threaded_irq(sysmon->dev,
632*4882a593Smuzhiyun sysmon->shutdown_irq,
633*4882a593Smuzhiyun NULL, sysmon_shutdown_interrupt,
634*4882a593Smuzhiyun IRQF_TRIGGER_RISING | IRQF_ONESHOT,
635*4882a593Smuzhiyun "q6v5 shutdown-ack", sysmon);
636*4882a593Smuzhiyun if (ret) {
637*4882a593Smuzhiyun dev_err(sysmon->dev,
638*4882a593Smuzhiyun "failed to acquire shutdown-ack IRQ\n");
639*4882a593Smuzhiyun return ERR_PTR(ret);
640*4882a593Smuzhiyun }
641*4882a593Smuzhiyun }
642*4882a593Smuzhiyun
643*4882a593Smuzhiyun ret = qmi_handle_init(&sysmon->qmi, SSCTL_MAX_MSG_LEN, &ssctl_ops,
644*4882a593Smuzhiyun qmi_indication_handler);
645*4882a593Smuzhiyun if (ret < 0) {
646*4882a593Smuzhiyun dev_err(sysmon->dev, "failed to initialize qmi handle\n");
647*4882a593Smuzhiyun kfree(sysmon);
648*4882a593Smuzhiyun return ERR_PTR(ret);
649*4882a593Smuzhiyun }
650*4882a593Smuzhiyun
651*4882a593Smuzhiyun qmi_add_lookup(&sysmon->qmi, 43, 0, 0);
652*4882a593Smuzhiyun
653*4882a593Smuzhiyun sysmon->subdev.prepare = sysmon_prepare;
654*4882a593Smuzhiyun sysmon->subdev.start = sysmon_start;
655*4882a593Smuzhiyun sysmon->subdev.stop = sysmon_stop;
656*4882a593Smuzhiyun sysmon->subdev.unprepare = sysmon_unprepare;
657*4882a593Smuzhiyun
658*4882a593Smuzhiyun rproc_add_subdev(rproc, &sysmon->subdev);
659*4882a593Smuzhiyun
660*4882a593Smuzhiyun sysmon->nb.notifier_call = sysmon_notify;
661*4882a593Smuzhiyun blocking_notifier_chain_register(&sysmon_notifiers, &sysmon->nb);
662*4882a593Smuzhiyun
663*4882a593Smuzhiyun mutex_lock(&sysmon_lock);
664*4882a593Smuzhiyun list_add(&sysmon->node, &sysmon_list);
665*4882a593Smuzhiyun mutex_unlock(&sysmon_lock);
666*4882a593Smuzhiyun
667*4882a593Smuzhiyun return sysmon;
668*4882a593Smuzhiyun }
669*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(qcom_add_sysmon_subdev);
670*4882a593Smuzhiyun
671*4882a593Smuzhiyun /**
672*4882a593Smuzhiyun * qcom_remove_sysmon_subdev() - release a qcom_sysmon
673*4882a593Smuzhiyun * @sysmon: sysmon context, as retrieved by qcom_add_sysmon_subdev()
674*4882a593Smuzhiyun */
qcom_remove_sysmon_subdev(struct qcom_sysmon * sysmon)675*4882a593Smuzhiyun void qcom_remove_sysmon_subdev(struct qcom_sysmon *sysmon)
676*4882a593Smuzhiyun {
677*4882a593Smuzhiyun if (!sysmon)
678*4882a593Smuzhiyun return;
679*4882a593Smuzhiyun
680*4882a593Smuzhiyun mutex_lock(&sysmon_lock);
681*4882a593Smuzhiyun list_del(&sysmon->node);
682*4882a593Smuzhiyun mutex_unlock(&sysmon_lock);
683*4882a593Smuzhiyun
684*4882a593Smuzhiyun blocking_notifier_chain_unregister(&sysmon_notifiers, &sysmon->nb);
685*4882a593Smuzhiyun
686*4882a593Smuzhiyun rproc_remove_subdev(sysmon->rproc, &sysmon->subdev);
687*4882a593Smuzhiyun
688*4882a593Smuzhiyun qmi_handle_release(&sysmon->qmi);
689*4882a593Smuzhiyun
690*4882a593Smuzhiyun kfree(sysmon);
691*4882a593Smuzhiyun }
692*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(qcom_remove_sysmon_subdev);
693*4882a593Smuzhiyun
694*4882a593Smuzhiyun /**
695*4882a593Smuzhiyun * sysmon_probe() - probe sys_mon channel
696*4882a593Smuzhiyun * @rpdev: rpmsg device handle
697*4882a593Smuzhiyun *
698*4882a593Smuzhiyun * Find the sysmon context associated with the ancestor remoteproc and assign
699*4882a593Smuzhiyun * this rpmsg device with said sysmon context.
700*4882a593Smuzhiyun *
701*4882a593Smuzhiyun * Return: 0 on success, negative errno on failure.
702*4882a593Smuzhiyun */
sysmon_probe(struct rpmsg_device * rpdev)703*4882a593Smuzhiyun static int sysmon_probe(struct rpmsg_device *rpdev)
704*4882a593Smuzhiyun {
705*4882a593Smuzhiyun struct qcom_sysmon *sysmon;
706*4882a593Smuzhiyun struct rproc *rproc;
707*4882a593Smuzhiyun
708*4882a593Smuzhiyun rproc = rproc_get_by_child(&rpdev->dev);
709*4882a593Smuzhiyun if (!rproc) {
710*4882a593Smuzhiyun dev_err(&rpdev->dev, "sysmon device not child of rproc\n");
711*4882a593Smuzhiyun return -EINVAL;
712*4882a593Smuzhiyun }
713*4882a593Smuzhiyun
714*4882a593Smuzhiyun mutex_lock(&sysmon_lock);
715*4882a593Smuzhiyun list_for_each_entry(sysmon, &sysmon_list, node) {
716*4882a593Smuzhiyun if (sysmon->rproc == rproc)
717*4882a593Smuzhiyun goto found;
718*4882a593Smuzhiyun }
719*4882a593Smuzhiyun mutex_unlock(&sysmon_lock);
720*4882a593Smuzhiyun
721*4882a593Smuzhiyun dev_err(&rpdev->dev, "no sysmon associated with parent rproc\n");
722*4882a593Smuzhiyun
723*4882a593Smuzhiyun return -EINVAL;
724*4882a593Smuzhiyun
725*4882a593Smuzhiyun found:
726*4882a593Smuzhiyun mutex_unlock(&sysmon_lock);
727*4882a593Smuzhiyun
728*4882a593Smuzhiyun rpdev->ept->priv = sysmon;
729*4882a593Smuzhiyun sysmon->ept = rpdev->ept;
730*4882a593Smuzhiyun
731*4882a593Smuzhiyun return 0;
732*4882a593Smuzhiyun }
733*4882a593Smuzhiyun
734*4882a593Smuzhiyun /**
735*4882a593Smuzhiyun * sysmon_remove() - sys_mon channel remove handler
736*4882a593Smuzhiyun * @rpdev: rpmsg device handle
737*4882a593Smuzhiyun *
738*4882a593Smuzhiyun * Disassociate the rpmsg device with the sysmon instance.
739*4882a593Smuzhiyun */
sysmon_remove(struct rpmsg_device * rpdev)740*4882a593Smuzhiyun static void sysmon_remove(struct rpmsg_device *rpdev)
741*4882a593Smuzhiyun {
742*4882a593Smuzhiyun struct qcom_sysmon *sysmon = rpdev->ept->priv;
743*4882a593Smuzhiyun
744*4882a593Smuzhiyun sysmon->ept = NULL;
745*4882a593Smuzhiyun }
746*4882a593Smuzhiyun
747*4882a593Smuzhiyun static const struct rpmsg_device_id sysmon_match[] = {
748*4882a593Smuzhiyun { "sys_mon" },
749*4882a593Smuzhiyun {}
750*4882a593Smuzhiyun };
751*4882a593Smuzhiyun
752*4882a593Smuzhiyun static struct rpmsg_driver sysmon_driver = {
753*4882a593Smuzhiyun .probe = sysmon_probe,
754*4882a593Smuzhiyun .remove = sysmon_remove,
755*4882a593Smuzhiyun .callback = sysmon_callback,
756*4882a593Smuzhiyun .id_table = sysmon_match,
757*4882a593Smuzhiyun .drv = {
758*4882a593Smuzhiyun .name = "qcom_sysmon",
759*4882a593Smuzhiyun },
760*4882a593Smuzhiyun };
761*4882a593Smuzhiyun
762*4882a593Smuzhiyun module_rpmsg_driver(sysmon_driver);
763*4882a593Smuzhiyun
764*4882a593Smuzhiyun MODULE_DESCRIPTION("Qualcomm sysmon driver");
765*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
766