61 	int (*devcmd_rtn)(struct vnic_dev *vdev, enum vnic_devcmd_cmd cmd,
70 void *vnic_dev_priv(struct vnic_dev *vdev)  in vnic_dev_priv()  argument
72 	return vdev->priv;  in vnic_dev_priv()
75 static int vnic_dev_discover_res(struct vnic_dev *vdev,  in vnic_dev_discover_res()  argument
142 		vdev->res[type].count = count;  in vnic_dev_discover_res()
143 		vdev->res[type].vaddr = (char __iomem *)bar->vaddr + bar_offset;  in vnic_dev_discover_res()
149 unsigned int vnic_dev_get_res_count(struct vnic_dev *vdev,  in vnic_dev_get_res_count()  argument
152 	return vdev->res[type].count;  in vnic_dev_get_res_count()
155 void __iomem *vnic_dev_get_res(struct vnic_dev *vdev, enum vnic_res_type type,  in vnic_dev_get_res()  argument
158 	if (!vdev->res[type].vaddr)  in vnic_dev_get_res()
166 		return (char __iomem *)vdev->res[type].vaddr +  in vnic_dev_get_res()
169 		return (char __iomem *)vdev->res[type].vaddr;  in vnic_dev_get_res()
206 int vnic_dev_alloc_desc_ring(struct vnic_dev *vdev, struct vnic_dev_ring *ring,  in vnic_dev_alloc_desc_ring()  argument
211 	ring->descs_unaligned = dma_alloc_coherent(&vdev->pdev->dev,  in vnic_dev_alloc_desc_ring()
234 void vnic_dev_free_desc_ring(struct vnic_dev *vdev, struct vnic_dev_ring *ring)  in vnic_dev_free_desc_ring()  argument
237 		dma_free_coherent(&vdev->pdev->dev,  in vnic_dev_free_desc_ring()
245 static int vnic_dev_cmd1(struct vnic_dev *vdev, enum vnic_devcmd_cmd cmd, int wait)  in vnic_dev_cmd1()  argument
247 	struct vnic_devcmd __iomem *devcmd = vdev->devcmd;  in vnic_dev_cmd1()
259 	u64 *a0 = &vdev->args[0];  in vnic_dev_cmd1()
260 	u64 *a1 = &vdev->args[1];  in vnic_dev_cmd1()
307 static int vnic_dev_cmd2(struct vnic_dev *vdev, enum vnic_devcmd_cmd cmd,  in vnic_dev_cmd2()  argument
310 	struct devcmd2_controller *dc2c = vdev->devcmd2;  in vnic_dev_cmd2()
326 				pci_name(vdev->pdev), _CMD_N(cmd));  in vnic_dev_cmd2()
328 				pci_name(vdev->pdev), fetch_index, posted);  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()
351 			dc2c->cmd_ring[posted].args[i] = vdev->args[i];  in vnic_dev_cmd2()
383 						pci_name(vdev->pdev),  in vnic_dev_cmd2()
390 					vdev->args[i] = result->results[i];  in vnic_dev_cmd2()
396 	pr_err("%s:Timed out devcmd %d\n", pci_name(vdev->pdev), _CMD_N(cmd));  in vnic_dev_cmd2()
402 static int vnic_dev_init_devcmd1(struct vnic_dev *vdev)  in vnic_dev_init_devcmd1()  argument
404 	vdev->devcmd = vnic_dev_get_res(vdev, RES_TYPE_DEVCMD, 0);  in vnic_dev_init_devcmd1()
405 	if (!vdev->devcmd)  in vnic_dev_init_devcmd1()
408 	vdev->devcmd_rtn = &vnic_dev_cmd1;  in vnic_dev_init_devcmd1()
413 static int vnic_dev_init_devcmd2(struct vnic_dev *vdev)  in vnic_dev_init_devcmd2()  argument
418 	if (vdev->devcmd2)  in vnic_dev_init_devcmd2()
421 	vdev->devcmd2 = kzalloc(sizeof(*vdev->devcmd2), GFP_ATOMIC);  in vnic_dev_init_devcmd2()
422 	if (!vdev->devcmd2)  in vnic_dev_init_devcmd2()
425 	vdev->devcmd2->color = 1;  in vnic_dev_init_devcmd2()
426 	vdev->devcmd2->result_size = DEVCMD2_RING_SIZE;  in vnic_dev_init_devcmd2()
427 	err = vnic_wq_devcmd2_alloc(vdev, &vdev->devcmd2->wq,  in vnic_dev_init_devcmd2()
432 	fetch_index = ioread32(&vdev->devcmd2->wq.ctrl->fetch_index);  in vnic_dev_init_devcmd2()
444 	vnic_wq_init_start(&vdev->devcmd2->wq, 0, fetch_index,  in vnic_dev_init_devcmd2()
447 	vnic_wq_enable(&vdev->devcmd2->wq);  in vnic_dev_init_devcmd2()
449 	err = vnic_dev_alloc_desc_ring(vdev, &vdev->devcmd2->results_ring,  in vnic_dev_init_devcmd2()
454 	vdev->devcmd2->result =  in vnic_dev_init_devcmd2()
455 		(struct devcmd2_result *) vdev->devcmd2->results_ring.descs;  in vnic_dev_init_devcmd2()
456 	vdev->devcmd2->cmd_ring =  in vnic_dev_init_devcmd2()
457 		(struct vnic_devcmd2 *) vdev->devcmd2->wq.ring.descs;  in vnic_dev_init_devcmd2()
458 	vdev->devcmd2->wq_ctrl = vdev->devcmd2->wq.ctrl;  in vnic_dev_init_devcmd2()
459 	vdev->args[0] = (u64) vdev->devcmd2->results_ring.base_addr |  in vnic_dev_init_devcmd2()
461 	vdev->args[1] = DEVCMD2_RING_SIZE;  in vnic_dev_init_devcmd2()
463 	err = vnic_dev_cmd2(vdev, CMD_INITIALIZE_DEVCMD2, 1000);  in vnic_dev_init_devcmd2()
467 	vdev->devcmd_rtn = &vnic_dev_cmd2;  in vnic_dev_init_devcmd2()
472 	vnic_dev_free_desc_ring(vdev, &vdev->devcmd2->results_ring);  in vnic_dev_init_devcmd2()
474 	vnic_wq_disable(&vdev->devcmd2->wq);  in vnic_dev_init_devcmd2()
476 	vnic_wq_free(&vdev->devcmd2->wq);  in vnic_dev_init_devcmd2()
478 	kfree(vdev->devcmd2);  in vnic_dev_init_devcmd2()
479 	vdev->devcmd2 = NULL;  in vnic_dev_init_devcmd2()
485 static void vnic_dev_deinit_devcmd2(struct vnic_dev *vdev)  in vnic_dev_deinit_devcmd2()  argument
487 	vnic_dev_free_desc_ring(vdev, &vdev->devcmd2->results_ring);  in vnic_dev_deinit_devcmd2()
488 	vnic_wq_disable(&vdev->devcmd2->wq);  in vnic_dev_deinit_devcmd2()
489 	vnic_wq_free(&vdev->devcmd2->wq);  in vnic_dev_deinit_devcmd2()
490 	kfree(vdev->devcmd2);  in vnic_dev_deinit_devcmd2()
491 	vdev->devcmd2 = NULL;  in vnic_dev_deinit_devcmd2()
492 	vdev->devcmd_rtn = &vnic_dev_cmd1;  in vnic_dev_deinit_devcmd2()
496 static int vnic_dev_cmd_no_proxy(struct vnic_dev *vdev,  in vnic_dev_cmd_no_proxy()  argument
501 	vdev->args[0] = *a0;  in vnic_dev_cmd_no_proxy()
502 	vdev->args[1] = *a1;  in vnic_dev_cmd_no_proxy()
504 	err = (*vdev->devcmd_rtn)(vdev, cmd, wait);  in vnic_dev_cmd_no_proxy()
506 	*a0 = vdev->args[0];  in vnic_dev_cmd_no_proxy()
507 	*a1 = vdev->args[1];  in vnic_dev_cmd_no_proxy()
513 int vnic_dev_cmd(struct vnic_dev *vdev, enum vnic_devcmd_cmd cmd,  in vnic_dev_cmd()  argument
516 	memset(vdev->args, 0, sizeof(vdev->args));  in vnic_dev_cmd()
518 	switch (vdev->proxy) {  in vnic_dev_cmd()
521 		return vnic_dev_cmd_no_proxy(vdev, cmd, a0, a1, wait);  in vnic_dev_cmd()
526 int vnic_dev_fw_info(struct vnic_dev *vdev,  in vnic_dev_fw_info()  argument
533 	if (!vdev->fw_info) {  in vnic_dev_fw_info()
534 		vdev->fw_info = dma_alloc_coherent(&vdev->pdev->dev,  in vnic_dev_fw_info()
536 			&vdev->fw_info_pa, GFP_KERNEL);  in vnic_dev_fw_info()
537 		if (!vdev->fw_info)  in vnic_dev_fw_info()
540 		a0 = vdev->fw_info_pa;  in vnic_dev_fw_info()
543 		err = vnic_dev_cmd(vdev, CMD_MCPU_FW_INFO, &a0, &a1, wait);  in vnic_dev_fw_info()
546 	*fw_info = vdev->fw_info;  in vnic_dev_fw_info()
551 int vnic_dev_spec(struct vnic_dev *vdev, unsigned int offset, unsigned int size,  in vnic_dev_spec()  argument
561 	err = vnic_dev_cmd(vdev, CMD_DEV_SPEC, &a0, &a1, wait);  in vnic_dev_spec()
584 int vnic_dev_stats_clear(struct vnic_dev *vdev)  in vnic_dev_stats_clear()  argument
588 	return vnic_dev_cmd(vdev, CMD_STATS_CLEAR, &a0, &a1, wait);  in vnic_dev_stats_clear()
591 int vnic_dev_stats_dump(struct vnic_dev *vdev, struct vnic_stats **stats)  in vnic_dev_stats_dump()  argument
596 	if (!vdev->stats) {  in vnic_dev_stats_dump()
597 		vdev->stats = dma_alloc_coherent(&vdev->pdev->dev,  in vnic_dev_stats_dump()
598 			sizeof(struct vnic_stats), &vdev->stats_pa, GFP_KERNEL);  in vnic_dev_stats_dump()
599 		if (!vdev->stats)  in vnic_dev_stats_dump()
603 	*stats = vdev->stats;  in vnic_dev_stats_dump()
604 	a0 = vdev->stats_pa;  in vnic_dev_stats_dump()
607 	return vnic_dev_cmd(vdev, CMD_STATS_DUMP, &a0, &a1, wait);  in vnic_dev_stats_dump()
610 int vnic_dev_close(struct vnic_dev *vdev)  in vnic_dev_close()  argument
614 	return vnic_dev_cmd(vdev, CMD_CLOSE, &a0, &a1, wait);  in vnic_dev_close()
617 int vnic_dev_enable(struct vnic_dev *vdev)  in vnic_dev_enable()  argument
621 	return vnic_dev_cmd(vdev, CMD_ENABLE, &a0, &a1, wait);  in vnic_dev_enable()
624 int vnic_dev_disable(struct vnic_dev *vdev)  in vnic_dev_disable()  argument
628 	return vnic_dev_cmd(vdev, CMD_DISABLE, &a0, &a1, wait);  in vnic_dev_disable()
631 int vnic_dev_open(struct vnic_dev *vdev, int arg)  in vnic_dev_open()  argument
635 	return vnic_dev_cmd(vdev, CMD_OPEN, &a0, &a1, wait);  in vnic_dev_open()
638 int vnic_dev_open_done(struct vnic_dev *vdev, int *done)  in vnic_dev_open_done()  argument
646 	err = vnic_dev_cmd(vdev, CMD_OPEN_STATUS, &a0, &a1, wait);  in vnic_dev_open_done()
655 int vnic_dev_soft_reset(struct vnic_dev *vdev, int arg)  in vnic_dev_soft_reset()  argument
659 	return vnic_dev_cmd(vdev, CMD_SOFT_RESET, &a0, &a1, wait);  in vnic_dev_soft_reset()
662 int vnic_dev_soft_reset_done(struct vnic_dev *vdev, int *done)  in vnic_dev_soft_reset_done()  argument
670 	err = vnic_dev_cmd(vdev, CMD_SOFT_RESET_STATUS, &a0, &a1, wait);  in vnic_dev_soft_reset_done()
679 int vnic_dev_hang_notify(struct vnic_dev *vdev)  in vnic_dev_hang_notify()  argument
683 	return vnic_dev_cmd(vdev, CMD_HANG_NOTIFY, &a0, &a1, wait);  in vnic_dev_hang_notify()
686 int vnic_dev_mac_addr(struct vnic_dev *vdev, u8 *mac_addr)  in vnic_dev_mac_addr()  argument
695 	err = vnic_dev_cmd(vdev, CMD_MAC_ADDR, &a[0], &a[1], wait);  in vnic_dev_mac_addr()
705 void vnic_dev_packet_filter(struct vnic_dev *vdev, int directed, int multicast,  in vnic_dev_packet_filter()  argument
718 	err = vnic_dev_cmd(vdev, CMD_PACKET_FILTER, &a0, &a1, wait);  in vnic_dev_packet_filter()
723 void vnic_dev_add_addr(struct vnic_dev *vdev, u8 *addr)  in vnic_dev_add_addr()  argument
733 	err = vnic_dev_cmd(vdev, CMD_ADDR_ADD, &a[0], &a[1], wait);  in vnic_dev_add_addr()
738 void vnic_dev_del_addr(struct vnic_dev *vdev, u8 *addr)  in vnic_dev_del_addr()  argument
748 	err = vnic_dev_cmd(vdev, CMD_ADDR_DEL, &a[0], &a[1], wait);  in vnic_dev_del_addr()
753 int vnic_dev_notify_set(struct vnic_dev *vdev, u16 intr)  in vnic_dev_notify_set()  argument
758 	if (!vdev->notify) {  in vnic_dev_notify_set()
759 		vdev->notify = dma_alloc_coherent(&vdev->pdev->dev,  in vnic_dev_notify_set()
761 			&vdev->notify_pa, GFP_KERNEL);  in vnic_dev_notify_set()
762 		if (!vdev->notify)  in vnic_dev_notify_set()
766 	a0 = vdev->notify_pa;  in vnic_dev_notify_set()
770 	return vnic_dev_cmd(vdev, CMD_NOTIFY, &a0, &a1, wait);  in vnic_dev_notify_set()
773 void vnic_dev_notify_unset(struct vnic_dev *vdev)  in vnic_dev_notify_unset()  argument
782 	vnic_dev_cmd(vdev, CMD_NOTIFY, &a0, &a1, wait);  in vnic_dev_notify_unset()
785 static int vnic_dev_notify_ready(struct vnic_dev *vdev)  in vnic_dev_notify_ready()  argument
792 	if (!vdev->notify)  in vnic_dev_notify_ready()
797 		memcpy(&vdev->notify_copy, vdev->notify,  in vnic_dev_notify_ready()
799 		words = (u32 *)&vdev->notify_copy;  in vnic_dev_notify_ready()
807 int vnic_dev_init(struct vnic_dev *vdev, int arg)  in vnic_dev_init()  argument
811 	return vnic_dev_cmd(vdev, CMD_INIT, &a0, &a1, wait);  in vnic_dev_init()
814 u16 vnic_dev_set_default_vlan(struct vnic_dev *vdev, u16 new_default_vlan)  in vnic_dev_set_default_vlan()  argument
820 	old_vlan = vnic_dev_cmd(vdev, CMD_SET_DEFAULT_VLAN, &a0, &a1, wait);  in vnic_dev_set_default_vlan()
824 int vnic_dev_link_status(struct vnic_dev *vdev)  in vnic_dev_link_status()  argument
826 	if (vdev->linkstatus)  in vnic_dev_link_status()
827 		return *vdev->linkstatus;  in vnic_dev_link_status()
829 	if (!vnic_dev_notify_ready(vdev))  in vnic_dev_link_status()
832 	return vdev->notify_copy.link_state;  in vnic_dev_link_status()
835 u32 vnic_dev_port_speed(struct vnic_dev *vdev)  in vnic_dev_port_speed()  argument
837 	if (!vnic_dev_notify_ready(vdev))  in vnic_dev_port_speed()
840 	return vdev->notify_copy.port_speed;  in vnic_dev_port_speed()
843 u32 vnic_dev_msg_lvl(struct vnic_dev *vdev)  in vnic_dev_msg_lvl()  argument
845 	if (!vnic_dev_notify_ready(vdev))  in vnic_dev_msg_lvl()
848 	return vdev->notify_copy.msglvl;  in vnic_dev_msg_lvl()
851 u32 vnic_dev_mtu(struct vnic_dev *vdev)  in vnic_dev_mtu()  argument
853 	if (!vnic_dev_notify_ready(vdev))  in vnic_dev_mtu()
856 	return vdev->notify_copy.mtu;  in vnic_dev_mtu()
859 u32 vnic_dev_link_down_cnt(struct vnic_dev *vdev)  in vnic_dev_link_down_cnt()  argument
861 	if (!vnic_dev_notify_ready(vdev))  in vnic_dev_link_down_cnt()
864 	return vdev->notify_copy.link_down_cnt;  in vnic_dev_link_down_cnt()
867 void vnic_dev_set_intr_mode(struct vnic_dev *vdev,  in vnic_dev_set_intr_mode()  argument
870 	vdev->intr_mode = intr_mode;  in vnic_dev_set_intr_mode()
874 	struct vnic_dev *vdev)  in vnic_dev_get_intr_mode()  argument
876 	return vdev->intr_mode;  in vnic_dev_get_intr_mode()
879 void vnic_dev_unregister(struct vnic_dev *vdev)  in vnic_dev_unregister()  argument
881 	if (vdev) {  in vnic_dev_unregister()
882 		if (vdev->notify)  in vnic_dev_unregister()
883 			dma_free_coherent(&vdev->pdev->dev,  in vnic_dev_unregister()
885 				vdev->notify,  in vnic_dev_unregister()
886 				vdev->notify_pa);  in vnic_dev_unregister()
887 		if (vdev->linkstatus)  in vnic_dev_unregister()
888 			dma_free_coherent(&vdev->pdev->dev,  in vnic_dev_unregister()
890 				vdev->linkstatus,  in vnic_dev_unregister()
891 				vdev->linkstatus_pa);  in vnic_dev_unregister()
892 		if (vdev->stats)  in vnic_dev_unregister()
893 			dma_free_coherent(&vdev->pdev->dev,  in vnic_dev_unregister()
895 				vdev->stats, vdev->stats_pa);  in vnic_dev_unregister()
896 		if (vdev->fw_info)  in vnic_dev_unregister()
897 			dma_free_coherent(&vdev->pdev->dev,  in vnic_dev_unregister()
899 				vdev->fw_info, vdev->fw_info_pa);  in vnic_dev_unregister()
900 		if (vdev->devcmd2)  in vnic_dev_unregister()
901 			vnic_dev_deinit_devcmd2(vdev);  in vnic_dev_unregister()
902 		kfree(vdev);  in vnic_dev_unregister()
906 struct vnic_dev *vnic_dev_register(struct vnic_dev *vdev,  in vnic_dev_register()  argument
909 	if (!vdev) {  in vnic_dev_register()
910 		vdev = kzalloc(sizeof(struct vnic_dev), GFP_KERNEL);  in vnic_dev_register()
911 		if (!vdev)  in vnic_dev_register()
915 	vdev->priv = priv;  in vnic_dev_register()
916 	vdev->pdev = pdev;  in vnic_dev_register()
918 	if (vnic_dev_discover_res(vdev, bar))  in vnic_dev_register()
921 	return vdev;  in vnic_dev_register()
924 	vnic_dev_unregister(vdev);  in vnic_dev_register()
928 int vnic_dev_cmd_init(struct vnic_dev *vdev)  in vnic_dev_cmd_init()  argument
933 	p = vnic_dev_get_res(vdev, RES_TYPE_DEVCMD2, 0);  in vnic_dev_cmd_init()
936 		err = vnic_dev_init_devcmd2(vdev);  in vnic_dev_cmd_init()
939 		err = vnic_dev_init_devcmd1(vdev);  in vnic_dev_cmd_init()