1 // SPDX-License-Identifier: GPL-2.0
31 	struct list_head node;  member
46 	/* serialize pd status invocation */
69 	struct list_head node;  member
80 	pdr->locator_addr.sq_family = AF_QIPCRTR;  in pdr_locator_new_server()
81 	pdr->locator_addr.sq_node = svc->node;  in pdr_locator_new_server()
82 	pdr->locator_addr.sq_port = svc->port;  in pdr_locator_new_server()
84 	mutex_lock(&pdr->lock);  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 	mutex_lock(&pdr->list_lock);  in pdr_locator_new_server()
90 	list_for_each_entry(pds, &pdr->lookups, node) {  in pdr_locator_new_server()
91 		if (pds->need_locator_lookup)  in pdr_locator_new_server()
92 			schedule_work(&pdr->locator_work);  in pdr_locator_new_server()
94 	mutex_unlock(&pdr->list_lock);  in pdr_locator_new_server()
105 	mutex_lock(&pdr->lock);  in pdr_locator_del_server()
106 	pdr->locator_init_complete = false;  in pdr_locator_del_server()
107 	mutex_unlock(&pdr->lock);  in pdr_locator_del_server()
109 	pdr->locator_addr.sq_node = 0;  in pdr_locator_del_server()
110 	pdr->locator_addr.sq_port = 0;  in pdr_locator_del_server()
127 	ret = qmi_txn_init(&pdr->notifier_hdl, &txn,  in pdr_register_listener()
134 	strcpy(req.service_path, pds->service_path);  in pdr_register_listener()
136 	ret = qmi_send_request(&pdr->notifier_hdl, &pds->addr,  in pdr_register_listener()
149 		       pds->service_path, ret);  in pdr_register_listener()
155 		       pds->service_path, resp.resp.error);  in pdr_register_listener()
156 		return -EREMOTEIO;  in pdr_register_listener()
159 	pds->state = resp.curr_state;  in pdr_register_listener()
171 	mutex_lock(&pdr->list_lock);  in pdr_notifier_work()
172 	list_for_each_entry(pds, &pdr->lookups, node) {  in pdr_notifier_work()
173 		if (pds->service_connected) {  in pdr_notifier_work()
174 			if (!pds->need_notifier_register)  in pdr_notifier_work()
177 			pds->need_notifier_register = false;  in pdr_notifier_work()
180 				pds->state = SERVREG_SERVICE_STATE_DOWN;  in pdr_notifier_work()
182 			if (!pds->need_notifier_remove)  in pdr_notifier_work()
185 			pds->need_notifier_remove = false;  in pdr_notifier_work()
186 			pds->state = SERVREG_SERVICE_STATE_DOWN;  in pdr_notifier_work()
189 		mutex_lock(&pdr->status_lock);  in pdr_notifier_work()
190 		pdr->status(pds->state, pds->service_path, pdr->priv);  in pdr_notifier_work()
191 		mutex_unlock(&pdr->status_lock);  in pdr_notifier_work()
193 	mutex_unlock(&pdr->list_lock);  in pdr_notifier_work()
203 	mutex_lock(&pdr->list_lock);  in pdr_notifier_new_server()
204 	list_for_each_entry(pds, &pdr->lookups, node) {  in pdr_notifier_new_server()
205 		if (pds->service == svc->service &&  in pdr_notifier_new_server()
206 		    pds->instance == svc->instance) {  in pdr_notifier_new_server()
207 			pds->service_connected = true;  in pdr_notifier_new_server()
208 			pds->need_notifier_register = true;  in pdr_notifier_new_server()
209 			pds->addr.sq_family = AF_QIPCRTR;  in pdr_notifier_new_server()
210 			pds->addr.sq_node = svc->node;  in pdr_notifier_new_server()
211 			pds->addr.sq_port = svc->port;  in pdr_notifier_new_server()
212 			queue_work(pdr->notifier_wq, &pdr->notifier_work);  in pdr_notifier_new_server()
215 	mutex_unlock(&pdr->list_lock);  in pdr_notifier_new_server()
227 	mutex_lock(&pdr->list_lock);  in pdr_notifier_del_server()
228 	list_for_each_entry(pds, &pdr->lookups, node) {  in pdr_notifier_del_server()
229 		if (pds->service == svc->service &&  in pdr_notifier_del_server()
230 		    pds->instance == svc->instance) {  in pdr_notifier_del_server()
231 			pds->service_connected = false;  in pdr_notifier_del_server()
232 			pds->need_notifier_remove = true;  in pdr_notifier_del_server()
233 			pds->addr.sq_node = 0;  in pdr_notifier_del_server()
234 			pds->addr.sq_port = 0;  in pdr_notifier_del_server()
235 			queue_work(pdr->notifier_wq, &pdr->notifier_work);  in pdr_notifier_del_server()
238 	mutex_unlock(&pdr->list_lock);  in pdr_notifier_del_server()
254 	ret = qmi_txn_init(&pdr->notifier_hdl, &txn, servreg_set_ack_resp_ei,  in pdr_send_indack_msg()
260 	strcpy(req.service_path, pds->service_path);  in pdr_send_indack_msg()
262 	ret = qmi_send_request(&pdr->notifier_hdl, &pds->addr,  in pdr_send_indack_msg()
280 	list_for_each_entry_safe(ind, tmp, &pdr->indack_list, node) {  in pdr_indack_work()
281 		pds = ind->pds;  in pdr_indack_work()
283 		mutex_lock(&pdr->status_lock);  in pdr_indack_work()
284 		pds->state = ind->curr_state;  in pdr_indack_work()
285 		pdr->status(pds->state, pds->service_path, pdr->priv);  in pdr_indack_work()
286 		mutex_unlock(&pdr->status_lock);  in pdr_indack_work()
288 		/* Ack the indication after clients release the PD resources */  in pdr_indack_work()
289 		pdr_send_indack_msg(pdr, pds, ind->transaction_id);  in pdr_indack_work()
291 		mutex_lock(&pdr->list_lock);  in pdr_indack_work()
292 		list_del(&ind->node);  in pdr_indack_work()
293 		mutex_unlock(&pdr->list_lock);  in pdr_indack_work()
310 	if (!ind_msg || !ind_msg->service_path[0] ||  in pdr_indication_cb()
311 	    strlen(ind_msg->service_path) > SERVREG_NAME_LENGTH)  in pdr_indication_cb()
314 	mutex_lock(&pdr->list_lock);  in pdr_indication_cb()
315 	list_for_each_entry(pds, &pdr->lookups, node) {  in pdr_indication_cb()
316 		if (strcmp(pds->service_path, ind_msg->service_path))  in pdr_indication_cb()
322 	mutex_unlock(&pdr->list_lock);  in pdr_indication_cb()
327 	pr_info("PDR: Indication received from %s, state: 0x%x, trans-id: %d\n",  in pdr_indication_cb()
328 		ind_msg->service_path, ind_msg->curr_state,  in pdr_indication_cb()
329 		ind_msg->transaction_id);  in pdr_indication_cb()
335 	ind->transaction_id = ind_msg->transaction_id;  in pdr_indication_cb()
336 	ind->curr_state = ind_msg->curr_state;  in pdr_indication_cb()
337 	ind->pds = pds;  in pdr_indication_cb()
339 	mutex_lock(&pdr->list_lock);  in pdr_indication_cb()
340 	list_add_tail(&ind->node, &pdr->indack_list);  in pdr_indication_cb()
341 	mutex_unlock(&pdr->list_lock);  in pdr_indication_cb()
343 	queue_work(pdr->indack_wq, &pdr->indack_work);  in pdr_indication_cb()
364 	ret = qmi_txn_init(&pdr->locator_hdl, &txn,  in pdr_get_domain_list()
369 	ret = qmi_send_request(&pdr->locator_hdl,  in pdr_get_domain_list()
370 			       &pdr->locator_addr,  in pdr_get_domain_list()
383 		       req->service_name, ret);  in pdr_get_domain_list()
387 	if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {  in pdr_get_domain_list()
389 		       req->service_name, resp->resp.error);  in pdr_get_domain_list()
390 		return -EREMOTEIO;  in pdr_get_domain_list()
406 		return -ENOMEM;  in pdr_locate_service()
409 	strcpy(req.service_name, pds->service_name);  in pdr_locate_service()
419 		for (i = domains_read; i < resp->domain_list_len; i++) {  in pdr_locate_service()
420 			entry = &resp->domain_list[i];  in pdr_locate_service()
422 			if (strnlen(entry->name, sizeof(entry->name)) == sizeof(entry->name))  in pdr_locate_service()
425 			if (!strcmp(entry->name, pds->service_path)) {  in pdr_locate_service()
426 				pds->service_data_valid = entry->service_data_valid;  in pdr_locate_service()
427 				pds->service_data = entry->service_data;  in pdr_locate_service()
428 				pds->instance = entry->instance;  in pdr_locate_service()
434 		ret = -ENXIO;  in pdr_locate_service()
437 		if (resp->domain_list_len > resp->total_domains)  in pdr_locate_service()
438 			resp->domain_list_len = resp->total_domains;  in pdr_locate_service()
440 		domains_read += resp->domain_list_len;  in pdr_locate_service()
441 	} while (domains_read < resp->total_domains);  in pdr_locate_service()
452 	       pds->service_name, err);  in pdr_notify_lookup_failure()
454 	if (err == -ENXIO)  in pdr_notify_lookup_failure()
457 	list_del(&pds->node);  in pdr_notify_lookup_failure()
458 	pds->state = SERVREG_LOCATOR_ERR;  in pdr_notify_lookup_failure()
459 	mutex_lock(&pdr->status_lock);  in pdr_notify_lookup_failure()
460 	pdr->status(pds->state, pds->service_path, pdr->priv);  in pdr_notify_lookup_failure()
461 	mutex_unlock(&pdr->status_lock);  in pdr_notify_lookup_failure()
473 	mutex_lock(&pdr->lock);  in pdr_locator_work()
474 	if (!pdr->locator_init_complete) {  in pdr_locator_work()
475 		mutex_unlock(&pdr->lock);  in pdr_locator_work()
479 	mutex_unlock(&pdr->lock);  in pdr_locator_work()
481 	mutex_lock(&pdr->list_lock);  in pdr_locator_work()
482 	list_for_each_entry_safe(pds, tmp, &pdr->lookups, node) {  in pdr_locator_work()
483 		if (!pds->need_locator_lookup)  in pdr_locator_work()
492 		ret = qmi_add_lookup(&pdr->notifier_hdl, pds->service, 1,  in pdr_locator_work()
493 				     pds->instance);  in pdr_locator_work()
499 		pds->need_locator_lookup = false;  in pdr_locator_work()
501 	mutex_unlock(&pdr->list_lock);  in pdr_locator_work()
505  * pdr_add_lookup() - register a tracking request for a PD
510  * Registering a pdr lookup allows for tracking the life cycle of the PD.
512  * Return: pdr_service object on success, ERR_PTR on failure. -EALREADY is
523 		return ERR_PTR(-EINVAL);  in pdr_add_lookup()
527 		return ERR_PTR(-EINVAL);  in pdr_add_lookup()
531 		return ERR_PTR(-ENOMEM);  in pdr_add_lookup()
533 	pds->service = SERVREG_NOTIFIER_SERVICE;  in pdr_add_lookup()
534 	strcpy(pds->service_name, service_name);  in pdr_add_lookup()
535 	strcpy(pds->service_path, service_path);  in pdr_add_lookup()
536 	pds->need_locator_lookup = true;  in pdr_add_lookup()
538 	mutex_lock(&pdr->list_lock);  in pdr_add_lookup()
539 	list_for_each_entry(tmp, &pdr->lookups, node) {  in pdr_add_lookup()
540 		if (strcmp(tmp->service_path, service_path))  in pdr_add_lookup()
543 		mutex_unlock(&pdr->list_lock);  in pdr_add_lookup()
544 		ret = -EALREADY;  in pdr_add_lookup()
548 	list_add(&pds->node, &pdr->lookups);  in pdr_add_lookup()
549 	mutex_unlock(&pdr->list_lock);  in pdr_add_lookup()
551 	schedule_work(&pdr->locator_work);  in pdr_add_lookup()
561  * pdr_restart_pd() - restart PD
563  * @pds:	PD service handle
565  * Restarts the PD tracked by the PDR client handle for a given service path.
579 		return -EINVAL;  in pdr_restart_pd()
581 	mutex_lock(&pdr->list_lock);  in pdr_restart_pd()
582 	list_for_each_entry(tmp, &pdr->lookups, node) {  in pdr_restart_pd()
586 		if (!pds->service_connected)  in pdr_restart_pd()
590 		strcpy(req.service_path, pds->service_path);  in pdr_restart_pd()
591 		addr = pds->addr;  in pdr_restart_pd()
594 	mutex_unlock(&pdr->list_lock);  in pdr_restart_pd()
597 		return -EINVAL;  in pdr_restart_pd()
599 	ret = qmi_txn_init(&pdr->notifier_hdl, &txn,  in pdr_restart_pd()
605 	ret = qmi_send_request(&pdr->notifier_hdl, &addr,  in pdr_restart_pd()
616 		pr_err("PDR: %s PD restart txn wait failed: %d\n",  in pdr_restart_pd()
624 		pr_err("PDR: %s PD restart is disabled: 0x%x\n",  in pdr_restart_pd()
626 		return -EOPNOTSUPP;  in pdr_restart_pd()
631 		pr_err("PDR: %s request for PD restart failed: 0x%x\n",  in pdr_restart_pd()
633 		return -EREMOTEIO;  in pdr_restart_pd()
641  * pdr_handle_alloc() - initialize the PDR client handle
642  * @status:	function to be called on PD state change
657 		return ERR_PTR(-EINVAL);  in pdr_handle_alloc()
661 		return ERR_PTR(-ENOMEM);  in pdr_handle_alloc()
663 	pdr->status = status;  in pdr_handle_alloc()
664 	pdr->priv = priv;  in pdr_handle_alloc()
666 	mutex_init(&pdr->status_lock);  in pdr_handle_alloc()
667 	mutex_init(&pdr->list_lock);  in pdr_handle_alloc()
668 	mutex_init(&pdr->lock);  in pdr_handle_alloc()
670 	INIT_LIST_HEAD(&pdr->lookups);  in pdr_handle_alloc()
671 	INIT_LIST_HEAD(&pdr->indack_list);  in pdr_handle_alloc()
673 	INIT_WORK(&pdr->locator_work, pdr_locator_work);  in pdr_handle_alloc()
674 	INIT_WORK(&pdr->notifier_work, pdr_notifier_work);  in pdr_handle_alloc()
675 	INIT_WORK(&pdr->indack_work, pdr_indack_work);  in pdr_handle_alloc()
677 	pdr->notifier_wq = create_singlethread_workqueue("pdr_notifier_wq");  in pdr_handle_alloc()
678 	if (!pdr->notifier_wq) {  in pdr_handle_alloc()
679 		ret = -ENOMEM;  in pdr_handle_alloc()
683 	pdr->indack_wq = alloc_ordered_workqueue("pdr_indack_wq", WQ_HIGHPRI);  in pdr_handle_alloc()
684 	if (!pdr->indack_wq) {  in pdr_handle_alloc()
685 		ret = -ENOMEM;  in pdr_handle_alloc()
689 	ret = qmi_handle_init(&pdr->locator_hdl,  in pdr_handle_alloc()
695 	ret = qmi_add_lookup(&pdr->locator_hdl, SERVREG_LOCATOR_SERVICE, 1, 1);  in pdr_handle_alloc()
699 	ret = qmi_handle_init(&pdr->notifier_hdl,  in pdr_handle_alloc()
709 	qmi_handle_release(&pdr->locator_hdl);  in pdr_handle_alloc()
711 	destroy_workqueue(pdr->indack_wq);  in pdr_handle_alloc()
713 	destroy_workqueue(pdr->notifier_wq);  in pdr_handle_alloc()
722  * pdr_handle_release() - release the PDR client handle
734 	mutex_lock(&pdr->list_lock);  in pdr_handle_release()
735 	list_for_each_entry_safe(pds, tmp, &pdr->lookups, node) {  in pdr_handle_release()
736 		list_del(&pds->node);  in pdr_handle_release()
739 	mutex_unlock(&pdr->list_lock);  in pdr_handle_release()
741 	cancel_work_sync(&pdr->locator_work);  in pdr_handle_release()
742 	cancel_work_sync(&pdr->notifier_work);  in pdr_handle_release()
743 	cancel_work_sync(&pdr->indack_work);  in pdr_handle_release()
745 	destroy_workqueue(pdr->notifier_wq);  in pdr_handle_release()
746 	destroy_workqueue(pdr->indack_wq);  in pdr_handle_release()
748 	qmi_handle_release(&pdr->locator_hdl);  in pdr_handle_release()
749 	qmi_handle_release(&pdr->notifier_hdl);  in pdr_handle_release()