1 // SPDX-License-Identifier: GPL-2.0
32 	struct list_head node;  member
47 	/* serialize pd status invocation */
70 	struct list_head node;  member
79 	mutex_lock(&pdr->lock);  in pdr_locator_new_server()
81 	pdr->locator_addr.sq_family = AF_QIPCRTR;  in pdr_locator_new_server()
82 	pdr->locator_addr.sq_node = svc->node;  in pdr_locator_new_server()
83 	pdr->locator_addr.sq_port = svc->port;  in pdr_locator_new_server()
85 	pdr->locator_init_complete = true;  in pdr_locator_new_server()
86 	mutex_unlock(&pdr->lock);  in pdr_locator_new_server()
89 	schedule_work(&pdr->locator_work);  in pdr_locator_new_server()
100 	mutex_lock(&pdr->lock);  in pdr_locator_del_server()
101 	pdr->locator_init_complete = false;  in pdr_locator_del_server()
103 	pdr->locator_addr.sq_node = 0;  in pdr_locator_del_server()
104 	pdr->locator_addr.sq_port = 0;  in pdr_locator_del_server()
105 	mutex_unlock(&pdr->lock);  in pdr_locator_del_server()
122 	ret = qmi_txn_init(&pdr->notifier_hdl, &txn,  in pdr_register_listener()
129 	strscpy(req.service_path, pds->service_path, sizeof(req.service_path));  in pdr_register_listener()
131 	ret = qmi_send_request(&pdr->notifier_hdl, &pds->addr,  in pdr_register_listener()
144 		       pds->service_path, ret);  in pdr_register_listener()
150 		       pds->service_path, resp.resp.error);  in pdr_register_listener()
151 		return -EREMOTEIO;  in pdr_register_listener()
154 	pds->state = resp.curr_state;  in pdr_register_listener()
166 	mutex_lock(&pdr->list_lock);  in pdr_notifier_work()
167 	list_for_each_entry(pds, &pdr->lookups, node) {  in pdr_notifier_work()
168 		if (pds->service_connected) {  in pdr_notifier_work()
169 			if (!pds->need_notifier_register)  in pdr_notifier_work()
172 			pds->need_notifier_register = false;  in pdr_notifier_work()
175 				pds->state = SERVREG_SERVICE_STATE_DOWN;  in pdr_notifier_work()
177 			if (!pds->need_notifier_remove)  in pdr_notifier_work()
180 			pds->need_notifier_remove = false;  in pdr_notifier_work()
181 			pds->state = SERVREG_SERVICE_STATE_DOWN;  in pdr_notifier_work()
184 		mutex_lock(&pdr->status_lock);  in pdr_notifier_work()
185 		pdr->status(pds->state, pds->service_path, pdr->priv);  in pdr_notifier_work()
186 		mutex_unlock(&pdr->status_lock);  in pdr_notifier_work()
188 	mutex_unlock(&pdr->list_lock);  in pdr_notifier_work()
198 	mutex_lock(&pdr->list_lock);  in pdr_notifier_new_server()
199 	list_for_each_entry(pds, &pdr->lookups, node) {  in pdr_notifier_new_server()
200 		if (pds->service == svc->service &&  in pdr_notifier_new_server()
201 		    pds->instance == svc->instance) {  in pdr_notifier_new_server()
202 			pds->service_connected = true;  in pdr_notifier_new_server()
203 			pds->need_notifier_register = true;  in pdr_notifier_new_server()
204 			pds->addr.sq_family = AF_QIPCRTR;  in pdr_notifier_new_server()
205 			pds->addr.sq_node = svc->node;  in pdr_notifier_new_server()
206 			pds->addr.sq_port = svc->port;  in pdr_notifier_new_server()
207 			queue_work(pdr->notifier_wq, &pdr->notifier_work);  in pdr_notifier_new_server()
210 	mutex_unlock(&pdr->list_lock);  in pdr_notifier_new_server()
222 	mutex_lock(&pdr->list_lock);  in pdr_notifier_del_server()
223 	list_for_each_entry(pds, &pdr->lookups, node) {  in pdr_notifier_del_server()
224 		if (pds->service == svc->service &&  in pdr_notifier_del_server()
225 		    pds->instance == svc->instance) {  in pdr_notifier_del_server()
226 			pds->service_connected = false;  in pdr_notifier_del_server()
227 			pds->need_notifier_remove = true;  in pdr_notifier_del_server()
228 			pds->addr.sq_node = 0;  in pdr_notifier_del_server()
229 			pds->addr.sq_port = 0;  in pdr_notifier_del_server()
230 			queue_work(pdr->notifier_wq, &pdr->notifier_work);  in pdr_notifier_del_server()
233 	mutex_unlock(&pdr->list_lock);  in pdr_notifier_del_server()
249 	ret = qmi_txn_init(&pdr->notifier_hdl, &txn, servreg_set_ack_resp_ei,  in pdr_send_indack_msg()
255 	strscpy(req.service_path, pds->service_path, sizeof(req.service_path));  in pdr_send_indack_msg()
257 	ret = qmi_send_request(&pdr->notifier_hdl, &pds->addr,  in pdr_send_indack_msg()
275 	list_for_each_entry_safe(ind, tmp, &pdr->indack_list, node) {  in pdr_indack_work()
276 		pds = ind->pds;  in pdr_indack_work()
278 		mutex_lock(&pdr->status_lock);  in pdr_indack_work()
279 		pds->state = ind->curr_state;  in pdr_indack_work()
280 		pdr->status(pds->state, pds->service_path, pdr->priv);  in pdr_indack_work()
281 		mutex_unlock(&pdr->status_lock);  in pdr_indack_work()
283 		/* Ack the indication after clients release the PD resources */  in pdr_indack_work()
284 		pdr_send_indack_msg(pdr, pds, ind->transaction_id);  in pdr_indack_work()
286 		mutex_lock(&pdr->list_lock);  in pdr_indack_work()
287 		list_del(&ind->node);  in pdr_indack_work()
288 		mutex_unlock(&pdr->list_lock);  in pdr_indack_work()
304 	if (!ind_msg || !ind_msg->service_path[0] ||  in pdr_indication_cb()
305 	    strlen(ind_msg->service_path) > SERVREG_NAME_LENGTH)  in pdr_indication_cb()
308 	mutex_lock(&pdr->list_lock);  in pdr_indication_cb()
309 	list_for_each_entry(iter, &pdr->lookups, node) {  in pdr_indication_cb()
310 		if (strcmp(iter->service_path, ind_msg->service_path))  in pdr_indication_cb()
316 	mutex_unlock(&pdr->list_lock);  in pdr_indication_cb()
321 	pr_info("PDR: Indication received from %s, state: 0x%x, trans-id: %d\n",  in pdr_indication_cb()
322 		ind_msg->service_path, ind_msg->curr_state,  in pdr_indication_cb()
323 		ind_msg->transaction_id);  in pdr_indication_cb()
329 	ind->transaction_id = ind_msg->transaction_id;  in pdr_indication_cb()
330 	ind->curr_state = ind_msg->curr_state;  in pdr_indication_cb()
331 	ind->pds = pds;  in pdr_indication_cb()
333 	mutex_lock(&pdr->list_lock);  in pdr_indication_cb()
334 	list_add_tail(&ind->node, &pdr->indack_list);  in pdr_indication_cb()
335 	mutex_unlock(&pdr->list_lock);  in pdr_indication_cb()
337 	queue_work(pdr->indack_wq, &pdr->indack_work);  in pdr_indication_cb()
358 	ret = qmi_txn_init(&pdr->locator_hdl, &txn,  in pdr_get_domain_list()
363 	mutex_lock(&pdr->lock);  in pdr_get_domain_list()
364 	ret = qmi_send_request(&pdr->locator_hdl,  in pdr_get_domain_list()
365 			       &pdr->locator_addr,  in pdr_get_domain_list()
370 	mutex_unlock(&pdr->lock);  in pdr_get_domain_list()
379 		       req->service_name, ret);  in pdr_get_domain_list()
383 	if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {  in pdr_get_domain_list()
385 		       req->service_name, resp->resp.error);  in pdr_get_domain_list()
386 		return -EREMOTEIO;  in pdr_get_domain_list()
402 		return -ENOMEM;  in pdr_locate_service()
405 	strscpy(req.service_name, pds->service_name, sizeof(req.service_name));  in pdr_locate_service()
415 		for (i = 0; i < resp->domain_list_len; i++) {  in pdr_locate_service()
416 			entry = &resp->domain_list[i];  in pdr_locate_service()
418 			if (strnlen(entry->name, sizeof(entry->name)) == sizeof(entry->name))  in pdr_locate_service()
421 			if (!strcmp(entry->name, pds->service_path)) {  in pdr_locate_service()
422 				pds->service_data_valid = entry->service_data_valid;  in pdr_locate_service()
423 				pds->service_data = entry->service_data;  in pdr_locate_service()
424 				pds->instance = entry->instance;  in pdr_locate_service()
430 		ret = -ENXIO;  in pdr_locate_service()
433 		if (resp->domain_list_len > resp->total_domains)  in pdr_locate_service()
434 			resp->domain_list_len = resp->total_domains;  in pdr_locate_service()
436 		domains_read += resp->domain_list_len;  in pdr_locate_service()
437 	} while (domains_read < resp->total_domains);  in pdr_locate_service()
447 	       pds->service_name, err);  in pdr_notify_lookup_failure()
449 	if (err == -ENXIO)  in pdr_notify_lookup_failure()
452 	list_del(&pds->node);  in pdr_notify_lookup_failure()
453 	pds->state = SERVREG_LOCATOR_ERR;  in pdr_notify_lookup_failure()
454 	mutex_lock(&pdr->status_lock);  in pdr_notify_lookup_failure()
455 	pdr->status(pds->state, pds->service_path, pdr->priv);  in pdr_notify_lookup_failure()
456 	mutex_unlock(&pdr->status_lock);  in pdr_notify_lookup_failure()
468 	mutex_lock(&pdr->lock);  in pdr_locator_work()
469 	if (!pdr->locator_init_complete) {  in pdr_locator_work()
470 		mutex_unlock(&pdr->lock);  in pdr_locator_work()
474 	mutex_unlock(&pdr->lock);  in pdr_locator_work()
476 	mutex_lock(&pdr->list_lock);  in pdr_locator_work()
477 	list_for_each_entry_safe(pds, tmp, &pdr->lookups, node) {  in pdr_locator_work()
478 		if (!pds->need_locator_lookup)  in pdr_locator_work()
487 		ret = qmi_add_lookup(&pdr->notifier_hdl, pds->service, 1,  in pdr_locator_work()
488 				     pds->instance);  in pdr_locator_work()
494 		pds->need_locator_lookup = false;  in pdr_locator_work()
496 	mutex_unlock(&pdr->list_lock);  in pdr_locator_work()
500  * pdr_add_lookup() - register a tracking request for a PD
505  * Registering a pdr lookup allows for tracking the life cycle of the PD.
507  * Return: pdr_service object on success, ERR_PTR on failure. -EALREADY is
517 		return ERR_PTR(-EINVAL);  in pdr_add_lookup()
521 		return ERR_PTR(-EINVAL);  in pdr_add_lookup()
525 		return ERR_PTR(-ENOMEM);  in pdr_add_lookup()
527 	pds->service = SERVREG_NOTIFIER_SERVICE;  in pdr_add_lookup()
528 	strscpy(pds->service_name, service_name, sizeof(pds->service_name));  in pdr_add_lookup()
529 	strscpy(pds->service_path, service_path, sizeof(pds->service_path));  in pdr_add_lookup()
530 	pds->need_locator_lookup = true;  in pdr_add_lookup()
532 	mutex_lock(&pdr->list_lock);  in pdr_add_lookup()
533 	list_for_each_entry(tmp, &pdr->lookups, node) {  in pdr_add_lookup()
534 		if (strcmp(tmp->service_path, service_path))  in pdr_add_lookup()
537 		mutex_unlock(&pdr->list_lock);  in pdr_add_lookup()
538 		return ERR_PTR(-EALREADY);  in pdr_add_lookup()
541 	list_add(&pds->node, &pdr->lookups);  in pdr_add_lookup()
542 	mutex_unlock(&pdr->list_lock);  in pdr_add_lookup()
544 	schedule_work(&pdr->locator_work);  in pdr_add_lookup()
551  * pdr_restart_pd() - restart PD
553  * @pds:	PD service handle
555  * Restarts the PD tracked by the PDR client handle for a given service path.
569 		return -EINVAL;  in pdr_restart_pd()
571 	mutex_lock(&pdr->list_lock);  in pdr_restart_pd()
572 	list_for_each_entry(tmp, &pdr->lookups, node) {  in pdr_restart_pd()
576 		if (!pds->service_connected)  in pdr_restart_pd()
580 		strscpy(req.service_path, pds->service_path, sizeof(req.service_path));  in pdr_restart_pd()
581 		addr = pds->addr;  in pdr_restart_pd()
584 	mutex_unlock(&pdr->list_lock);  in pdr_restart_pd()
587 		return -EINVAL;  in pdr_restart_pd()
589 	ret = qmi_txn_init(&pdr->notifier_hdl, &txn,  in pdr_restart_pd()
595 	ret = qmi_send_request(&pdr->notifier_hdl, &addr,  in pdr_restart_pd()
606 		pr_err("PDR: %s PD restart txn wait failed: %d\n",  in pdr_restart_pd()
614 		pr_err("PDR: %s PD restart is disabled: 0x%x\n",  in pdr_restart_pd()
616 		return -EOPNOTSUPP;  in pdr_restart_pd()
621 		pr_err("PDR: %s request for PD restart failed: 0x%x\n",  in pdr_restart_pd()
623 		return -EREMOTEIO;  in pdr_restart_pd()
631  * pdr_handle_alloc() - initialize the PDR client handle
632  * @status:	function to be called on PD state change
646 		return ERR_PTR(-EINVAL);  in pdr_handle_alloc()
650 		return ERR_PTR(-ENOMEM);  in pdr_handle_alloc()
652 	pdr->status = status;  in pdr_handle_alloc()
653 	pdr->priv = priv;  in pdr_handle_alloc()
655 	mutex_init(&pdr->status_lock);  in pdr_handle_alloc()
656 	mutex_init(&pdr->list_lock);  in pdr_handle_alloc()
657 	mutex_init(&pdr->lock);  in pdr_handle_alloc()
659 	INIT_LIST_HEAD(&pdr->lookups);  in pdr_handle_alloc()
660 	INIT_LIST_HEAD(&pdr->indack_list);  in pdr_handle_alloc()
662 	INIT_WORK(&pdr->locator_work, pdr_locator_work);  in pdr_handle_alloc()
663 	INIT_WORK(&pdr->notifier_work, pdr_notifier_work);  in pdr_handle_alloc()
664 	INIT_WORK(&pdr->indack_work, pdr_indack_work);  in pdr_handle_alloc()
666 	pdr->notifier_wq = create_singlethread_workqueue("pdr_notifier_wq");  in pdr_handle_alloc()
667 	if (!pdr->notifier_wq)  in pdr_handle_alloc()
668 		return ERR_PTR(-ENOMEM);  in pdr_handle_alloc()
670 	pdr->indack_wq = alloc_ordered_workqueue("pdr_indack_wq", WQ_HIGHPRI);  in pdr_handle_alloc()
671 	if (!pdr->indack_wq) {  in pdr_handle_alloc()
672 		ret = -ENOMEM;  in pdr_handle_alloc()
676 	ret = qmi_handle_init(&pdr->locator_hdl,  in pdr_handle_alloc()
682 	ret = qmi_add_lookup(&pdr->locator_hdl, SERVREG_LOCATOR_SERVICE, 1, 1);  in pdr_handle_alloc()
686 	ret = qmi_handle_init(&pdr->notifier_hdl,  in pdr_handle_alloc()
696 	qmi_handle_release(&pdr->locator_hdl);  in pdr_handle_alloc()
698 	destroy_workqueue(pdr->indack_wq);  in pdr_handle_alloc()
700 	destroy_workqueue(pdr->notifier_wq);  in pdr_handle_alloc()
707  * pdr_handle_release() - release the PDR client handle
719 	mutex_lock(&pdr->list_lock);  in pdr_handle_release()
720 	list_for_each_entry_safe(pds, tmp, &pdr->lookups, node) {  in pdr_handle_release()
721 		list_del(&pds->node);  in pdr_handle_release()
724 	mutex_unlock(&pdr->list_lock);  in pdr_handle_release()
726 	cancel_work_sync(&pdr->locator_work);  in pdr_handle_release()
727 	cancel_work_sync(&pdr->notifier_work);  in pdr_handle_release()
728 	cancel_work_sync(&pdr->indack_work);  in pdr_handle_release()
730 	destroy_workqueue(pdr->notifier_wq);  in pdr_handle_release()
731 	destroy_workqueue(pdr->indack_wq);  in pdr_handle_release()
733 	qmi_handle_release(&pdr->locator_hdl);  in pdr_handle_release()
734 	qmi_handle_release(&pdr->notifier_hdl);  in pdr_handle_release()