73 	int (*devcmd_rtn)(struct vnic_dev *vdev, enum vnic_devcmd_cmd cmd,
82 void *vnic_dev_priv(struct vnic_dev *vdev)  in vnic_dev_priv()  argument
84 	return vdev->priv;  in vnic_dev_priv()
87 static int vnic_dev_discover_res(struct vnic_dev *vdev,  in vnic_dev_discover_res()  argument
154 		vdev->res[type].count = count;  in vnic_dev_discover_res()
155 		vdev->res[type].vaddr = (char __iomem *)bar->vaddr + bar_offset;  in vnic_dev_discover_res()
161 unsigned int vnic_dev_get_res_count(struct vnic_dev *vdev,  in vnic_dev_get_res_count()  argument
164 	return vdev->res[type].count;  in vnic_dev_get_res_count()
167 void __iomem *vnic_dev_get_res(struct vnic_dev *vdev, enum vnic_res_type type,  in vnic_dev_get_res()  argument
170 	if (!vdev->res[type].vaddr)  in vnic_dev_get_res()
178 		return (char __iomem *)vdev->res[type].vaddr +  in vnic_dev_get_res()
181 		return (char __iomem *)vdev->res[type].vaddr;  in vnic_dev_get_res()
218 int vnic_dev_alloc_desc_ring(struct vnic_dev *vdev, struct vnic_dev_ring *ring,  in vnic_dev_alloc_desc_ring()  argument
223 	ring->descs_unaligned = dma_alloc_coherent(&vdev->pdev->dev,  in vnic_dev_alloc_desc_ring()
246 void vnic_dev_free_desc_ring(struct vnic_dev *vdev, struct vnic_dev_ring *ring)  in vnic_dev_free_desc_ring()  argument
249 		dma_free_coherent(&vdev->pdev->dev,  in vnic_dev_free_desc_ring()
257 static int vnic_dev_cmd1(struct vnic_dev *vdev, enum vnic_devcmd_cmd cmd, int wait)  in vnic_dev_cmd1()  argument
259 	struct vnic_devcmd __iomem *devcmd = vdev->devcmd;  in vnic_dev_cmd1()
271 	u64 *a0 = &vdev->args[0];  in vnic_dev_cmd1()
272 	u64 *a1 = &vdev->args[1];  in vnic_dev_cmd1()
319 static int vnic_dev_cmd2(struct vnic_dev *vdev, enum vnic_devcmd_cmd cmd,  in vnic_dev_cmd2()  argument
322 	struct devcmd2_controller *dc2c = vdev->devcmd2;  in vnic_dev_cmd2()
338 				pci_name(vdev->pdev), _CMD_N(cmd));  in vnic_dev_cmd2()
340 				pci_name(vdev->pdev), fetch_index, posted);  in vnic_dev_cmd2()
350 				pci_name(vdev->pdev), _CMD_N(cmd));  in vnic_dev_cmd2()
352 				pci_name(vdev->pdev), fetch_index, posted);  in vnic_dev_cmd2()
363 			dc2c->cmd_ring[posted].args[i] = vdev->args[i];  in vnic_dev_cmd2()
395 						pci_name(vdev->pdev),  in vnic_dev_cmd2()
402 					vdev->args[i] = result->results[i];  in vnic_dev_cmd2()
408 	pr_err("%s:Timed out devcmd %d\n", pci_name(vdev->pdev), _CMD_N(cmd));  in vnic_dev_cmd2()
414 static int vnic_dev_init_devcmd1(struct vnic_dev *vdev)  in vnic_dev_init_devcmd1()  argument
416 	vdev->devcmd = vnic_dev_get_res(vdev, RES_TYPE_DEVCMD, 0);  in vnic_dev_init_devcmd1()
417 	if (!vdev->devcmd)  in vnic_dev_init_devcmd1()
420 	vdev->devcmd_rtn = &vnic_dev_cmd1;  in vnic_dev_init_devcmd1()
425 static int vnic_dev_init_devcmd2(struct vnic_dev *vdev)  in vnic_dev_init_devcmd2()  argument
430 	if (vdev->devcmd2)  in vnic_dev_init_devcmd2()
433 	vdev->devcmd2 = kzalloc(sizeof(*vdev->devcmd2), GFP_ATOMIC);  in vnic_dev_init_devcmd2()
434 	if (!vdev->devcmd2)  in vnic_dev_init_devcmd2()
437 	vdev->devcmd2->color = 1;  in vnic_dev_init_devcmd2()
438 	vdev->devcmd2->result_size = DEVCMD2_RING_SIZE;  in vnic_dev_init_devcmd2()
439 	err = vnic_wq_devcmd2_alloc(vdev, &vdev->devcmd2->wq,  in vnic_dev_init_devcmd2()
444 	fetch_index = ioread32(&vdev->devcmd2->wq.ctrl->fetch_index);  in vnic_dev_init_devcmd2()
455 	vnic_wq_init_start(&vdev->devcmd2->wq, 0, fetch_index,  in vnic_dev_init_devcmd2()
458 	vnic_wq_enable(&vdev->devcmd2->wq);  in vnic_dev_init_devcmd2()
460 	err = vnic_dev_alloc_desc_ring(vdev, &vdev->devcmd2->results_ring,  in vnic_dev_init_devcmd2()
465 	vdev->devcmd2->result =  in vnic_dev_init_devcmd2()
466 		(struct devcmd2_result *) vdev->devcmd2->results_ring.descs;  in vnic_dev_init_devcmd2()
467 	vdev->devcmd2->cmd_ring =  in vnic_dev_init_devcmd2()
468 		(struct vnic_devcmd2 *) vdev->devcmd2->wq.ring.descs;  in vnic_dev_init_devcmd2()
469 	vdev->devcmd2->wq_ctrl = vdev->devcmd2->wq.ctrl;  in vnic_dev_init_devcmd2()
470 	vdev->args[0] = (u64) vdev->devcmd2->results_ring.base_addr |  in vnic_dev_init_devcmd2()
472 	vdev->args[1] = DEVCMD2_RING_SIZE;  in vnic_dev_init_devcmd2()
474 	err = vnic_dev_cmd2(vdev, CMD_INITIALIZE_DEVCMD2, 1000);  in vnic_dev_init_devcmd2()
478 	vdev->devcmd_rtn = &vnic_dev_cmd2;  in vnic_dev_init_devcmd2()
483 	vnic_dev_free_desc_ring(vdev, &vdev->devcmd2->results_ring);  in vnic_dev_init_devcmd2()
485 	vnic_wq_disable(&vdev->devcmd2->wq);  in vnic_dev_init_devcmd2()
486 	vnic_wq_free(&vdev->devcmd2->wq);  in vnic_dev_init_devcmd2()
488 	kfree(vdev->devcmd2);  in vnic_dev_init_devcmd2()
489 	vdev->devcmd2 = NULL;  in vnic_dev_init_devcmd2()
495 static void vnic_dev_deinit_devcmd2(struct vnic_dev *vdev)  in vnic_dev_deinit_devcmd2()  argument
497 	vnic_dev_free_desc_ring(vdev, &vdev->devcmd2->results_ring);  in vnic_dev_deinit_devcmd2()
498 	vnic_wq_disable(&vdev->devcmd2->wq);  in vnic_dev_deinit_devcmd2()
499 	vnic_wq_free(&vdev->devcmd2->wq);  in vnic_dev_deinit_devcmd2()
500 	kfree(vdev->devcmd2);  in vnic_dev_deinit_devcmd2()
501 	vdev->devcmd2 = NULL;  in vnic_dev_deinit_devcmd2()
502 	vdev->devcmd_rtn = &vnic_dev_cmd1;  in vnic_dev_deinit_devcmd2()
506 static int vnic_dev_cmd_no_proxy(struct vnic_dev *vdev,  in vnic_dev_cmd_no_proxy()  argument
511 	vdev->args[0] = *a0;  in vnic_dev_cmd_no_proxy()
512 	vdev->args[1] = *a1;  in vnic_dev_cmd_no_proxy()
514 	err = (*vdev->devcmd_rtn)(vdev, cmd, wait);  in vnic_dev_cmd_no_proxy()
516 	*a0 = vdev->args[0];  in vnic_dev_cmd_no_proxy()
517 	*a1 = vdev->args[1];  in vnic_dev_cmd_no_proxy()
523 int vnic_dev_cmd(struct vnic_dev *vdev, enum vnic_devcmd_cmd cmd,  in vnic_dev_cmd()  argument
526 	memset(vdev->args, 0, sizeof(vdev->args));  in vnic_dev_cmd()
528 	switch (vdev->proxy) {  in vnic_dev_cmd()
531 		return vnic_dev_cmd_no_proxy(vdev, cmd, a0, a1, wait);  in vnic_dev_cmd()
536 int vnic_dev_fw_info(struct vnic_dev *vdev,  in vnic_dev_fw_info()  argument
543 	if (!vdev->fw_info) {  in vnic_dev_fw_info()
544 		vdev->fw_info = dma_alloc_coherent(&vdev->pdev->dev,  in vnic_dev_fw_info()
546 			&vdev->fw_info_pa, GFP_KERNEL);  in vnic_dev_fw_info()
547 		if (!vdev->fw_info)  in vnic_dev_fw_info()
550 		a0 = vdev->fw_info_pa;  in vnic_dev_fw_info()
553 		err = vnic_dev_cmd(vdev, CMD_MCPU_FW_INFO, &a0, &a1, wait);  in vnic_dev_fw_info()
556 	*fw_info = vdev->fw_info;  in vnic_dev_fw_info()
561 int vnic_dev_spec(struct vnic_dev *vdev, unsigned int offset, unsigned int size,  in vnic_dev_spec()  argument
571 	err = vnic_dev_cmd(vdev, CMD_DEV_SPEC, &a0, &a1, wait);  in vnic_dev_spec()
594 int vnic_dev_stats_clear(struct vnic_dev *vdev)  in vnic_dev_stats_clear()  argument
598 	return vnic_dev_cmd(vdev, CMD_STATS_CLEAR, &a0, &a1, wait);  in vnic_dev_stats_clear()
601 int vnic_dev_stats_dump(struct vnic_dev *vdev, struct vnic_stats **stats)  in vnic_dev_stats_dump()  argument
606 	if (!vdev->stats) {  in vnic_dev_stats_dump()
607 		vdev->stats = dma_alloc_coherent(&vdev->pdev->dev,  in vnic_dev_stats_dump()
608 			sizeof(struct vnic_stats), &vdev->stats_pa, GFP_KERNEL);  in vnic_dev_stats_dump()
609 		if (!vdev->stats)  in vnic_dev_stats_dump()
613 	*stats = vdev->stats;  in vnic_dev_stats_dump()
614 	a0 = vdev->stats_pa;  in vnic_dev_stats_dump()
617 	return vnic_dev_cmd(vdev, CMD_STATS_DUMP, &a0, &a1, wait);  in vnic_dev_stats_dump()
620 int vnic_dev_close(struct vnic_dev *vdev)  in vnic_dev_close()  argument
624 	return vnic_dev_cmd(vdev, CMD_CLOSE, &a0, &a1, wait);  in vnic_dev_close()
627 int vnic_dev_enable(struct vnic_dev *vdev)  in vnic_dev_enable()  argument
631 	return vnic_dev_cmd(vdev, CMD_ENABLE, &a0, &a1, wait);  in vnic_dev_enable()
634 int vnic_dev_disable(struct vnic_dev *vdev)  in vnic_dev_disable()  argument
638 	return vnic_dev_cmd(vdev, CMD_DISABLE, &a0, &a1, wait);  in vnic_dev_disable()
641 int vnic_dev_open(struct vnic_dev *vdev, int arg)  in vnic_dev_open()  argument
645 	return vnic_dev_cmd(vdev, CMD_OPEN, &a0, &a1, wait);  in vnic_dev_open()
648 int vnic_dev_open_done(struct vnic_dev *vdev, int *done)  in vnic_dev_open_done()  argument
656 	err = vnic_dev_cmd(vdev, CMD_OPEN_STATUS, &a0, &a1, wait);  in vnic_dev_open_done()
665 int vnic_dev_soft_reset(struct vnic_dev *vdev, int arg)  in vnic_dev_soft_reset()  argument
669 	return vnic_dev_cmd(vdev, CMD_SOFT_RESET, &a0, &a1, wait);  in vnic_dev_soft_reset()
672 int vnic_dev_soft_reset_done(struct vnic_dev *vdev, int *done)  in vnic_dev_soft_reset_done()  argument
680 	err = vnic_dev_cmd(vdev, CMD_SOFT_RESET_STATUS, &a0, &a1, wait);  in vnic_dev_soft_reset_done()
689 int vnic_dev_hang_notify(struct vnic_dev *vdev)  in vnic_dev_hang_notify()  argument
693 	return vnic_dev_cmd(vdev, CMD_HANG_NOTIFY, &a0, &a1, wait);  in vnic_dev_hang_notify()
696 int vnic_dev_mac_addr(struct vnic_dev *vdev, u8 *mac_addr)  in vnic_dev_mac_addr()  argument
705 	err = vnic_dev_cmd(vdev, CMD_MAC_ADDR, &a[0], &a[1], wait);  in vnic_dev_mac_addr()
715 void vnic_dev_packet_filter(struct vnic_dev *vdev, int directed, int multicast,  in vnic_dev_packet_filter()  argument
728 	err = vnic_dev_cmd(vdev, CMD_PACKET_FILTER, &a0, &a1, wait);  in vnic_dev_packet_filter()
733 void vnic_dev_add_addr(struct vnic_dev *vdev, u8 *addr)  in vnic_dev_add_addr()  argument
743 	err = vnic_dev_cmd(vdev, CMD_ADDR_ADD, &a[0], &a[1], wait);  in vnic_dev_add_addr()
748 void vnic_dev_del_addr(struct vnic_dev *vdev, u8 *addr)  in vnic_dev_del_addr()  argument
758 	err = vnic_dev_cmd(vdev, CMD_ADDR_DEL, &a[0], &a[1], wait);  in vnic_dev_del_addr()
763 int vnic_dev_notify_set(struct vnic_dev *vdev, u16 intr)  in vnic_dev_notify_set()  argument
768 	if (!vdev->notify) {  in vnic_dev_notify_set()
769 		vdev->notify = dma_alloc_coherent(&vdev->pdev->dev,  in vnic_dev_notify_set()
771 			&vdev->notify_pa, GFP_KERNEL);  in vnic_dev_notify_set()
772 		if (!vdev->notify)  in vnic_dev_notify_set()
776 	a0 = vdev->notify_pa;  in vnic_dev_notify_set()
780 	return vnic_dev_cmd(vdev, CMD_NOTIFY, &a0, &a1, wait);  in vnic_dev_notify_set()
783 void vnic_dev_notify_unset(struct vnic_dev *vdev)  in vnic_dev_notify_unset()  argument
792 	vnic_dev_cmd(vdev, CMD_NOTIFY, &a0, &a1, wait);  in vnic_dev_notify_unset()
795 static int vnic_dev_notify_ready(struct vnic_dev *vdev)  in vnic_dev_notify_ready()  argument
802 	if (!vdev->notify)  in vnic_dev_notify_ready()
807 		memcpy(&vdev->notify_copy, vdev->notify,  in vnic_dev_notify_ready()
809 		words = (u32 *)&vdev->notify_copy;  in vnic_dev_notify_ready()
817 int vnic_dev_init(struct vnic_dev *vdev, int arg)  in vnic_dev_init()  argument
821 	return vnic_dev_cmd(vdev, CMD_INIT, &a0, &a1, wait);  in vnic_dev_init()
824 u16 vnic_dev_set_default_vlan(struct vnic_dev *vdev, u16 new_default_vlan)  in vnic_dev_set_default_vlan()  argument
830 	old_vlan = vnic_dev_cmd(vdev, CMD_SET_DEFAULT_VLAN, &a0, &a1, wait);  in vnic_dev_set_default_vlan()
834 int vnic_dev_link_status(struct vnic_dev *vdev)  in vnic_dev_link_status()  argument
836 	if (vdev->linkstatus)  in vnic_dev_link_status()
837 		return *vdev->linkstatus;  in vnic_dev_link_status()
839 	if (!vnic_dev_notify_ready(vdev))  in vnic_dev_link_status()
842 	return vdev->notify_copy.link_state;  in vnic_dev_link_status()
845 u32 vnic_dev_port_speed(struct vnic_dev *vdev)  in vnic_dev_port_speed()  argument
847 	if (!vnic_dev_notify_ready(vdev))  in vnic_dev_port_speed()
850 	return vdev->notify_copy.port_speed;  in vnic_dev_port_speed()
853 u32 vnic_dev_msg_lvl(struct vnic_dev *vdev)  in vnic_dev_msg_lvl()  argument
855 	if (!vnic_dev_notify_ready(vdev))  in vnic_dev_msg_lvl()
858 	return vdev->notify_copy.msglvl;  in vnic_dev_msg_lvl()
861 u32 vnic_dev_mtu(struct vnic_dev *vdev)  in vnic_dev_mtu()  argument
863 	if (!vnic_dev_notify_ready(vdev))  in vnic_dev_mtu()
866 	return vdev->notify_copy.mtu;  in vnic_dev_mtu()
869 u32 vnic_dev_link_down_cnt(struct vnic_dev *vdev)  in vnic_dev_link_down_cnt()  argument
871 	if (!vnic_dev_notify_ready(vdev))  in vnic_dev_link_down_cnt()
874 	return vdev->notify_copy.link_down_cnt;  in vnic_dev_link_down_cnt()
877 void vnic_dev_set_intr_mode(struct vnic_dev *vdev,  in vnic_dev_set_intr_mode()  argument
880 	vdev->intr_mode = intr_mode;  in vnic_dev_set_intr_mode()
884 	struct vnic_dev *vdev)  in vnic_dev_get_intr_mode()  argument
886 	return vdev->intr_mode;  in vnic_dev_get_intr_mode()
889 void vnic_dev_unregister(struct vnic_dev *vdev)  in vnic_dev_unregister()  argument
891 	if (vdev) {  in vnic_dev_unregister()
892 		if (vdev->notify)  in vnic_dev_unregister()
893 			dma_free_coherent(&vdev->pdev->dev,  in vnic_dev_unregister()
895 				vdev->notify,  in vnic_dev_unregister()
896 				vdev->notify_pa);  in vnic_dev_unregister()
897 		if (vdev->linkstatus)  in vnic_dev_unregister()
898 			dma_free_coherent(&vdev->pdev->dev,  in vnic_dev_unregister()
900 				vdev->linkstatus,  in vnic_dev_unregister()
901 				vdev->linkstatus_pa);  in vnic_dev_unregister()
902 		if (vdev->stats)  in vnic_dev_unregister()
903 			dma_free_coherent(&vdev->pdev->dev,  in vnic_dev_unregister()
905 				vdev->stats, vdev->stats_pa);  in vnic_dev_unregister()
906 		if (vdev->fw_info)  in vnic_dev_unregister()
907 			dma_free_coherent(&vdev->pdev->dev,  in vnic_dev_unregister()
909 				vdev->fw_info, vdev->fw_info_pa);  in vnic_dev_unregister()
910 		if (vdev->devcmd2)  in vnic_dev_unregister()
911 			vnic_dev_deinit_devcmd2(vdev);  in vnic_dev_unregister()
912 		kfree(vdev);  in vnic_dev_unregister()
916 struct vnic_dev *vnic_dev_register(struct vnic_dev *vdev,  in vnic_dev_register()  argument
919 	if (!vdev) {  in vnic_dev_register()
920 		vdev = kzalloc(sizeof(struct vnic_dev), GFP_KERNEL);  in vnic_dev_register()
921 		if (!vdev)  in vnic_dev_register()
925 	vdev->priv = priv;  in vnic_dev_register()
926 	vdev->pdev = pdev;  in vnic_dev_register()
928 	if (vnic_dev_discover_res(vdev, bar))  in vnic_dev_register()
931 	return vdev;  in vnic_dev_register()
934 	vnic_dev_unregister(vdev);  in vnic_dev_register()
938 int vnic_dev_cmd_init(struct vnic_dev *vdev)  in vnic_dev_cmd_init()  argument
943 	p = vnic_dev_get_res(vdev, RES_TYPE_DEVCMD2, 0);  in vnic_dev_cmd_init()
946 		err = vnic_dev_init_devcmd2(vdev);  in vnic_dev_cmd_init()
949 		err = vnic_dev_init_devcmd1(vdev);  in vnic_dev_cmd_init()