1 // SPDX-License-Identifier: GPL-2.0-only
3  * Copyright (c) 2019-2020, The Linux Foundation. All rights reserved.
65 	struct pmic_glink *pg = client->pg;  in _devm_pmic_glink_release_client()
68 	spin_lock_irqsave(&pg->client_lock, flags);  in _devm_pmic_glink_release_client()
69 	list_del(&client->node);  in _devm_pmic_glink_release_client()
70 	spin_unlock_irqrestore(&pg->client_lock, flags);  in _devm_pmic_glink_release_client()
80 	struct pmic_glink *pg = dev_get_drvdata(dev->parent);  in devm_pmic_glink_client_alloc()
84 		return ERR_PTR(-ENOMEM);  in devm_pmic_glink_client_alloc()
86 	client->pg = pg;  in devm_pmic_glink_client_alloc()
87 	client->id = id;  in devm_pmic_glink_client_alloc()
88 	client->cb = cb;  in devm_pmic_glink_client_alloc()
89 	client->pdr_notify = pdr;  in devm_pmic_glink_client_alloc()
90 	client->priv = priv;  in devm_pmic_glink_client_alloc()
91 	INIT_LIST_HEAD(&client->node);  in devm_pmic_glink_client_alloc()
101 	struct pmic_glink *pg = client->pg;  in pmic_glink_client_register()
104 	guard(mutex)(&pg->state_lock);  in pmic_glink_client_register()
105 	spin_lock_irqsave(&pg->client_lock, flags);  in pmic_glink_client_register()
107 	list_add(&client->node, &pg->clients);  in pmic_glink_client_register()
108 	client->pdr_notify(client->priv, pg->client_state);  in pmic_glink_client_register()
110 	spin_unlock_irqrestore(&pg->client_lock, flags);  in pmic_glink_client_register()
116 	struct pmic_glink *pg = client->pg;  in pmic_glink_send()
121 	guard(mutex)(&pg->state_lock);  in pmic_glink_send()
122 	if (!pg->ept) {  in pmic_glink_send()
123 		return -ECONNRESET;  in pmic_glink_send()
128 		ret = rpmsg_send(pg->ept, data, len);  in pmic_glink_send()
129 		if (ret != -EAGAIN)  in pmic_glink_send()
133 			ret = -ETIMEDOUT;  in pmic_glink_send()
150 	struct pmic_glink *pg = dev_get_drvdata(&rpdev->dev);  in pmic_glink_rpmsg_callback()
154 		dev_warn(pg->dev, "ignoring truncated message\n");  in pmic_glink_rpmsg_callback()
160 	spin_lock_irqsave(&pg->client_lock, flags);  in pmic_glink_rpmsg_callback()
161 	list_for_each_entry(client, &pg->clients, node) {  in pmic_glink_rpmsg_callback()
162 		if (client->id == le32_to_cpu(hdr->owner))  in pmic_glink_rpmsg_callback()
163 			client->cb(data, len, client->priv);  in pmic_glink_rpmsg_callback()
165 	spin_unlock_irqrestore(&pg->client_lock, flags);  in pmic_glink_rpmsg_callback()
172 	of_node_put(dev->of_node);  in pmic_glink_aux_release()
179 	struct device *parent = pg->dev;  in pmic_glink_add_aux_device()
182 	aux->name = name;  in pmic_glink_add_aux_device()
183 	aux->dev.parent = parent;  in pmic_glink_add_aux_device()
184 	aux->dev.release = pmic_glink_aux_release;  in pmic_glink_add_aux_device()
185 	device_set_of_node_from_dev(&aux->dev, parent);  in pmic_glink_add_aux_device()
188 		of_node_put(aux->dev.of_node);  in pmic_glink_add_aux_device()
209 	unsigned int new_state = pg->client_state;  in pmic_glink_state_notify_clients()
212 	if (pg->client_state != SERVREG_SERVICE_STATE_UP) {  in pmic_glink_state_notify_clients()
213 		if (pg->pdr_state == SERVREG_SERVICE_STATE_UP && pg->ept)  in pmic_glink_state_notify_clients()
216 		if (pg->pdr_state == SERVREG_SERVICE_STATE_DOWN || !pg->ept)  in pmic_glink_state_notify_clients()
220 	if (new_state != pg->client_state) {  in pmic_glink_state_notify_clients()
221 		spin_lock_irqsave(&pg->client_lock, flags);  in pmic_glink_state_notify_clients()
222 		list_for_each_entry(client, &pg->clients, node)  in pmic_glink_state_notify_clients()
223 			client->pdr_notify(client->priv, new_state);  in pmic_glink_state_notify_clients()
224 		spin_unlock_irqrestore(&pg->client_lock, flags);  in pmic_glink_state_notify_clients()
225 		pg->client_state = new_state;  in pmic_glink_state_notify_clients()
233 	guard(mutex)(&pg->state_lock);  in pmic_glink_pdr_callback()
234 	pg->pdr_state = state;  in pmic_glink_pdr_callback()
246 		return dev_err_probe(&rpdev->dev, -ENODEV, "no pmic_glink device to attach to\n");  in pmic_glink_rpmsg_probe()
248 	dev_set_drvdata(&rpdev->dev, pg);  in pmic_glink_rpmsg_probe()
250 	guard(mutex)(&pg->state_lock);  in pmic_glink_rpmsg_probe()
251 	pg->ept = rpdev->ept;  in pmic_glink_rpmsg_probe()
266 	guard(mutex)(&pg->state_lock);  in pmic_glink_rpmsg_remove()
267 	pg->ept = NULL;  in pmic_glink_rpmsg_remove()
293 	pg = devm_kzalloc(&pdev->dev, sizeof(*pg), GFP_KERNEL);  in pmic_glink_probe()
295 		return -ENOMEM;  in pmic_glink_probe()
297 	dev_set_drvdata(&pdev->dev, pg);  in pmic_glink_probe()
299 	pg->dev = &pdev->dev;  in pmic_glink_probe()
301 	INIT_LIST_HEAD(&pg->clients);  in pmic_glink_probe()
302 	spin_lock_init(&pg->client_lock);  in pmic_glink_probe()
303 	mutex_init(&pg->state_lock);  in pmic_glink_probe()
305 	match_data = (unsigned long *)of_device_get_match_data(&pdev->dev);  in pmic_glink_probe()
307 		return -EINVAL;  in pmic_glink_probe()
309 	pg->client_mask = *match_data;  in pmic_glink_probe()
311 	pg->pdr = pdr_handle_alloc(pmic_glink_pdr_callback, pg);  in pmic_glink_probe()
312 	if (IS_ERR(pg->pdr)) {  in pmic_glink_probe()
313 		ret = dev_err_probe(&pdev->dev, PTR_ERR(pg->pdr),  in pmic_glink_probe()
318 	if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_UCSI)) {  in pmic_glink_probe()
319 		ret = pmic_glink_add_aux_device(pg, &pg->ucsi_aux, "ucsi");  in pmic_glink_probe()
323 	if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_ALTMODE)) {  in pmic_glink_probe()
324 		ret = pmic_glink_add_aux_device(pg, &pg->altmode_aux, "altmode");  in pmic_glink_probe()
328 	if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_BATT)) {  in pmic_glink_probe()
329 		ret = pmic_glink_add_aux_device(pg, &pg->ps_aux, "power-supply");  in pmic_glink_probe()
334 	service = pdr_add_lookup(pg->pdr, "tms/servreg", "msm/adsp/charger_pd");  in pmic_glink_probe()
336 		ret = dev_err_probe(&pdev->dev, PTR_ERR(service),  in pmic_glink_probe()
348 	if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_BATT))  in pmic_glink_probe()
349 		pmic_glink_del_aux_device(pg, &pg->ps_aux);  in pmic_glink_probe()
351 	if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_ALTMODE))  in pmic_glink_probe()
352 		pmic_glink_del_aux_device(pg, &pg->altmode_aux);  in pmic_glink_probe()
354 	if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_UCSI))  in pmic_glink_probe()
355 		pmic_glink_del_aux_device(pg, &pg->ucsi_aux);  in pmic_glink_probe()
357 	pdr_handle_release(pg->pdr);  in pmic_glink_probe()
364 	struct pmic_glink *pg = dev_get_drvdata(&pdev->dev);  in pmic_glink_remove()
366 	pdr_handle_release(pg->pdr);  in pmic_glink_remove()
368 	if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_BATT))  in pmic_glink_remove()
369 		pmic_glink_del_aux_device(pg, &pg->ps_aux);  in pmic_glink_remove()
370 	if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_ALTMODE))  in pmic_glink_remove()
371 		pmic_glink_del_aux_device(pg, &pg->altmode_aux);  in pmic_glink_remove()
372 	if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_UCSI))  in pmic_glink_remove()
373 		pmic_glink_del_aux_device(pg, &pg->ucsi_aux);  in pmic_glink_remove()
384 	{ .compatible = "qcom,pmic-glink", .data = &pmic_glink_sm8450_client_mask },
423 MODULE_DESCRIPTION("Qualcomm PMIC GLINK driver");