65 	struct dpaa_if dpaa_intf = {0};  in fm_prev_cleanup()  local
89 		dpaa_intf.port_handle =  in fm_prev_cleanup()
91 		dpaa_intf.scheme_handle[0] = create_device(fm_info.pcd_handle,  in fm_prev_cleanup()
93 		dpaa_intf.scheme_count = 1;  in fm_prev_cleanup()
95 			dpaa_intf.scheme_handle[1] =  in fm_prev_cleanup()
98 			if (dpaa_intf.scheme_handle[1])  in fm_prev_cleanup()
99 				dpaa_intf.scheme_count++;  in fm_prev_cleanup()
102 		dpaa_intf.netenv_handle = create_device(fm_info.pcd_handle,  in fm_prev_cleanup()
105 		if (!dpaa_intf.netenv_handle ||  in fm_prev_cleanup()
106 			!dpaa_intf.scheme_handle[0] ||  in fm_prev_cleanup()
107 			!dpaa_intf.port_handle)  in fm_prev_cleanup()
110 		if (dpaa_fm_deconfig(&dpaa_intf, NULL))  in fm_prev_cleanup()
314 	struct dpaa_if *dpaa_intf,  in set_scheme_params()  argument
333 	scheme_params->param.base_fqid = dpaa_intf->rx_queues[0].fqid;  in set_scheme_params()
335 		dpaa_intf->netenv_handle;  in set_scheme_params()
340 			dpaa_intf->nb_rx_queues;  in set_scheme_params()
476 static inline int set_port_pcd(struct dpaa_if *dpaa_intf)  in set_port_pcd()  argument
497 	for (idx = 0; idx < dpaa_intf->scheme_count; idx++)  in set_port_pcd()
498 		kg_param.scheme_ids[idx] = dpaa_intf->scheme_handle[idx];  in set_port_pcd()
499 	kg_param.num_schemes = dpaa_intf->scheme_count;  in set_port_pcd()
502 	pcd_param.net_env_id = dpaa_intf->netenv_handle;  in set_port_pcd()
508 	ret = fm_port_disable(dpaa_intf->port_handle);  in set_port_pcd()
515 	ret = fm_port_set_pcd(dpaa_intf->port_handle, &pcd_param);  in set_port_pcd()
522 	ret = fm_port_enable(dpaa_intf->port_handle);  in set_port_pcd()
532 	ret = fm_port_delete_pcd(dpaa_intf->port_handle);  in set_port_pcd()
541 static inline void unset_pcd_netenv_scheme(struct dpaa_if *dpaa_intf)  in unset_pcd_netenv_scheme()  argument
547 	if (dpaa_intf->scheme_count)  in unset_pcd_netenv_scheme()
548 		dpaa_intf->scheme_count--;  in unset_pcd_netenv_scheme()
551 		dpaa_intf->scheme_count,  in unset_pcd_netenv_scheme()
552 		dpaa_intf->scheme_handle[dpaa_intf->scheme_count]);  in unset_pcd_netenv_scheme()
554 	ret = fm_pcd_kg_scheme_delete(dpaa_intf->scheme_handle  in unset_pcd_netenv_scheme()
555 					[dpaa_intf->scheme_count]);  in unset_pcd_netenv_scheme()
559 	dpaa_intf->scheme_handle[dpaa_intf->scheme_count] = NULL;  in unset_pcd_netenv_scheme()
563 static inline int set_default_scheme(struct dpaa_if *dpaa_intf)  in set_default_scheme()  argument
566 	int idx = dpaa_intf->scheme_count;  in set_default_scheme()
577 		10 + dpaa_intf->ifid;  in set_default_scheme()
582 		dpaa_intf->netenv_handle;  in set_default_scheme()
583 	scheme_params.param.base_fqid = dpaa_intf->rx_queues[0].fqid;  in set_default_scheme()
592 	dpaa_intf->scheme_handle[idx] =  in set_default_scheme()
595 		idx, dpaa_intf->scheme_handle[idx]);  in set_default_scheme()
596 	if (!dpaa_intf->scheme_handle[idx]) {  in set_default_scheme()
601 	fm_model.scheme_devid[dpaa_intf->ifid][idx] =  in set_default_scheme()
602 				get_device_id(dpaa_intf->scheme_handle[idx]);  in set_default_scheme()
603 	dpaa_intf->scheme_count++;  in set_default_scheme()
609 static inline int set_pcd_netenv_scheme(struct dpaa_if *dpaa_intf,  in set_pcd_netenv_scheme()  argument
616 	int idx = dpaa_intf->scheme_count;  in set_pcd_netenv_scheme()
626 	scheme_params.param.scm_id.relative_scheme_id = dpaa_intf->ifid;  in set_pcd_netenv_scheme()
629 	ret = set_scheme_params(&scheme_params, &dist_units, dpaa_intf, fif);  in set_pcd_netenv_scheme()
636 	dpaa_intf->scheme_handle[idx] =  in set_pcd_netenv_scheme()
639 			idx, dpaa_intf->scheme_handle[idx]);  in set_pcd_netenv_scheme()
640 	if (!dpaa_intf->scheme_handle[idx]) {  in set_pcd_netenv_scheme()
645 	fm_model.scheme_devid[dpaa_intf->ifid][idx] =  in set_pcd_netenv_scheme()
646 				get_device_id(dpaa_intf->scheme_handle[idx]);  in set_pcd_netenv_scheme()
647 	dpaa_intf->scheme_count++;  in set_pcd_netenv_scheme()
665 static inline int set_fm_port_handle(struct dpaa_if *dpaa_intf,  in set_fm_port_handle()  argument
687 	dpaa_intf->port_handle = fm_port_open(&fm_port_params);  in set_fm_port_handle()
688 	if (!dpaa_intf->port_handle) {  in set_fm_port_handle()
693 	fm_model.fm_port_params[dpaa_intf->ifid] = fm_port_params;  in set_fm_port_handle()
702 	dpaa_intf->netenv_handle =  in set_fm_port_handle()
705 	if (!dpaa_intf->netenv_handle) {  in set_fm_port_handle()
710 	fm_model.netenv_devid[dpaa_intf->ifid] =  in set_fm_port_handle()
711 				get_device_id(dpaa_intf->netenv_handle);  in set_fm_port_handle()
717 int dpaa_fm_deconfig(struct dpaa_if *dpaa_intf,  in dpaa_fm_deconfig()  argument
726 	ret = fm_port_disable(dpaa_intf->port_handle);  in dpaa_fm_deconfig()
733 	ret = fm_port_delete_pcd(dpaa_intf->port_handle);  in dpaa_fm_deconfig()
739 	for (idx = 0; idx < dpaa_intf->scheme_count; idx++) {  in dpaa_fm_deconfig()
741 			idx, dpaa_intf->scheme_handle[idx]);  in dpaa_fm_deconfig()
743 		ret = fm_pcd_kg_scheme_delete(dpaa_intf->scheme_handle[idx]);  in dpaa_fm_deconfig()
748 		dpaa_intf->scheme_handle[idx] = NULL;  in dpaa_fm_deconfig()
751 	ret = fm_pcd_net_env_characteristics_delete(dpaa_intf->netenv_handle);  in dpaa_fm_deconfig()
756 	dpaa_intf->netenv_handle = NULL;  in dpaa_fm_deconfig()
759 		ret = fm_port_enable(dpaa_intf->port_handle);  in dpaa_fm_deconfig()
767 	fm_port_close(dpaa_intf->port_handle);  in dpaa_fm_deconfig()
768 	dpaa_intf->port_handle = NULL;  in dpaa_fm_deconfig()
771 	dpaa_intf->scheme_count = 0;  in dpaa_fm_deconfig()
778 	struct dpaa_if *dpaa_intf = dev->data->dev_private;  in dpaa_fm_config()  local
784 	if (dpaa_intf->port_handle) {  in dpaa_fm_config()
785 		if (dpaa_fm_deconfig(dpaa_intf, fif))  in dpaa_fm_config()
797 	dpaa_intf->nb_rx_queues = dev->data->nb_rx_queues;  in dpaa_fm_config()
800 	ret = set_fm_port_handle(dpaa_intf, req_dist_set, fif);  in dpaa_fm_config()
807 		for (i = 0; i < dpaa_intf->nb_rx_queues; i++)  in dpaa_fm_config()
808 			dpaa_intf->rx_queues[i].vsp_id =  in dpaa_fm_config()
816 		ret = set_pcd_netenv_scheme(dpaa_intf, req_dist_set, fif);  in dpaa_fm_config()
824 		ret = set_default_scheme(dpaa_intf);  in dpaa_fm_config()
832 	ret = set_port_pcd(dpaa_intf);  in dpaa_fm_config()
839 		if (fm_model.device_order[i] == dpaa_intf->ifid)  in dpaa_fm_config()
842 	fm_model.device_order[fm_model.dev_count] = dpaa_intf->ifid;  in dpaa_fm_config()
848 	unset_pcd_netenv_scheme(dpaa_intf);  in dpaa_fm_config()
851 	unset_pcd_netenv_scheme(dpaa_intf);  in dpaa_fm_config()
855 	fm_port_close(dpaa_intf->port_handle);  in dpaa_fm_config()
856 	dpaa_intf->port_handle = NULL;  in dpaa_fm_config()
940 static int dpaa_port_vsp_configure(struct dpaa_if *dpaa_intf,  in dpaa_port_vsp_configure()  argument
954 		dpaa_intf->vsp_bpid[vsp_id] = 0;  in dpaa_port_vsp_configure()
980 		dpaa_intf->vsp_bpid[vsp_id];  in dpaa_port_vsp_configure()
984 	dpaa_intf->vsp_handle[vsp_id] = fm_vsp_config(&vsp_params);  in dpaa_port_vsp_configure()
985 	if (!dpaa_intf->vsp_handle[vsp_id]) {  in dpaa_port_vsp_configure()
1005 	ret = fm_vsp_config_buffer_prefix_content(dpaa_intf->vsp_handle[vsp_id],  in dpaa_port_vsp_configure()
1014 	ret = fm_vsp_init(dpaa_intf->vsp_handle[vsp_id]);  in dpaa_port_vsp_configure()
1024 int dpaa_port_vsp_update(struct dpaa_if *dpaa_intf,  in dpaa_port_vsp_update()  argument
1037 	if (dpaa_intf->vsp_bpid[vsp_id] == bpid)  in dpaa_port_vsp_update()
1040 	if (dpaa_intf->vsp_handle[vsp_id]) {  in dpaa_port_vsp_update()
1041 		ret = fm_vsp_free(dpaa_intf->vsp_handle[vsp_id]);  in dpaa_port_vsp_update()
1047 		dpaa_intf->vsp_handle[vsp_id] = 0;  in dpaa_port_vsp_update()
1055 	dpaa_intf->vsp_bpid[vsp_id] = bpid;  in dpaa_port_vsp_update()
1057 	return dpaa_port_vsp_configure(dpaa_intf, vsp_id, fman_handle, fif);  in dpaa_port_vsp_update()
1060 int dpaa_port_vsp_cleanup(struct dpaa_if *dpaa_intf, struct fman_if *fif)  in dpaa_port_vsp_cleanup()  argument
1065 		if (dpaa_intf->vsp_handle[idx]) {  in dpaa_port_vsp_cleanup()
1066 			ret = fm_vsp_free(dpaa_intf->vsp_handle[idx]);  in dpaa_port_vsp_cleanup()