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