1 // SPDX-License-Identifier: GPL-2.0-only
3  * Copyright (c) 2019-2020, The Linux Foundation. All rights reserved.
60 	struct pmic_glink *pg = client->pg;  in _devm_pmic_glink_release_client()
62 	mutex_lock(&pg->client_lock);  in _devm_pmic_glink_release_client()
63 	list_del(&client->node);  in _devm_pmic_glink_release_client()
64 	mutex_unlock(&pg->client_lock);  in _devm_pmic_glink_release_client()
74 	struct pmic_glink *pg = dev_get_drvdata(dev->parent);  in devm_pmic_glink_register_client()
78 		return ERR_PTR(-ENOMEM);  in devm_pmic_glink_register_client()
80 	client->pg = pg;  in devm_pmic_glink_register_client()
81 	client->id = id;  in devm_pmic_glink_register_client()
82 	client->cb = cb;  in devm_pmic_glink_register_client()
83 	client->pdr_notify = pdr;  in devm_pmic_glink_register_client()
84 	client->priv = priv;  in devm_pmic_glink_register_client()
86 	mutex_lock(&pg->client_lock);  in devm_pmic_glink_register_client()
87 	list_add(&client->node, &pg->clients);  in devm_pmic_glink_register_client()
88 	mutex_unlock(&pg->client_lock);  in devm_pmic_glink_register_client()
98 	struct pmic_glink *pg = client->pg;  in pmic_glink_send()
100 	return rpmsg_send(pg->ept, data, len);  in pmic_glink_send()
109 	struct pmic_glink *pg = dev_get_drvdata(&rpdev->dev);  in pmic_glink_rpmsg_callback()
112 		dev_warn(pg->dev, "ignoring truncated message\n");  in pmic_glink_rpmsg_callback()
118 	list_for_each_entry(client, &pg->clients, node) {  in pmic_glink_rpmsg_callback()
119 		if (client->id == le32_to_cpu(hdr->owner))  in pmic_glink_rpmsg_callback()
120 			client->cb(data, len, client->priv);  in pmic_glink_rpmsg_callback()
132 	struct device *parent = pg->dev;  in pmic_glink_add_aux_device()
135 	aux->name = name;  in pmic_glink_add_aux_device()
136 	aux->dev.parent = parent;  in pmic_glink_add_aux_device()
137 	aux->dev.release = pmic_glink_aux_release;  in pmic_glink_add_aux_device()
138 	device_set_of_node_from_dev(&aux->dev, parent);  in pmic_glink_add_aux_device()
160 	unsigned int new_state = pg->client_state;  in pmic_glink_state_notify_clients()
162 	if (pg->client_state != SERVREG_SERVICE_STATE_UP) {  in pmic_glink_state_notify_clients()
163 		if (pg->pdr_state == SERVREG_SERVICE_STATE_UP && pg->ept)  in pmic_glink_state_notify_clients()
166 		if (pg->pdr_state == SERVREG_SERVICE_STATE_UP && pg->ept)  in pmic_glink_state_notify_clients()
170 	if (new_state != pg->client_state) {  in pmic_glink_state_notify_clients()
171 		list_for_each_entry(client, &pg->clients, node)  in pmic_glink_state_notify_clients()
172 			client->pdr_notify(client->priv, new_state);  in pmic_glink_state_notify_clients()
173 		pg->client_state = new_state;  in pmic_glink_state_notify_clients()
181 	mutex_lock(&pg->state_lock);  in pmic_glink_pdr_callback()
182 	pg->pdr_state = state;  in pmic_glink_pdr_callback()
185 	mutex_unlock(&pg->state_lock);  in pmic_glink_pdr_callback()
195 		ret = dev_err_probe(&rpdev->dev, -ENODEV, "no pmic_glink device to attach to\n");  in pmic_glink_rpmsg_probe()
199 	dev_set_drvdata(&rpdev->dev, pg);  in pmic_glink_rpmsg_probe()
201 	mutex_lock(&pg->state_lock);  in pmic_glink_rpmsg_probe()
202 	pg->ept = rpdev->ept;  in pmic_glink_rpmsg_probe()
204 	mutex_unlock(&pg->state_lock);  in pmic_glink_rpmsg_probe()
220 	mutex_lock(&pg->state_lock);  in pmic_glink_rpmsg_remove()
221 	pg->ept = NULL;  in pmic_glink_rpmsg_remove()
223 	mutex_unlock(&pg->state_lock);  in pmic_glink_rpmsg_remove()
250 	pg = devm_kzalloc(&pdev->dev, sizeof(*pg), GFP_KERNEL);  in pmic_glink_probe()
252 		return -ENOMEM;  in pmic_glink_probe()
254 	dev_set_drvdata(&pdev->dev, pg);  in pmic_glink_probe()
256 	pg->dev = &pdev->dev;  in pmic_glink_probe()
258 	INIT_LIST_HEAD(&pg->clients);  in pmic_glink_probe()
259 	mutex_init(&pg->client_lock);  in pmic_glink_probe()
260 	mutex_init(&pg->state_lock);  in pmic_glink_probe()
262 	match_data = (unsigned long *)of_device_get_match_data(&pdev->dev);  in pmic_glink_probe()
264 		return -EINVAL;  in pmic_glink_probe()
266 	pg->client_mask = *match_data;  in pmic_glink_probe()
268 	pg->pdr = pdr_handle_alloc(pmic_glink_pdr_callback, pg);  in pmic_glink_probe()
269 	if (IS_ERR(pg->pdr)) {  in pmic_glink_probe()
270 		ret = dev_err_probe(&pdev->dev, PTR_ERR(pg->pdr),  in pmic_glink_probe()
275 	if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_UCSI)) {  in pmic_glink_probe()
276 		ret = pmic_glink_add_aux_device(pg, &pg->ucsi_aux, "ucsi");  in pmic_glink_probe()
280 	if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_ALTMODE)) {  in pmic_glink_probe()
281 		ret = pmic_glink_add_aux_device(pg, &pg->altmode_aux, "altmode");  in pmic_glink_probe()
285 	if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_BATT)) {  in pmic_glink_probe()
286 		ret = pmic_glink_add_aux_device(pg, &pg->ps_aux, "power-supply");  in pmic_glink_probe()
291 	service = pdr_add_lookup(pg->pdr, "tms/servreg", "msm/adsp/charger_pd");  in pmic_glink_probe()
293 		ret = dev_err_probe(&pdev->dev, PTR_ERR(service),  in pmic_glink_probe()
305 	if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_BATT))  in pmic_glink_probe()
306 		pmic_glink_del_aux_device(pg, &pg->ps_aux);  in pmic_glink_probe()
308 	if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_ALTMODE))  in pmic_glink_probe()
309 		pmic_glink_del_aux_device(pg, &pg->altmode_aux);  in pmic_glink_probe()
311 	if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_UCSI))  in pmic_glink_probe()
312 		pmic_glink_del_aux_device(pg, &pg->ucsi_aux);  in pmic_glink_probe()
314 	pdr_handle_release(pg->pdr);  in pmic_glink_probe()
321 	struct pmic_glink *pg = dev_get_drvdata(&pdev->dev);  in pmic_glink_remove()
323 	pdr_handle_release(pg->pdr);  in pmic_glink_remove()
325 	if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_BATT))  in pmic_glink_remove()
326 		pmic_glink_del_aux_device(pg, &pg->ps_aux);  in pmic_glink_remove()
327 	if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_ALTMODE))  in pmic_glink_remove()
328 		pmic_glink_del_aux_device(pg, &pg->altmode_aux);  in pmic_glink_remove()
329 	if (pg->client_mask & BIT(PMIC_GLINK_CLIENT_UCSI))  in pmic_glink_remove()
330 		pmic_glink_del_aux_device(pg, &pg->ucsi_aux);  in pmic_glink_remove()
345 	{ .compatible = "qcom,sc8180x-pmic-glink", .data = &pmic_glink_sc8180x_client_mask },
346 	{ .compatible = "qcom,sc8280xp-pmic-glink", .data = &pmic_glink_sc8180x_client_mask },
347 	{ .compatible = "qcom,pmic-glink", .data = &pmic_glink_sm8450_client_mask },
377 MODULE_DESCRIPTION("Qualcomm PMIC GLINK driver");