1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright (c) 2019-2020, The Linux Foundation. All rights reserved.
4 * Copyright (c) 2022, Linaro Ltd
5 */
6 #include <linux/auxiliary_bus.h>
7 #include <linux/delay.h>
8 #include <linux/module.h>
9 #include <linux/of.h>
10 #include <linux/platform_device.h>
11 #include <linux/rpmsg.h>
12 #include <linux/slab.h>
13 #include <linux/soc/qcom/pdr.h>
14 #include <linux/soc/qcom/pmic_glink.h>
15 #include <linux/spinlock.h>
16
17 #define PMIC_GLINK_SEND_TIMEOUT (5 * HZ)
18
19 enum {
20 PMIC_GLINK_CLIENT_BATT = 0,
21 PMIC_GLINK_CLIENT_ALTMODE,
22 PMIC_GLINK_CLIENT_UCSI,
23 };
24
25 struct pmic_glink {
26 struct device *dev;
27 struct pdr_handle *pdr;
28
29 struct rpmsg_endpoint *ept;
30
31 unsigned long client_mask;
32
33 struct auxiliary_device altmode_aux;
34 struct auxiliary_device ps_aux;
35 struct auxiliary_device ucsi_aux;
36
37 /* serializing client_state and pdr_state updates */
38 struct mutex state_lock;
39 unsigned int client_state;
40 unsigned int pdr_state;
41
42 /* serializing clients list updates */
43 spinlock_t client_lock;
44 struct list_head clients;
45 };
46
47 static struct pmic_glink *__pmic_glink;
48 static DEFINE_MUTEX(__pmic_glink_lock);
49
50 struct pmic_glink_client {
51 struct list_head node;
52
53 struct pmic_glink *pg;
54 unsigned int id;
55
56 void (*cb)(const void *data, size_t len, void *priv);
57 void (*pdr_notify)(void *priv, int state);
58 void *priv;
59 };
60
_devm_pmic_glink_release_client(struct device * dev,void * res)61 static void _devm_pmic_glink_release_client(struct device *dev, void *res)
62 {
63 struct pmic_glink_client *client = (struct pmic_glink_client *)res;
64 struct pmic_glink *pg = client->pg;
65 unsigned long flags;
66
67 spin_lock_irqsave(&pg->client_lock, flags);
68 list_del(&client->node);
69 spin_unlock_irqrestore(&pg->client_lock, flags);
70 }
71
devm_pmic_glink_client_alloc(struct device * dev,unsigned int id,void (* cb)(const void *,size_t,void *),void (* pdr)(void *,int),void * priv)72 struct pmic_glink_client *devm_pmic_glink_client_alloc(struct device *dev,
73 unsigned int id,
74 void (*cb)(const void *, size_t, void *),
75 void (*pdr)(void *, int),
76 void *priv)
77 {
78 struct pmic_glink_client *client;
79 struct pmic_glink *pg = dev_get_drvdata(dev->parent);
80
81 client = devres_alloc(_devm_pmic_glink_release_client, sizeof(*client), GFP_KERNEL);
82 if (!client)
83 return ERR_PTR(-ENOMEM);
84
85 client->pg = pg;
86 client->id = id;
87 client->cb = cb;
88 client->pdr_notify = pdr;
89 client->priv = priv;
90 INIT_LIST_HEAD(&client->node);
91
92 devres_add(dev, client);
93
94 return client;
95 }
96 EXPORT_SYMBOL_GPL(devm_pmic_glink_client_alloc);
97
pmic_glink_client_register(struct pmic_glink_client * client)98 void pmic_glink_client_register(struct pmic_glink_client *client)
99 {
100 struct pmic_glink *pg = client->pg;
101 unsigned long flags;
102
103 mutex_lock(&pg->state_lock);
104 spin_lock_irqsave(&pg->client_lock, flags);
105
106 list_add(&client->node, &pg->clients);
107 client->pdr_notify(client->priv, pg->client_state);
108
109 spin_unlock_irqrestore(&pg->client_lock, flags);
110 mutex_unlock(&pg->state_lock);
111
112 }
113 EXPORT_SYMBOL_GPL(pmic_glink_client_register);
114
pmic_glink_send(struct pmic_glink_client * client,void * data,size_t len)115 int pmic_glink_send(struct pmic_glink_client *client, void *data, size_t len)
116 {
117 struct pmic_glink *pg = client->pg;
118 bool timeout_reached = false;
119 unsigned long start;
120 int ret;
121
122 mutex_lock(&pg->state_lock);
123 if (!pg->ept) {
124 ret = -ECONNRESET;
125 } else {
126 start = jiffies;
127 for (;;) {
128 ret = rpmsg_send(pg->ept, data, len);
129 if (ret != -EAGAIN)
130 break;
131
132 if (timeout_reached) {
133 ret = -ETIMEDOUT;
134 break;
135 }
136
137 usleep_range(1000, 5000);
138 timeout_reached = time_after(jiffies, start + PMIC_GLINK_SEND_TIMEOUT);
139 }
140 }
141 mutex_unlock(&pg->state_lock);
142
143 return ret;
144 }
145 EXPORT_SYMBOL_GPL(pmic_glink_send);
146
pmic_glink_rpmsg_callback(struct rpmsg_device * rpdev,void * data,int len,void * priv,u32 addr)147 static int pmic_glink_rpmsg_callback(struct rpmsg_device *rpdev, void *data,
148 int len, void *priv, u32 addr)
149 {
150 struct pmic_glink_client *client;
151 struct pmic_glink_hdr *hdr;
152 struct pmic_glink *pg = dev_get_drvdata(&rpdev->dev);
153 unsigned long flags;
154
155 if (len < sizeof(*hdr)) {
156 dev_warn(pg->dev, "ignoring truncated message\n");
157 return 0;
158 }
159
160 hdr = data;
161
162 spin_lock_irqsave(&pg->client_lock, flags);
163 list_for_each_entry(client, &pg->clients, node) {
164 if (client->id == le32_to_cpu(hdr->owner))
165 client->cb(data, len, client->priv);
166 }
167 spin_unlock_irqrestore(&pg->client_lock, flags);
168
169 return 0;
170 }
171
pmic_glink_aux_release(struct device * dev)172 static void pmic_glink_aux_release(struct device *dev)
173 {
174 of_node_put(dev->of_node);
175 }
176
pmic_glink_add_aux_device(struct pmic_glink * pg,struct auxiliary_device * aux,const char * name)177 static int pmic_glink_add_aux_device(struct pmic_glink *pg,
178 struct auxiliary_device *aux,
179 const char *name)
180 {
181 struct device *parent = pg->dev;
182 int ret;
183
184 aux->name = name;
185 aux->dev.parent = parent;
186 aux->dev.release = pmic_glink_aux_release;
187 device_set_of_node_from_dev(&aux->dev, parent);
188 ret = auxiliary_device_init(aux);
189 if (ret) {
190 of_node_put(aux->dev.of_node);
191 return ret;
192 }
193
194 ret = auxiliary_device_add(aux);
195 if (ret)
196 auxiliary_device_uninit(aux);
197
198 return ret;
199 }
200
pmic_glink_del_aux_device(struct pmic_glink * pg,struct auxiliary_device * aux)201 static void pmic_glink_del_aux_device(struct pmic_glink *pg,
202 struct auxiliary_device *aux)
203 {
204 auxiliary_device_delete(aux);
205 auxiliary_device_uninit(aux);
206 }
207
pmic_glink_state_notify_clients(struct pmic_glink * pg)208 static void pmic_glink_state_notify_clients(struct pmic_glink *pg)
209 {
210 struct pmic_glink_client *client;
211 unsigned int new_state = pg->client_state;
212 unsigned long flags;
213
214 if (pg->client_state != SERVREG_SERVICE_STATE_UP) {
215 if (pg->pdr_state == SERVREG_SERVICE_STATE_UP && pg->ept)
216 new_state = SERVREG_SERVICE_STATE_UP;
217 } else {
218 if (pg->pdr_state == SERVREG_SERVICE_STATE_DOWN || !pg->ept)
219 new_state = SERVREG_SERVICE_STATE_DOWN;
220 }
221
222 if (new_state != pg->client_state) {
223 spin_lock_irqsave(&pg->client_lock, flags);
224 list_for_each_entry(client, &pg->clients, node)
225 client->pdr_notify(client->priv, new_state);
226 spin_unlock_irqrestore(&pg->client_lock, flags);
227 pg->client_state = new_state;
228 }
229 }
230
pmic_glink_pdr_callback(int state,char * svc_path,void * priv)231 static void pmic_glink_pdr_callback(int state, char *svc_path, void *priv)
232 {
233 struct pmic_glink *pg = priv;
234
235 mutex_lock(&pg->state_lock);
236 pg->pdr_state = state;
237
238 pmic_glink_state_notify_clients(pg);
239 mutex_unlock(&pg->state_lock);
240 }
241
pmic_glink_rpmsg_probe(struct rpmsg_device * rpdev)242 static int pmic_glink_rpmsg_probe(struct rpmsg_device *rpdev)
243 {
244 struct pmic_glink *pg = __pmic_glink;
245 int ret = 0;
246
247 mutex_lock(&__pmic_glink_lock);
248 if (!pg) {
249 ret = dev_err_probe(&rpdev->dev, -ENODEV, "no pmic_glink device to attach to\n");
250 goto out_unlock;
251 }
252
253 dev_set_drvdata(&rpdev->dev, pg);
254
255 mutex_lock(&pg->state_lock);
256 pg->ept = rpdev->ept;
257 pmic_glink_state_notify_clients(pg);
258 mutex_unlock(&pg->state_lock);
259
260 out_unlock:
261 mutex_unlock(&__pmic_glink_lock);
262 return ret;
263 }
264
pmic_glink_rpmsg_remove(struct rpmsg_device * rpdev)265 static void pmic_glink_rpmsg_remove(struct rpmsg_device *rpdev)
266 {
267 struct pmic_glink *pg;
268
269 mutex_lock(&__pmic_glink_lock);
270 pg = __pmic_glink;
271 if (!pg)
272 goto out_unlock;
273
274 mutex_lock(&pg->state_lock);
275 pg->ept = NULL;
276 pmic_glink_state_notify_clients(pg);
277 mutex_unlock(&pg->state_lock);
278 out_unlock:
279 mutex_unlock(&__pmic_glink_lock);
280 }
281
282 static const struct rpmsg_device_id pmic_glink_rpmsg_id_match[] = {
283 { "PMIC_RTR_ADSP_APPS" },
284 {}
285 };
286
287 static struct rpmsg_driver pmic_glink_rpmsg_driver = {
288 .probe = pmic_glink_rpmsg_probe,
289 .remove = pmic_glink_rpmsg_remove,
290 .callback = pmic_glink_rpmsg_callback,
291 .id_table = pmic_glink_rpmsg_id_match,
292 .drv = {
293 .name = "qcom_pmic_glink_rpmsg",
294 },
295 };
296
pmic_glink_probe(struct platform_device * pdev)297 static int pmic_glink_probe(struct platform_device *pdev)
298 {
299 const unsigned long *match_data;
300 struct pdr_service *service;
301 struct pmic_glink *pg;
302 int ret;
303
304 pg = devm_kzalloc(&pdev->dev, sizeof(*pg), GFP_KERNEL);
305 if (!pg)
306 return -ENOMEM;
307
308 dev_set_drvdata(&pdev->dev, pg);
309
310 pg->dev = &pdev->dev;
311
312 INIT_LIST_HEAD(&pg->clients);
313 spin_lock_init(&pg->client_lock);
314 mutex_init(&pg->state_lock);
315
316 match_data = (unsigned long *)of_device_get_match_data(&pdev->dev);
317 if (!match_data)
318 return -EINVAL;
319
320 pg->client_mask = *match_data;
321
322 pg->pdr = pdr_handle_alloc(pmic_glink_pdr_callback, pg);
323 if (IS_ERR(pg->pdr)) {
324 ret = dev_err_probe(&pdev->dev, PTR_ERR(pg->pdr),
325 "failed to initialize pdr\n");
326 return ret;
327 }
328
329 if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_UCSI)) {
330 ret = pmic_glink_add_aux_device(pg, &pg->ucsi_aux, "ucsi");
331 if (ret)
332 goto out_release_pdr_handle;
333 }
334 if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_ALTMODE)) {
335 ret = pmic_glink_add_aux_device(pg, &pg->altmode_aux, "altmode");
336 if (ret)
337 goto out_release_ucsi_aux;
338 }
339 if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_BATT)) {
340 ret = pmic_glink_add_aux_device(pg, &pg->ps_aux, "power-supply");
341 if (ret)
342 goto out_release_altmode_aux;
343 }
344
345 service = pdr_add_lookup(pg->pdr, "tms/servreg", "msm/adsp/charger_pd");
346 if (IS_ERR(service)) {
347 ret = dev_err_probe(&pdev->dev, PTR_ERR(service),
348 "failed adding pdr lookup for charger_pd\n");
349 goto out_release_aux_devices;
350 }
351
352 mutex_lock(&__pmic_glink_lock);
353 __pmic_glink = pg;
354 mutex_unlock(&__pmic_glink_lock);
355
356 return 0;
357
358 out_release_aux_devices:
359 if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_BATT))
360 pmic_glink_del_aux_device(pg, &pg->ps_aux);
361 out_release_altmode_aux:
362 if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_ALTMODE))
363 pmic_glink_del_aux_device(pg, &pg->altmode_aux);
364 out_release_ucsi_aux:
365 if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_UCSI))
366 pmic_glink_del_aux_device(pg, &pg->ucsi_aux);
367 out_release_pdr_handle:
368 pdr_handle_release(pg->pdr);
369
370 return ret;
371 }
372
pmic_glink_remove(struct platform_device * pdev)373 static void pmic_glink_remove(struct platform_device *pdev)
374 {
375 struct pmic_glink *pg = dev_get_drvdata(&pdev->dev);
376
377 pdr_handle_release(pg->pdr);
378
379 if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_BATT))
380 pmic_glink_del_aux_device(pg, &pg->ps_aux);
381 if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_ALTMODE))
382 pmic_glink_del_aux_device(pg, &pg->altmode_aux);
383 if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_UCSI))
384 pmic_glink_del_aux_device(pg, &pg->ucsi_aux);
385
386 mutex_lock(&__pmic_glink_lock);
387 __pmic_glink = NULL;
388 mutex_unlock(&__pmic_glink_lock);
389 }
390
391 static const unsigned long pmic_glink_sc8280xp_client_mask = BIT(PMIC_GLINK_CLIENT_BATT) |
392 BIT(PMIC_GLINK_CLIENT_ALTMODE);
393
394 static const unsigned long pmic_glink_sm8450_client_mask = BIT(PMIC_GLINK_CLIENT_BATT) |
395 BIT(PMIC_GLINK_CLIENT_ALTMODE) |
396 BIT(PMIC_GLINK_CLIENT_UCSI);
397
398 static const struct of_device_id pmic_glink_of_match[] = {
399 { .compatible = "qcom,sc8280xp-pmic-glink", .data = &pmic_glink_sc8280xp_client_mask },
400 { .compatible = "qcom,pmic-glink", .data = &pmic_glink_sm8450_client_mask },
401 {}
402 };
403 MODULE_DEVICE_TABLE(of, pmic_glink_of_match);
404
405 static struct platform_driver pmic_glink_driver = {
406 .probe = pmic_glink_probe,
407 .remove_new = pmic_glink_remove,
408 .driver = {
409 .name = "qcom_pmic_glink",
410 .of_match_table = pmic_glink_of_match,
411 },
412 };
413
pmic_glink_init(void)414 static int pmic_glink_init(void)
415 {
416 int ret;
417
418 ret = platform_driver_register(&pmic_glink_driver);
419 if (ret < 0)
420 return ret;
421
422 ret = register_rpmsg_driver(&pmic_glink_rpmsg_driver);
423 if (ret < 0) {
424 platform_driver_unregister(&pmic_glink_driver);
425 return ret;
426 }
427
428 return 0;
429 }
430 module_init(pmic_glink_init);
431
pmic_glink_exit(void)432 static void pmic_glink_exit(void)
433 {
434 unregister_rpmsg_driver(&pmic_glink_rpmsg_driver);
435 platform_driver_unregister(&pmic_glink_driver);
436 }
437 module_exit(pmic_glink_exit);
438
439 MODULE_DESCRIPTION("Qualcomm PMIC GLINK driver");
440 MODULE_LICENSE("GPL");
441