wangxun/libwx/wx_sriov.c

325 static int wx_get_vf_queues(struct wx *wx, u32 *msgbuf, u32 vf)
330 	msgbuf[WX_VF_TX_QUEUES] = __ALIGN_MASK(1, ~vmdq->mask);
331 	msgbuf[WX_VF_RX_QUEUES] = __ALIGN_MASK(1, ~vmdq->mask);
334 		msgbuf[WX_VF_TRANS_VLAN] = 1;
336 		msgbuf[WX_VF_TRANS_VLAN] = 0;
339 	msgbuf[WX_VF_DEF_QUEUE] = default_tc;
382 	u32 msgbuf[5] = {0, 0, 0, 0, 0};
383 	u8 *addr = (u8 *)(&msgbuf[1]);
413 	msgbuf[0] = WX_VF_RESET;
415 		msgbuf[0] |= WX_VT_MSGTYPE_ACK;
418 		msgbuf[0] |= WX_VT_MSGTYPE_NACK;
422 	msgbuf[3] = wx->mac.mc_filter_type;
423 	wx_write_mbx_pf(wx, msgbuf, WX_VF_PERMADDR_MSG_LEN, vf);
426 static int wx_set_vf_mac_addr(struct wx *wx, u32 *msgbuf, u16 vf)
428 	const u8 *new_mac = ((u8 *)(&msgbuf[1]));
451 static void wx_set_vf_multicasts(struct wx *wx, u32 *msgbuf, u32 vf)
454 	u16 entries = (msgbuf[0] & WX_VT_MSGINFO_MASK)
458 	u16 *hash_list = (u16 *)&msgbuf[1];
567 static int wx_set_vf_vlan_msg(struct wx *wx, u32 *msgbuf, u16 vf)
569 	int add = (msgbuf[0] & WX_VT_MSGINFO_MASK) >> WX_VT_MSGINFO_SHIFT;
570 	int vid = (msgbuf[1] & WX_PSR_VLAN_SWC_VLANID_MASK);
625 static int wx_set_vf_macvlan_msg(struct wx *wx, u32 *msgbuf, u16 vf)
627 	int index = (msgbuf[0] & WX_VT_MSGINFO_MASK) >>
629 	u8 *new_mac = ((u8 *)(&msgbuf[1]));
661 static int wx_negotiate_vf_api(struct wx *wx, u32 *msgbuf, u32 vf)
663 	int api = msgbuf[1];
675 static int wx_get_vf_link_state(struct wx *wx, u32 *msgbuf, u32 vf)
677 	msgbuf[1] = wx->vfinfo[vf].link_enable;
682 static int wx_get_fw_version(struct wx *wx, u32 *msgbuf, u32 vf)
690 	msgbuf[1] = fw_version;
695 static int wx_update_vf_xcast_mode(struct wx *wx, u32 *msgbuf, u32 vf)
697 	int xcast_mode = msgbuf[1];
736 	msgbuf[1] = xcast_mode;
744 	u32 msgbuf[WX_VXMAILBOX_SIZE];
747 	retval = wx_read_mbx_pf(wx, msgbuf, mbx_size, vf);
754 	if (msgbuf[0] & (WX_VT_MSGTYPE_ACK | WX_VT_MSGTYPE_NACK))
757 	if (msgbuf[0] == WX_VF_RESET) {
766 		msgbuf[0] |= WX_VT_MSGTYPE_NACK;
767 		wx_write_mbx_pf(wx, msgbuf, 1, vf);
771 	switch ((msgbuf[0] & U16_MAX)) {
773 		retval = wx_set_vf_mac_addr(wx, msgbuf, vf);
776 		wx_set_vf_multicasts(wx, msgbuf, vf);
780 		retval = wx_set_vf_vlan_msg(wx, msgbuf, vf);
783 		wx_set_vf_lpe(wx, msgbuf[1], vf);
787 		retval = wx_set_vf_macvlan_msg(wx, msgbuf, vf);
790 		retval = wx_negotiate_vf_api(wx, msgbuf, vf);
793 		retval = wx_get_vf_queues(wx, msgbuf, vf);
796 		retval = wx_get_vf_link_state(wx, msgbuf, vf);
799 		retval = wx_get_fw_version(wx, msgbuf, vf);
802 		retval = wx_update_vf_xcast_mode(wx, msgbuf, vf);
807 		wx_err(wx, "Unhandled Msg %8.8x\n", msgbuf[0]);
813 		msgbuf[0] |= WX_VT_MSGTYPE_NACK;
815 		msgbuf[0] |= WX_VT_MSGTYPE_ACK;
817 	msgbuf[0] |= WX_VT_MSGTYPE_CTS;
819 	wx_write_mbx_pf(wx, msgbuf, mbx_size, vf);
864 	u32 msgbuf[2] = {0, 0};
869 	msgbuf[0] = WX_PF_NOFITY_VF_LINK_STATUS | WX_PF_CONTROL_MSG;
871 		msgbuf[1] = FIELD_PREP(GENMASK(31, 1), wx->speed) | link_up;
873 		msgbuf[1] |= WX_PF_NOFITY_VF_NET_NOT_RUNNING;
876 			msgbuf[0] |= WX_VT_MSGTYPE_CTS;
877 		wx_write_mbx_pf(wx, msgbuf, 2, i);