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 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 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 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 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 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 172 static void pmic_glink_aux_release(struct device *dev) {} 173 174 static int pmic_glink_add_aux_device(struct pmic_glink *pg, 175 struct auxiliary_device *aux, 176 const char *name) 177 { 178 struct device *parent = pg->dev; 179 int ret; 180 181 aux->name = name; 182 aux->dev.parent = parent; 183 aux->dev.release = pmic_glink_aux_release; 184 device_set_of_node_from_dev(&aux->dev, parent); 185 ret = auxiliary_device_init(aux); 186 if (ret) 187 return ret; 188 189 ret = auxiliary_device_add(aux); 190 if (ret) 191 auxiliary_device_uninit(aux); 192 193 return ret; 194 } 195 196 static void pmic_glink_del_aux_device(struct pmic_glink *pg, 197 struct auxiliary_device *aux) 198 { 199 auxiliary_device_delete(aux); 200 auxiliary_device_uninit(aux); 201 } 202 203 static void pmic_glink_state_notify_clients(struct pmic_glink *pg) 204 { 205 struct pmic_glink_client *client; 206 unsigned int new_state = pg->client_state; 207 unsigned long flags; 208 209 if (pg->client_state != SERVREG_SERVICE_STATE_UP) { 210 if (pg->pdr_state == SERVREG_SERVICE_STATE_UP && pg->ept) 211 new_state = SERVREG_SERVICE_STATE_UP; 212 } else { 213 if (pg->pdr_state == SERVREG_SERVICE_STATE_DOWN || !pg->ept) 214 new_state = SERVREG_SERVICE_STATE_DOWN; 215 } 216 217 if (new_state != pg->client_state) { 218 spin_lock_irqsave(&pg->client_lock, flags); 219 list_for_each_entry(client, &pg->clients, node) 220 client->pdr_notify(client->priv, new_state); 221 spin_unlock_irqrestore(&pg->client_lock, flags); 222 pg->client_state = new_state; 223 } 224 } 225 226 static void pmic_glink_pdr_callback(int state, char *svc_path, void *priv) 227 { 228 struct pmic_glink *pg = priv; 229 230 mutex_lock(&pg->state_lock); 231 pg->pdr_state = state; 232 233 pmic_glink_state_notify_clients(pg); 234 mutex_unlock(&pg->state_lock); 235 } 236 237 static int pmic_glink_rpmsg_probe(struct rpmsg_device *rpdev) 238 { 239 struct pmic_glink *pg = __pmic_glink; 240 int ret = 0; 241 242 mutex_lock(&__pmic_glink_lock); 243 if (!pg) { 244 ret = dev_err_probe(&rpdev->dev, -ENODEV, "no pmic_glink device to attach to\n"); 245 goto out_unlock; 246 } 247 248 dev_set_drvdata(&rpdev->dev, pg); 249 250 mutex_lock(&pg->state_lock); 251 pg->ept = rpdev->ept; 252 pmic_glink_state_notify_clients(pg); 253 mutex_unlock(&pg->state_lock); 254 255 out_unlock: 256 mutex_unlock(&__pmic_glink_lock); 257 return ret; 258 } 259 260 static void pmic_glink_rpmsg_remove(struct rpmsg_device *rpdev) 261 { 262 struct pmic_glink *pg; 263 264 mutex_lock(&__pmic_glink_lock); 265 pg = __pmic_glink; 266 if (!pg) 267 goto out_unlock; 268 269 mutex_lock(&pg->state_lock); 270 pg->ept = NULL; 271 pmic_glink_state_notify_clients(pg); 272 mutex_unlock(&pg->state_lock); 273 out_unlock: 274 mutex_unlock(&__pmic_glink_lock); 275 } 276 277 static const struct rpmsg_device_id pmic_glink_rpmsg_id_match[] = { 278 { "PMIC_RTR_ADSP_APPS" }, 279 {} 280 }; 281 282 static struct rpmsg_driver pmic_glink_rpmsg_driver = { 283 .probe = pmic_glink_rpmsg_probe, 284 .remove = pmic_glink_rpmsg_remove, 285 .callback = pmic_glink_rpmsg_callback, 286 .id_table = pmic_glink_rpmsg_id_match, 287 .drv = { 288 .name = "qcom_pmic_glink_rpmsg", 289 }, 290 }; 291 292 static int pmic_glink_probe(struct platform_device *pdev) 293 { 294 const unsigned long *match_data; 295 struct pdr_service *service; 296 struct pmic_glink *pg; 297 int ret; 298 299 pg = devm_kzalloc(&pdev->dev, sizeof(*pg), GFP_KERNEL); 300 if (!pg) 301 return -ENOMEM; 302 303 dev_set_drvdata(&pdev->dev, pg); 304 305 pg->dev = &pdev->dev; 306 307 INIT_LIST_HEAD(&pg->clients); 308 spin_lock_init(&pg->client_lock); 309 mutex_init(&pg->state_lock); 310 311 match_data = (unsigned long *)of_device_get_match_data(&pdev->dev); 312 if (!match_data) 313 return -EINVAL; 314 315 pg->client_mask = *match_data; 316 317 pg->pdr = pdr_handle_alloc(pmic_glink_pdr_callback, pg); 318 if (IS_ERR(pg->pdr)) { 319 ret = dev_err_probe(&pdev->dev, PTR_ERR(pg->pdr), 320 "failed to initialize pdr\n"); 321 return ret; 322 } 323 324 if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_UCSI)) { 325 ret = pmic_glink_add_aux_device(pg, &pg->ucsi_aux, "ucsi"); 326 if (ret) 327 goto out_release_pdr_handle; 328 } 329 if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_ALTMODE)) { 330 ret = pmic_glink_add_aux_device(pg, &pg->altmode_aux, "altmode"); 331 if (ret) 332 goto out_release_ucsi_aux; 333 } 334 if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_BATT)) { 335 ret = pmic_glink_add_aux_device(pg, &pg->ps_aux, "power-supply"); 336 if (ret) 337 goto out_release_altmode_aux; 338 } 339 340 service = pdr_add_lookup(pg->pdr, "tms/servreg", "msm/adsp/charger_pd"); 341 if (IS_ERR(service)) { 342 ret = dev_err_probe(&pdev->dev, PTR_ERR(service), 343 "failed adding pdr lookup for charger_pd\n"); 344 goto out_release_aux_devices; 345 } 346 347 mutex_lock(&__pmic_glink_lock); 348 __pmic_glink = pg; 349 mutex_unlock(&__pmic_glink_lock); 350 351 return 0; 352 353 out_release_aux_devices: 354 if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_BATT)) 355 pmic_glink_del_aux_device(pg, &pg->ps_aux); 356 out_release_altmode_aux: 357 if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_ALTMODE)) 358 pmic_glink_del_aux_device(pg, &pg->altmode_aux); 359 out_release_ucsi_aux: 360 if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_UCSI)) 361 pmic_glink_del_aux_device(pg, &pg->ucsi_aux); 362 out_release_pdr_handle: 363 pdr_handle_release(pg->pdr); 364 365 return ret; 366 } 367 368 static void pmic_glink_remove(struct platform_device *pdev) 369 { 370 struct pmic_glink *pg = dev_get_drvdata(&pdev->dev); 371 372 pdr_handle_release(pg->pdr); 373 374 if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_BATT)) 375 pmic_glink_del_aux_device(pg, &pg->ps_aux); 376 if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_ALTMODE)) 377 pmic_glink_del_aux_device(pg, &pg->altmode_aux); 378 if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_UCSI)) 379 pmic_glink_del_aux_device(pg, &pg->ucsi_aux); 380 381 mutex_lock(&__pmic_glink_lock); 382 __pmic_glink = NULL; 383 mutex_unlock(&__pmic_glink_lock); 384 } 385 386 static const unsigned long pmic_glink_sc8280xp_client_mask = BIT(PMIC_GLINK_CLIENT_BATT) | 387 BIT(PMIC_GLINK_CLIENT_ALTMODE); 388 389 static const unsigned long pmic_glink_sm8450_client_mask = BIT(PMIC_GLINK_CLIENT_BATT) | 390 BIT(PMIC_GLINK_CLIENT_ALTMODE) | 391 BIT(PMIC_GLINK_CLIENT_UCSI); 392 393 static const struct of_device_id pmic_glink_of_match[] = { 394 { .compatible = "qcom,sc8280xp-pmic-glink", .data = &pmic_glink_sc8280xp_client_mask }, 395 { .compatible = "qcom,pmic-glink", .data = &pmic_glink_sm8450_client_mask }, 396 {} 397 }; 398 MODULE_DEVICE_TABLE(of, pmic_glink_of_match); 399 400 static struct platform_driver pmic_glink_driver = { 401 .probe = pmic_glink_probe, 402 .remove_new = pmic_glink_remove, 403 .driver = { 404 .name = "qcom_pmic_glink", 405 .of_match_table = pmic_glink_of_match, 406 }, 407 }; 408 409 static int pmic_glink_init(void) 410 { 411 int ret; 412 413 ret = platform_driver_register(&pmic_glink_driver); 414 if (ret < 0) 415 return ret; 416 417 ret = register_rpmsg_driver(&pmic_glink_rpmsg_driver); 418 if (ret < 0) { 419 platform_driver_unregister(&pmic_glink_driver); 420 return ret; 421 } 422 423 return 0; 424 } 425 module_init(pmic_glink_init); 426 427 static void pmic_glink_exit(void) 428 { 429 unregister_rpmsg_driver(&pmic_glink_rpmsg_driver); 430 platform_driver_unregister(&pmic_glink_driver); 431 } 432 module_exit(pmic_glink_exit); 433 434 MODULE_DESCRIPTION("Qualcomm PMIC GLINK driver"); 435 MODULE_LICENSE("GPL"); 436