xref: /openbmc/linux/drivers/soc/qcom/pdr_interface.c (revision a89aa749ece9c6fee7932163472d2ee0efd6ddd3)
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Copyright (C) 2020 The Linux Foundation. All rights reserved.
4  */
5 
6 #include <linux/kernel.h>
7 #include <linux/module.h>
8 #include <linux/string.h>
9 #include <linux/workqueue.h>
10 
11 #include "pdr_internal.h"
12 
13 struct pdr_service {
14 	char service_name[SERVREG_NAME_LENGTH + 1];
15 	char service_path[SERVREG_NAME_LENGTH + 1];
16 
17 	struct sockaddr_qrtr addr;
18 
19 	unsigned int instance;
20 	unsigned int service;
21 	u8 service_data_valid;
22 	u32 service_data;
23 	int state;
24 
25 	bool need_notifier_register;
26 	bool need_notifier_remove;
27 	bool need_locator_lookup;
28 	bool service_connected;
29 
30 	struct list_head node;
31 };
32 
33 struct pdr_handle {
34 	struct qmi_handle locator_hdl;
35 	struct qmi_handle notifier_hdl;
36 
37 	struct sockaddr_qrtr locator_addr;
38 
39 	struct list_head lookups;
40 	struct list_head indack_list;
41 
42 	/* control access to pdr lookup/indack lists */
43 	struct mutex list_lock;
44 
45 	/* serialize pd status invocation */
46 	struct mutex status_lock;
47 
48 	/* control access to the locator state */
49 	struct mutex lock;
50 
51 	bool locator_init_complete;
52 
53 	struct work_struct locator_work;
54 	struct work_struct notifier_work;
55 	struct work_struct indack_work;
56 
57 	struct workqueue_struct *notifier_wq;
58 	struct workqueue_struct *indack_wq;
59 
60 	void (*status)(int state, char *service_path, void *priv);
61 	void *priv;
62 };
63 
64 struct pdr_list_node {
65 	enum servreg_service_state curr_state;
66 	u16 transaction_id;
67 	struct pdr_service *pds;
68 	struct list_head node;
69 };
70 
71 static int pdr_locator_new_server(struct qmi_handle *qmi,
72 				  struct qmi_service *svc)
73 {
74 	struct pdr_handle *pdr = container_of(qmi, struct pdr_handle,
75 					      locator_hdl);
76 	struct pdr_service *pds;
77 
78 	/* Create a local client port for QMI communication */
79 	pdr->locator_addr.sq_family = AF_QIPCRTR;
80 	pdr->locator_addr.sq_node = svc->node;
81 	pdr->locator_addr.sq_port = svc->port;
82 
83 	mutex_lock(&pdr->lock);
84 	pdr->locator_init_complete = true;
85 	mutex_unlock(&pdr->lock);
86 
87 	/* Service pending lookup requests */
88 	mutex_lock(&pdr->list_lock);
89 	list_for_each_entry(pds, &pdr->lookups, node) {
90 		if (pds->need_locator_lookup)
91 			schedule_work(&pdr->locator_work);
92 	}
93 	mutex_unlock(&pdr->list_lock);
94 
95 	return 0;
96 }
97 
98 static void pdr_locator_del_server(struct qmi_handle *qmi,
99 				   struct qmi_service *svc)
100 {
101 	struct pdr_handle *pdr = container_of(qmi, struct pdr_handle,
102 					      locator_hdl);
103 
104 	mutex_lock(&pdr->lock);
105 	pdr->locator_init_complete = false;
106 	mutex_unlock(&pdr->lock);
107 
108 	pdr->locator_addr.sq_node = 0;
109 	pdr->locator_addr.sq_port = 0;
110 }
111 
112 static struct qmi_ops pdr_locator_ops = {
113 	.new_server = pdr_locator_new_server,
114 	.del_server = pdr_locator_del_server,
115 };
116 
117 static int pdr_register_listener(struct pdr_handle *pdr,
118 				 struct pdr_service *pds,
119 				 bool enable)
120 {
121 	struct servreg_register_listener_resp resp;
122 	struct servreg_register_listener_req req;
123 	struct qmi_txn txn;
124 	int ret;
125 
126 	ret = qmi_txn_init(&pdr->notifier_hdl, &txn,
127 			   servreg_register_listener_resp_ei,
128 			   &resp);
129 	if (ret < 0)
130 		return ret;
131 
132 	req.enable = enable;
133 	strcpy(req.service_path, pds->service_path);
134 
135 	ret = qmi_send_request(&pdr->notifier_hdl, &pds->addr,
136 			       &txn, SERVREG_REGISTER_LISTENER_REQ,
137 			       SERVREG_REGISTER_LISTENER_REQ_LEN,
138 			       servreg_register_listener_req_ei,
139 			       &req);
140 	if (ret < 0) {
141 		qmi_txn_cancel(&txn);
142 		return ret;
143 	}
144 
145 	ret = qmi_txn_wait(&txn, 5 * HZ);
146 	if (ret < 0) {
147 		pr_err("PDR: %s register listener txn wait failed: %d\n",
148 		       pds->service_path, ret);
149 		return ret;
150 	}
151 
152 	if (resp.resp.result != QMI_RESULT_SUCCESS_V01) {
153 		pr_err("PDR: %s register listener failed: 0x%x\n",
154 		       pds->service_path, resp.resp.error);
155 		return ret;
156 	}
157 
158 	if ((int)resp.curr_state < INT_MIN || (int)resp.curr_state > INT_MAX)
159 		pr_err("PDR: %s notification state invalid: 0x%x\n",
160 		       pds->service_path, resp.curr_state);
161 
162 	pds->state = resp.curr_state;
163 
164 	return 0;
165 }
166 
167 static void pdr_notifier_work(struct work_struct *work)
168 {
169 	struct pdr_handle *pdr = container_of(work, struct pdr_handle,
170 					      notifier_work);
171 	struct pdr_service *pds;
172 	int ret;
173 
174 	mutex_lock(&pdr->list_lock);
175 	list_for_each_entry(pds, &pdr->lookups, node) {
176 		if (pds->service_connected) {
177 			if (!pds->need_notifier_register)
178 				continue;
179 
180 			pds->need_notifier_register = false;
181 			ret = pdr_register_listener(pdr, pds, true);
182 			if (ret < 0)
183 				pds->state = SERVREG_SERVICE_STATE_DOWN;
184 		} else {
185 			if (!pds->need_notifier_remove)
186 				continue;
187 
188 			pds->need_notifier_remove = false;
189 			pds->state = SERVREG_SERVICE_STATE_DOWN;
190 		}
191 
192 		mutex_lock(&pdr->status_lock);
193 		pdr->status(pds->state, pds->service_path, pdr->priv);
194 		mutex_unlock(&pdr->status_lock);
195 	}
196 	mutex_unlock(&pdr->list_lock);
197 }
198 
199 static int pdr_notifier_new_server(struct qmi_handle *qmi,
200 				   struct qmi_service *svc)
201 {
202 	struct pdr_handle *pdr = container_of(qmi, struct pdr_handle,
203 					      notifier_hdl);
204 	struct pdr_service *pds;
205 
206 	mutex_lock(&pdr->list_lock);
207 	list_for_each_entry(pds, &pdr->lookups, node) {
208 		if (pds->service == svc->service &&
209 		    pds->instance == svc->instance) {
210 			pds->service_connected = true;
211 			pds->need_notifier_register = true;
212 			pds->addr.sq_family = AF_QIPCRTR;
213 			pds->addr.sq_node = svc->node;
214 			pds->addr.sq_port = svc->port;
215 			queue_work(pdr->notifier_wq, &pdr->notifier_work);
216 		}
217 	}
218 	mutex_unlock(&pdr->list_lock);
219 
220 	return 0;
221 }
222 
223 static void pdr_notifier_del_server(struct qmi_handle *qmi,
224 				    struct qmi_service *svc)
225 {
226 	struct pdr_handle *pdr = container_of(qmi, struct pdr_handle,
227 					      notifier_hdl);
228 	struct pdr_service *pds;
229 
230 	mutex_lock(&pdr->list_lock);
231 	list_for_each_entry(pds, &pdr->lookups, node) {
232 		if (pds->service == svc->service &&
233 		    pds->instance == svc->instance) {
234 			pds->service_connected = false;
235 			pds->need_notifier_remove = true;
236 			pds->addr.sq_node = 0;
237 			pds->addr.sq_port = 0;
238 			queue_work(pdr->notifier_wq, &pdr->notifier_work);
239 		}
240 	}
241 	mutex_unlock(&pdr->list_lock);
242 }
243 
244 static struct qmi_ops pdr_notifier_ops = {
245 	.new_server = pdr_notifier_new_server,
246 	.del_server = pdr_notifier_del_server,
247 };
248 
249 static int pdr_send_indack_msg(struct pdr_handle *pdr, struct pdr_service *pds,
250 			       u16 tid)
251 {
252 	struct servreg_set_ack_resp resp;
253 	struct servreg_set_ack_req req;
254 	struct qmi_txn txn;
255 	int ret;
256 
257 	ret = qmi_txn_init(&pdr->notifier_hdl, &txn, servreg_set_ack_resp_ei,
258 			   &resp);
259 	if (ret < 0)
260 		return ret;
261 
262 	req.transaction_id = tid;
263 	strcpy(req.service_path, pds->service_path);
264 
265 	ret = qmi_send_request(&pdr->notifier_hdl, &pds->addr,
266 			       &txn, SERVREG_SET_ACK_REQ,
267 			       SERVREG_SET_ACK_REQ_LEN,
268 			       servreg_set_ack_req_ei,
269 			       &req);
270 
271 	/* Skip waiting for response */
272 	qmi_txn_cancel(&txn);
273 	return ret;
274 }
275 
276 static void pdr_indack_work(struct work_struct *work)
277 {
278 	struct pdr_handle *pdr = container_of(work, struct pdr_handle,
279 					      indack_work);
280 	struct pdr_list_node *ind, *tmp;
281 	struct pdr_service *pds;
282 
283 	list_for_each_entry_safe(ind, tmp, &pdr->indack_list, node) {
284 		pds = ind->pds;
285 		pdr_send_indack_msg(pdr, pds, ind->transaction_id);
286 
287 		mutex_lock(&pdr->status_lock);
288 		pds->state = ind->curr_state;
289 		pdr->status(pds->state, pds->service_path, pdr->priv);
290 		mutex_unlock(&pdr->status_lock);
291 
292 		mutex_lock(&pdr->list_lock);
293 		list_del(&ind->node);
294 		mutex_unlock(&pdr->list_lock);
295 
296 		kfree(ind);
297 	}
298 }
299 
300 static void pdr_indication_cb(struct qmi_handle *qmi,
301 			      struct sockaddr_qrtr *sq,
302 			      struct qmi_txn *txn, const void *data)
303 {
304 	struct pdr_handle *pdr = container_of(qmi, struct pdr_handle,
305 					      notifier_hdl);
306 	const struct servreg_state_updated_ind *ind_msg = data;
307 	struct pdr_list_node *ind;
308 	struct pdr_service *pds;
309 	bool found = false;
310 
311 	if (!ind_msg || !ind_msg->service_path[0] ||
312 	    strlen(ind_msg->service_path) > SERVREG_NAME_LENGTH)
313 		return;
314 
315 	mutex_lock(&pdr->list_lock);
316 	list_for_each_entry(pds, &pdr->lookups, node) {
317 		if (strcmp(pds->service_path, ind_msg->service_path))
318 			continue;
319 
320 		found = true;
321 		break;
322 	}
323 	mutex_unlock(&pdr->list_lock);
324 
325 	if (!found)
326 		return;
327 
328 	pr_info("PDR: Indication received from %s, state: 0x%x, trans-id: %d\n",
329 		ind_msg->service_path, ind_msg->curr_state,
330 		ind_msg->transaction_id);
331 
332 	ind = kzalloc(sizeof(*ind), GFP_KERNEL);
333 	if (!ind)
334 		return;
335 
336 	ind->transaction_id = ind_msg->transaction_id;
337 	ind->curr_state = ind_msg->curr_state;
338 	ind->pds = pds;
339 
340 	mutex_lock(&pdr->list_lock);
341 	list_add_tail(&ind->node, &pdr->indack_list);
342 	mutex_unlock(&pdr->list_lock);
343 
344 	queue_work(pdr->indack_wq, &pdr->indack_work);
345 }
346 
347 static struct qmi_msg_handler qmi_indication_handler[] = {
348 	{
349 		.type = QMI_INDICATION,
350 		.msg_id = SERVREG_STATE_UPDATED_IND_ID,
351 		.ei = servreg_state_updated_ind_ei,
352 		.decoded_size = sizeof(struct servreg_state_updated_ind),
353 		.fn = pdr_indication_cb,
354 	},
355 	{}
356 };
357 
358 static int pdr_get_domain_list(struct servreg_get_domain_list_req *req,
359 			       struct servreg_get_domain_list_resp *resp,
360 			       struct pdr_handle *pdr)
361 {
362 	struct qmi_txn txn;
363 	int ret;
364 
365 	ret = qmi_txn_init(&pdr->locator_hdl, &txn,
366 			   servreg_get_domain_list_resp_ei, resp);
367 	if (ret < 0)
368 		return ret;
369 
370 	ret = qmi_send_request(&pdr->locator_hdl,
371 			       &pdr->locator_addr,
372 			       &txn, SERVREG_GET_DOMAIN_LIST_REQ,
373 			       SERVREG_GET_DOMAIN_LIST_REQ_MAX_LEN,
374 			       servreg_get_domain_list_req_ei,
375 			       req);
376 	if (ret < 0) {
377 		qmi_txn_cancel(&txn);
378 		return ret;
379 	}
380 
381 	ret = qmi_txn_wait(&txn, 5 * HZ);
382 	if (ret < 0) {
383 		pr_err("PDR: %s get domain list txn wait failed: %d\n",
384 		       req->service_name, ret);
385 		return ret;
386 	}
387 
388 	if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
389 		pr_err("PDR: %s get domain list failed: 0x%x\n",
390 		       req->service_name, resp->resp.error);
391 		return -EREMOTEIO;
392 	}
393 
394 	return 0;
395 }
396 
397 static int pdr_locate_service(struct pdr_handle *pdr, struct pdr_service *pds)
398 {
399 	struct servreg_get_domain_list_resp *resp;
400 	struct servreg_get_domain_list_req req;
401 	struct servreg_location_entry *entry;
402 	int domains_read = 0;
403 	int ret, i;
404 
405 	resp = kzalloc(sizeof(*resp), GFP_KERNEL);
406 	if (!resp)
407 		return -ENOMEM;
408 
409 	/* Prepare req message */
410 	strcpy(req.service_name, pds->service_name);
411 	req.domain_offset_valid = true;
412 	req.domain_offset = 0;
413 
414 	do {
415 		req.domain_offset = domains_read;
416 		ret = pdr_get_domain_list(&req, resp, pdr);
417 		if (ret < 0)
418 			goto out;
419 
420 		for (i = domains_read; i < resp->domain_list_len; i++) {
421 			entry = &resp->domain_list[i];
422 
423 			if (strnlen(entry->name, sizeof(entry->name)) == sizeof(entry->name))
424 				continue;
425 
426 			if (!strcmp(entry->name, pds->service_path)) {
427 				pds->service_data_valid = entry->service_data_valid;
428 				pds->service_data = entry->service_data;
429 				pds->instance = entry->instance;
430 				goto out;
431 			}
432 		}
433 
434 		/* Update ret to indicate that the service is not yet found */
435 		ret = -ENXIO;
436 
437 		/* Always read total_domains from the response msg */
438 		if (resp->domain_list_len > resp->total_domains)
439 			resp->domain_list_len = resp->total_domains;
440 
441 		domains_read += resp->domain_list_len;
442 	} while (domains_read < resp->total_domains);
443 out:
444 	kfree(resp);
445 	return ret;
446 }
447 
448 static void pdr_notify_lookup_failure(struct pdr_handle *pdr,
449 				      struct pdr_service *pds,
450 				      int err)
451 {
452 	pr_err("PDR: service lookup for %s failed: %d\n",
453 	       pds->service_name, err);
454 
455 	if (err == -ENXIO)
456 		return;
457 
458 	list_del(&pds->node);
459 	pds->state = SERVREG_LOCATOR_ERR;
460 	mutex_lock(&pdr->status_lock);
461 	pdr->status(pds->state, pds->service_path, pdr->priv);
462 	mutex_unlock(&pdr->status_lock);
463 	kfree(pds);
464 }
465 
466 static void pdr_locator_work(struct work_struct *work)
467 {
468 	struct pdr_handle *pdr = container_of(work, struct pdr_handle,
469 					      locator_work);
470 	struct pdr_service *pds, *tmp;
471 	int ret = 0;
472 
473 	/* Bail out early if the SERVREG LOCATOR QMI service is not up */
474 	mutex_lock(&pdr->lock);
475 	if (!pdr->locator_init_complete) {
476 		mutex_unlock(&pdr->lock);
477 		pr_debug("PDR: SERVICE LOCATOR service not available\n");
478 		return;
479 	}
480 	mutex_unlock(&pdr->lock);
481 
482 	mutex_lock(&pdr->list_lock);
483 	list_for_each_entry_safe(pds, tmp, &pdr->lookups, node) {
484 		if (!pds->need_locator_lookup)
485 			continue;
486 
487 		ret = pdr_locate_service(pdr, pds);
488 		if (ret < 0) {
489 			pdr_notify_lookup_failure(pdr, pds, ret);
490 			continue;
491 		}
492 
493 		ret = qmi_add_lookup(&pdr->notifier_hdl, pds->service, 1,
494 				     pds->instance);
495 		if (ret < 0) {
496 			pdr_notify_lookup_failure(pdr, pds, ret);
497 			continue;
498 		}
499 
500 		pds->need_locator_lookup = false;
501 	}
502 	mutex_unlock(&pdr->list_lock);
503 }
504 
505 /**
506  * pdr_add_lookup() - register a tracking request for a PD
507  * @pdr:		PDR client handle
508  * @service_name:	service name of the tracking request
509  * @service_path:	service path of the tracking request
510  *
511  * Registering a pdr lookup allows for tracking the life cycle of the PD.
512  *
513  * Return: pdr_service object on success, ERR_PTR on failure. -EALREADY is
514  * returned if a lookup is already in progress for the given service path.
515  */
516 struct pdr_service *pdr_add_lookup(struct pdr_handle *pdr,
517 				   const char *service_name,
518 				   const char *service_path)
519 {
520 	struct pdr_service *pds, *tmp;
521 	int ret;
522 
523 	if (IS_ERR_OR_NULL(pdr))
524 		return ERR_PTR(-EINVAL);
525 
526 	if (!service_name || strlen(service_name) > SERVREG_NAME_LENGTH ||
527 	    !service_path || strlen(service_path) > SERVREG_NAME_LENGTH)
528 		return ERR_PTR(-EINVAL);
529 
530 	pds = kzalloc(sizeof(*pds), GFP_KERNEL);
531 	if (!pds)
532 		return ERR_PTR(-ENOMEM);
533 
534 	pds->service = SERVREG_NOTIFIER_SERVICE;
535 	strcpy(pds->service_name, service_name);
536 	strcpy(pds->service_path, service_path);
537 	pds->need_locator_lookup = true;
538 
539 	mutex_lock(&pdr->list_lock);
540 	list_for_each_entry(tmp, &pdr->lookups, node) {
541 		if (strcmp(tmp->service_path, service_path))
542 			continue;
543 
544 		mutex_unlock(&pdr->list_lock);
545 		ret = -EALREADY;
546 		goto err;
547 	}
548 
549 	list_add(&pds->node, &pdr->lookups);
550 	mutex_unlock(&pdr->list_lock);
551 
552 	schedule_work(&pdr->locator_work);
553 
554 	return pds;
555 err:
556 	kfree(pds);
557 	return ERR_PTR(ret);
558 }
559 EXPORT_SYMBOL(pdr_add_lookup);
560 
561 /**
562  * pdr_restart_pd() - restart PD
563  * @pdr:	PDR client handle
564  * @pds:	PD service handle
565  *
566  * Restarts the PD tracked by the PDR client handle for a given service path.
567  *
568  * Return: 0 on success, negative errno on failure.
569  */
570 int pdr_restart_pd(struct pdr_handle *pdr, struct pdr_service *pds)
571 {
572 	struct servreg_restart_pd_resp resp;
573 	struct servreg_restart_pd_req req;
574 	struct sockaddr_qrtr addr;
575 	struct pdr_service *tmp;
576 	struct qmi_txn txn;
577 	int ret;
578 
579 	if (IS_ERR_OR_NULL(pdr) || IS_ERR_OR_NULL(pds))
580 		return -EINVAL;
581 
582 	mutex_lock(&pdr->list_lock);
583 	list_for_each_entry(tmp, &pdr->lookups, node) {
584 		if (tmp != pds)
585 			continue;
586 
587 		if (!pds->service_connected)
588 			break;
589 
590 		/* Prepare req message */
591 		strcpy(req.service_path, pds->service_path);
592 		addr = pds->addr;
593 		break;
594 	}
595 	mutex_unlock(&pdr->list_lock);
596 
597 	if (!req.service_path[0])
598 		return -EINVAL;
599 
600 	ret = qmi_txn_init(&pdr->notifier_hdl, &txn,
601 			   servreg_restart_pd_resp_ei,
602 			   &resp);
603 	if (ret < 0)
604 		return ret;
605 
606 	ret = qmi_send_request(&pdr->notifier_hdl, &addr,
607 			       &txn, SERVREG_RESTART_PD_REQ,
608 			       SERVREG_RESTART_PD_REQ_MAX_LEN,
609 			       servreg_restart_pd_req_ei, &req);
610 	if (ret < 0) {
611 		qmi_txn_cancel(&txn);
612 		return ret;
613 	}
614 
615 	ret = qmi_txn_wait(&txn, 5 * HZ);
616 	if (ret < 0) {
617 		pr_err("PDR: %s PD restart txn wait failed: %d\n",
618 		       req.service_path, ret);
619 		return ret;
620 	}
621 
622 	/* Check response if PDR is disabled */
623 	if (resp.resp.result == QMI_RESULT_FAILURE_V01 &&
624 	    resp.resp.error == QMI_ERR_DISABLED_V01) {
625 		pr_err("PDR: %s PD restart is disabled: 0x%x\n",
626 		       req.service_path, resp.resp.error);
627 		return -EOPNOTSUPP;
628 	}
629 
630 	/* Check the response for other error case*/
631 	if (resp.resp.result != QMI_RESULT_SUCCESS_V01) {
632 		pr_err("PDR: %s request for PD restart failed: 0x%x\n",
633 		       req.service_path, resp.resp.error);
634 		return -EREMOTEIO;
635 	}
636 
637 	return 0;
638 }
639 EXPORT_SYMBOL(pdr_restart_pd);
640 
641 /**
642  * pdr_handle_alloc() - initialize the PDR client handle
643  * @status:	function to be called on PD state change
644  * @priv:	handle for client's use
645  *
646  * Initializes the PDR client handle to allow for tracking/restart of PDs.
647  *
648  * Return: pdr_handle object on success, ERR_PTR on failure.
649  */
650 struct pdr_handle *pdr_handle_alloc(void (*status)(int state,
651 						   char *service_path,
652 						   void *priv), void *priv)
653 {
654 	struct pdr_handle *pdr;
655 	int ret;
656 
657 	if (!status)
658 		return ERR_PTR(-EINVAL);
659 
660 	pdr = kzalloc(sizeof(*pdr), GFP_KERNEL);
661 	if (!pdr)
662 		return ERR_PTR(-ENOMEM);
663 
664 	pdr->status = status;
665 	pdr->priv = priv;
666 
667 	mutex_init(&pdr->status_lock);
668 	mutex_init(&pdr->list_lock);
669 	mutex_init(&pdr->lock);
670 
671 	INIT_LIST_HEAD(&pdr->lookups);
672 	INIT_LIST_HEAD(&pdr->indack_list);
673 
674 	INIT_WORK(&pdr->locator_work, pdr_locator_work);
675 	INIT_WORK(&pdr->notifier_work, pdr_notifier_work);
676 	INIT_WORK(&pdr->indack_work, pdr_indack_work);
677 
678 	pdr->notifier_wq = create_singlethread_workqueue("pdr_notifier_wq");
679 	if (!pdr->notifier_wq) {
680 		ret = -ENOMEM;
681 		goto free_pdr_handle;
682 	}
683 
684 	pdr->indack_wq = alloc_ordered_workqueue("pdr_indack_wq", WQ_HIGHPRI);
685 	if (!pdr->indack_wq) {
686 		ret = -ENOMEM;
687 		goto destroy_notifier;
688 	}
689 
690 	ret = qmi_handle_init(&pdr->locator_hdl,
691 			      SERVREG_GET_DOMAIN_LIST_RESP_MAX_LEN,
692 			      &pdr_locator_ops, NULL);
693 	if (ret < 0)
694 		goto destroy_indack;
695 
696 	ret = qmi_add_lookup(&pdr->locator_hdl, SERVREG_LOCATOR_SERVICE, 1, 1);
697 	if (ret < 0)
698 		goto release_qmi_handle;
699 
700 	ret = qmi_handle_init(&pdr->notifier_hdl,
701 			      SERVREG_STATE_UPDATED_IND_MAX_LEN,
702 			      &pdr_notifier_ops,
703 			      qmi_indication_handler);
704 	if (ret < 0)
705 		goto release_qmi_handle;
706 
707 	return pdr;
708 
709 release_qmi_handle:
710 	qmi_handle_release(&pdr->locator_hdl);
711 destroy_indack:
712 	destroy_workqueue(pdr->indack_wq);
713 destroy_notifier:
714 	destroy_workqueue(pdr->notifier_wq);
715 free_pdr_handle:
716 	kfree(pdr);
717 
718 	return ERR_PTR(ret);
719 }
720 EXPORT_SYMBOL(pdr_handle_alloc);
721 
722 /**
723  * pdr_handle_release() - release the PDR client handle
724  * @pdr:	PDR client handle
725  *
726  * Cleans up pending tracking requests and releases the underlying qmi handles.
727  */
728 void pdr_handle_release(struct pdr_handle *pdr)
729 {
730 	struct pdr_service *pds, *tmp;
731 
732 	if (IS_ERR_OR_NULL(pdr))
733 		return;
734 
735 	mutex_lock(&pdr->list_lock);
736 	list_for_each_entry_safe(pds, tmp, &pdr->lookups, node) {
737 		list_del(&pds->node);
738 		kfree(pds);
739 	}
740 	mutex_unlock(&pdr->list_lock);
741 
742 	cancel_work_sync(&pdr->locator_work);
743 	cancel_work_sync(&pdr->notifier_work);
744 	cancel_work_sync(&pdr->indack_work);
745 
746 	destroy_workqueue(pdr->notifier_wq);
747 	destroy_workqueue(pdr->indack_wq);
748 
749 	qmi_handle_release(&pdr->locator_hdl);
750 	qmi_handle_release(&pdr->notifier_hdl);
751 
752 	kfree(pdr);
753 }
754 EXPORT_SYMBOL(pdr_handle_release);
755 
756 MODULE_LICENSE("GPL v2");
757 MODULE_DESCRIPTION("Qualcomm Protection Domain Restart helpers");
758