diff options
author | Ingo Molnar <mingo@kernel.org> | 2013-07-01 05:16:54 -0400 |
---|---|---|
committer | Ingo Molnar <mingo@kernel.org> | 2013-07-01 05:18:53 -0400 |
commit | 2fd1b487884310d0aa0c0640179dc7490ad86313 (patch) | |
tree | 1083dce15bd7dc0858c3883b8a361242046c5e09 /drivers/net | |
parent | 333bb864f192015a53b5060b829089decd0220ef (diff) | |
parent | 8bb495e3f02401ee6f76d1b1d77f3ac9f079e376 (diff) |
Merge tag 'v3.10' into sched/core
Merge in a recent upstream commit:
c2853c8df57f include/linux/math64.h: add div64_ul()
because:
72a4cf20cb71 sched: Change cfs_rq load avg to unsigned long
relies on it.
[ We don't rebase sched/core for this, because the handful of
followup commits after the broken commit are not behavioral
changes so are unlikely to be needed during bisection. ]
Signed-off-by: Ingo Molnar <mingo@kernel.org>
Diffstat (limited to 'drivers/net')
104 files changed, 5597 insertions, 594 deletions
diff --git a/drivers/net/bonding/bond_main.c b/drivers/net/bonding/bond_main.c index 29b846cbfb48..f97569613526 100644 --- a/drivers/net/bonding/bond_main.c +++ b/drivers/net/bonding/bond_main.c | |||
@@ -764,8 +764,8 @@ static void bond_resend_igmp_join_requests(struct bonding *bond) | |||
764 | struct net_device *bond_dev, *vlan_dev, *upper_dev; | 764 | struct net_device *bond_dev, *vlan_dev, *upper_dev; |
765 | struct vlan_entry *vlan; | 765 | struct vlan_entry *vlan; |
766 | 766 | ||
767 | rcu_read_lock(); | ||
768 | read_lock(&bond->lock); | 767 | read_lock(&bond->lock); |
768 | rcu_read_lock(); | ||
769 | 769 | ||
770 | bond_dev = bond->dev; | 770 | bond_dev = bond->dev; |
771 | 771 | ||
@@ -787,12 +787,19 @@ static void bond_resend_igmp_join_requests(struct bonding *bond) | |||
787 | if (vlan_dev) | 787 | if (vlan_dev) |
788 | __bond_resend_igmp_join_requests(vlan_dev); | 788 | __bond_resend_igmp_join_requests(vlan_dev); |
789 | } | 789 | } |
790 | rcu_read_unlock(); | ||
790 | 791 | ||
791 | if (--bond->igmp_retrans > 0) | 792 | /* We use curr_slave_lock to protect against concurrent access to |
793 | * igmp_retrans from multiple running instances of this function and | ||
794 | * bond_change_active_slave | ||
795 | */ | ||
796 | write_lock_bh(&bond->curr_slave_lock); | ||
797 | if (bond->igmp_retrans > 1) { | ||
798 | bond->igmp_retrans--; | ||
792 | queue_delayed_work(bond->wq, &bond->mcast_work, HZ/5); | 799 | queue_delayed_work(bond->wq, &bond->mcast_work, HZ/5); |
793 | 800 | } | |
801 | write_unlock_bh(&bond->curr_slave_lock); | ||
794 | read_unlock(&bond->lock); | 802 | read_unlock(&bond->lock); |
795 | rcu_read_unlock(); | ||
796 | } | 803 | } |
797 | 804 | ||
798 | static void bond_resend_igmp_join_requests_delayed(struct work_struct *work) | 805 | static void bond_resend_igmp_join_requests_delayed(struct work_struct *work) |
@@ -1957,6 +1964,10 @@ err_free: | |||
1957 | 1964 | ||
1958 | err_undo_flags: | 1965 | err_undo_flags: |
1959 | bond_compute_features(bond); | 1966 | bond_compute_features(bond); |
1967 | /* Enslave of first slave has failed and we need to fix master's mac */ | ||
1968 | if (bond->slave_cnt == 0 && | ||
1969 | ether_addr_equal(bond_dev->dev_addr, slave_dev->dev_addr)) | ||
1970 | eth_hw_addr_random(bond_dev); | ||
1960 | 1971 | ||
1961 | return res; | 1972 | return res; |
1962 | } | 1973 | } |
@@ -2402,7 +2413,8 @@ static void bond_miimon_commit(struct bonding *bond) | |||
2402 | 2413 | ||
2403 | pr_info("%s: link status definitely up for interface %s, %u Mbps %s duplex.\n", | 2414 | pr_info("%s: link status definitely up for interface %s, %u Mbps %s duplex.\n", |
2404 | bond->dev->name, slave->dev->name, | 2415 | bond->dev->name, slave->dev->name, |
2405 | slave->speed, slave->duplex ? "full" : "half"); | 2416 | slave->speed == SPEED_UNKNOWN ? 0 : slave->speed, |
2417 | slave->duplex ? "full" : "half"); | ||
2406 | 2418 | ||
2407 | /* notify ad that the link status has changed */ | 2419 | /* notify ad that the link status has changed */ |
2408 | if (bond->params.mode == BOND_MODE_8023AD) | 2420 | if (bond->params.mode == BOND_MODE_8023AD) |
diff --git a/drivers/net/bonding/bonding.h b/drivers/net/bonding/bonding.h index 2baec24388b1..f989e1529a29 100644 --- a/drivers/net/bonding/bonding.h +++ b/drivers/net/bonding/bonding.h | |||
@@ -225,7 +225,7 @@ struct bonding { | |||
225 | rwlock_t curr_slave_lock; | 225 | rwlock_t curr_slave_lock; |
226 | u8 send_peer_notif; | 226 | u8 send_peer_notif; |
227 | s8 setup_by_slave; | 227 | s8 setup_by_slave; |
228 | s8 igmp_retrans; | 228 | u8 igmp_retrans; |
229 | #ifdef CONFIG_PROC_FS | 229 | #ifdef CONFIG_PROC_FS |
230 | struct proc_dir_entry *proc_entry; | 230 | struct proc_dir_entry *proc_entry; |
231 | char proc_file_name[IFNAMSIZ]; | 231 | char proc_file_name[IFNAMSIZ]; |
diff --git a/drivers/net/can/usb/esd_usb2.c b/drivers/net/can/usb/esd_usb2.c index 9b74d1e3ad44..6aa7b3266c80 100644 --- a/drivers/net/can/usb/esd_usb2.c +++ b/drivers/net/can/usb/esd_usb2.c | |||
@@ -612,9 +612,15 @@ static int esd_usb2_start(struct esd_usb2_net_priv *priv) | |||
612 | { | 612 | { |
613 | struct esd_usb2 *dev = priv->usb2; | 613 | struct esd_usb2 *dev = priv->usb2; |
614 | struct net_device *netdev = priv->netdev; | 614 | struct net_device *netdev = priv->netdev; |
615 | struct esd_usb2_msg msg; | 615 | struct esd_usb2_msg *msg; |
616 | int err, i; | 616 | int err, i; |
617 | 617 | ||
618 | msg = kmalloc(sizeof(*msg), GFP_KERNEL); | ||
619 | if (!msg) { | ||
620 | err = -ENOMEM; | ||
621 | goto out; | ||
622 | } | ||
623 | |||
618 | /* | 624 | /* |
619 | * Enable all IDs | 625 | * Enable all IDs |
620 | * The IDADD message takes up to 64 32 bit bitmasks (2048 bits). | 626 | * The IDADD message takes up to 64 32 bit bitmasks (2048 bits). |
@@ -628,33 +634,32 @@ static int esd_usb2_start(struct esd_usb2_net_priv *priv) | |||
628 | * the number of the starting bitmask (0..64) to the filter.option | 634 | * the number of the starting bitmask (0..64) to the filter.option |
629 | * field followed by only some bitmasks. | 635 | * field followed by only some bitmasks. |
630 | */ | 636 | */ |
631 | msg.msg.hdr.cmd = CMD_IDADD; | 637 | msg->msg.hdr.cmd = CMD_IDADD; |
632 | msg.msg.hdr.len = 2 + ESD_MAX_ID_SEGMENT; | 638 | msg->msg.hdr.len = 2 + ESD_MAX_ID_SEGMENT; |
633 | msg.msg.filter.net = priv->index; | 639 | msg->msg.filter.net = priv->index; |
634 | msg.msg.filter.option = ESD_ID_ENABLE; /* start with segment 0 */ | 640 | msg->msg.filter.option = ESD_ID_ENABLE; /* start with segment 0 */ |
635 | for (i = 0; i < ESD_MAX_ID_SEGMENT; i++) | 641 | for (i = 0; i < ESD_MAX_ID_SEGMENT; i++) |
636 | msg.msg.filter.mask[i] = cpu_to_le32(0xffffffff); | 642 | msg->msg.filter.mask[i] = cpu_to_le32(0xffffffff); |
637 | /* enable 29bit extended IDs */ | 643 | /* enable 29bit extended IDs */ |
638 | msg.msg.filter.mask[ESD_MAX_ID_SEGMENT] = cpu_to_le32(0x00000001); | 644 | msg->msg.filter.mask[ESD_MAX_ID_SEGMENT] = cpu_to_le32(0x00000001); |
639 | 645 | ||
640 | err = esd_usb2_send_msg(dev, &msg); | 646 | err = esd_usb2_send_msg(dev, msg); |
641 | if (err) | 647 | if (err) |
642 | goto failed; | 648 | goto out; |
643 | 649 | ||
644 | err = esd_usb2_setup_rx_urbs(dev); | 650 | err = esd_usb2_setup_rx_urbs(dev); |
645 | if (err) | 651 | if (err) |
646 | goto failed; | 652 | goto out; |
647 | 653 | ||
648 | priv->can.state = CAN_STATE_ERROR_ACTIVE; | 654 | priv->can.state = CAN_STATE_ERROR_ACTIVE; |
649 | 655 | ||
650 | return 0; | 656 | out: |
651 | |||
652 | failed: | ||
653 | if (err == -ENODEV) | 657 | if (err == -ENODEV) |
654 | netif_device_detach(netdev); | 658 | netif_device_detach(netdev); |
659 | if (err) | ||
660 | netdev_err(netdev, "couldn't start device: %d\n", err); | ||
655 | 661 | ||
656 | netdev_err(netdev, "couldn't start device: %d\n", err); | 662 | kfree(msg); |
657 | |||
658 | return err; | 663 | return err; |
659 | } | 664 | } |
660 | 665 | ||
@@ -833,26 +838,30 @@ nourbmem: | |||
833 | static int esd_usb2_close(struct net_device *netdev) | 838 | static int esd_usb2_close(struct net_device *netdev) |
834 | { | 839 | { |
835 | struct esd_usb2_net_priv *priv = netdev_priv(netdev); | 840 | struct esd_usb2_net_priv *priv = netdev_priv(netdev); |
836 | struct esd_usb2_msg msg; | 841 | struct esd_usb2_msg *msg; |
837 | int i; | 842 | int i; |
838 | 843 | ||
844 | msg = kmalloc(sizeof(*msg), GFP_KERNEL); | ||
845 | if (!msg) | ||
846 | return -ENOMEM; | ||
847 | |||
839 | /* Disable all IDs (see esd_usb2_start()) */ | 848 | /* Disable all IDs (see esd_usb2_start()) */ |
840 | msg.msg.hdr.cmd = CMD_IDADD; | 849 | msg->msg.hdr.cmd = CMD_IDADD; |
841 | msg.msg.hdr.len = 2 + ESD_MAX_ID_SEGMENT; | 850 | msg->msg.hdr.len = 2 + ESD_MAX_ID_SEGMENT; |
842 | msg.msg.filter.net = priv->index; | 851 | msg->msg.filter.net = priv->index; |
843 | msg.msg.filter.option = ESD_ID_ENABLE; /* start with segment 0 */ | 852 | msg->msg.filter.option = ESD_ID_ENABLE; /* start with segment 0 */ |
844 | for (i = 0; i <= ESD_MAX_ID_SEGMENT; i++) | 853 | for (i = 0; i <= ESD_MAX_ID_SEGMENT; i++) |
845 | msg.msg.filter.mask[i] = 0; | 854 | msg->msg.filter.mask[i] = 0; |
846 | if (esd_usb2_send_msg(priv->usb2, &msg) < 0) | 855 | if (esd_usb2_send_msg(priv->usb2, msg) < 0) |
847 | netdev_err(netdev, "sending idadd message failed\n"); | 856 | netdev_err(netdev, "sending idadd message failed\n"); |
848 | 857 | ||
849 | /* set CAN controller to reset mode */ | 858 | /* set CAN controller to reset mode */ |
850 | msg.msg.hdr.len = 2; | 859 | msg->msg.hdr.len = 2; |
851 | msg.msg.hdr.cmd = CMD_SETBAUD; | 860 | msg->msg.hdr.cmd = CMD_SETBAUD; |
852 | msg.msg.setbaud.net = priv->index; | 861 | msg->msg.setbaud.net = priv->index; |
853 | msg.msg.setbaud.rsvd = 0; | 862 | msg->msg.setbaud.rsvd = 0; |
854 | msg.msg.setbaud.baud = cpu_to_le32(ESD_USB2_NO_BAUDRATE); | 863 | msg->msg.setbaud.baud = cpu_to_le32(ESD_USB2_NO_BAUDRATE); |
855 | if (esd_usb2_send_msg(priv->usb2, &msg) < 0) | 864 | if (esd_usb2_send_msg(priv->usb2, msg) < 0) |
856 | netdev_err(netdev, "sending setbaud message failed\n"); | 865 | netdev_err(netdev, "sending setbaud message failed\n"); |
857 | 866 | ||
858 | priv->can.state = CAN_STATE_STOPPED; | 867 | priv->can.state = CAN_STATE_STOPPED; |
@@ -861,6 +870,8 @@ static int esd_usb2_close(struct net_device *netdev) | |||
861 | 870 | ||
862 | close_candev(netdev); | 871 | close_candev(netdev); |
863 | 872 | ||
873 | kfree(msg); | ||
874 | |||
864 | return 0; | 875 | return 0; |
865 | } | 876 | } |
866 | 877 | ||
@@ -886,7 +897,8 @@ static int esd_usb2_set_bittiming(struct net_device *netdev) | |||
886 | { | 897 | { |
887 | struct esd_usb2_net_priv *priv = netdev_priv(netdev); | 898 | struct esd_usb2_net_priv *priv = netdev_priv(netdev); |
888 | struct can_bittiming *bt = &priv->can.bittiming; | 899 | struct can_bittiming *bt = &priv->can.bittiming; |
889 | struct esd_usb2_msg msg; | 900 | struct esd_usb2_msg *msg; |
901 | int err; | ||
890 | u32 canbtr; | 902 | u32 canbtr; |
891 | int sjw_shift; | 903 | int sjw_shift; |
892 | 904 | ||
@@ -912,15 +924,22 @@ static int esd_usb2_set_bittiming(struct net_device *netdev) | |||
912 | if (priv->can.ctrlmode & CAN_CTRLMODE_3_SAMPLES) | 924 | if (priv->can.ctrlmode & CAN_CTRLMODE_3_SAMPLES) |
913 | canbtr |= ESD_USB2_3_SAMPLES; | 925 | canbtr |= ESD_USB2_3_SAMPLES; |
914 | 926 | ||
915 | msg.msg.hdr.len = 2; | 927 | msg = kmalloc(sizeof(*msg), GFP_KERNEL); |
916 | msg.msg.hdr.cmd = CMD_SETBAUD; | 928 | if (!msg) |
917 | msg.msg.setbaud.net = priv->index; | 929 | return -ENOMEM; |
918 | msg.msg.setbaud.rsvd = 0; | 930 | |
919 | msg.msg.setbaud.baud = cpu_to_le32(canbtr); | 931 | msg->msg.hdr.len = 2; |
932 | msg->msg.hdr.cmd = CMD_SETBAUD; | ||
933 | msg->msg.setbaud.net = priv->index; | ||
934 | msg->msg.setbaud.rsvd = 0; | ||
935 | msg->msg.setbaud.baud = cpu_to_le32(canbtr); | ||
920 | 936 | ||
921 | netdev_info(netdev, "setting BTR=%#x\n", canbtr); | 937 | netdev_info(netdev, "setting BTR=%#x\n", canbtr); |
922 | 938 | ||
923 | return esd_usb2_send_msg(priv->usb2, &msg); | 939 | err = esd_usb2_send_msg(priv->usb2, msg); |
940 | |||
941 | kfree(msg); | ||
942 | return err; | ||
924 | } | 943 | } |
925 | 944 | ||
926 | static int esd_usb2_get_berr_counter(const struct net_device *netdev, | 945 | static int esd_usb2_get_berr_counter(const struct net_device *netdev, |
@@ -1022,7 +1041,7 @@ static int esd_usb2_probe(struct usb_interface *intf, | |||
1022 | const struct usb_device_id *id) | 1041 | const struct usb_device_id *id) |
1023 | { | 1042 | { |
1024 | struct esd_usb2 *dev; | 1043 | struct esd_usb2 *dev; |
1025 | struct esd_usb2_msg msg; | 1044 | struct esd_usb2_msg *msg; |
1026 | int i, err; | 1045 | int i, err; |
1027 | 1046 | ||
1028 | dev = kzalloc(sizeof(*dev), GFP_KERNEL); | 1047 | dev = kzalloc(sizeof(*dev), GFP_KERNEL); |
@@ -1037,27 +1056,33 @@ static int esd_usb2_probe(struct usb_interface *intf, | |||
1037 | 1056 | ||
1038 | usb_set_intfdata(intf, dev); | 1057 | usb_set_intfdata(intf, dev); |
1039 | 1058 | ||
1059 | msg = kmalloc(sizeof(*msg), GFP_KERNEL); | ||
1060 | if (!msg) { | ||
1061 | err = -ENOMEM; | ||
1062 | goto free_msg; | ||
1063 | } | ||
1064 | |||
1040 | /* query number of CAN interfaces (nets) */ | 1065 | /* query number of CAN interfaces (nets) */ |
1041 | msg.msg.hdr.cmd = CMD_VERSION; | 1066 | msg->msg.hdr.cmd = CMD_VERSION; |
1042 | msg.msg.hdr.len = 2; | 1067 | msg->msg.hdr.len = 2; |
1043 | msg.msg.version.rsvd = 0; | 1068 | msg->msg.version.rsvd = 0; |
1044 | msg.msg.version.flags = 0; | 1069 | msg->msg.version.flags = 0; |
1045 | msg.msg.version.drv_version = 0; | 1070 | msg->msg.version.drv_version = 0; |
1046 | 1071 | ||
1047 | err = esd_usb2_send_msg(dev, &msg); | 1072 | err = esd_usb2_send_msg(dev, msg); |
1048 | if (err < 0) { | 1073 | if (err < 0) { |
1049 | dev_err(&intf->dev, "sending version message failed\n"); | 1074 | dev_err(&intf->dev, "sending version message failed\n"); |
1050 | goto free_dev; | 1075 | goto free_msg; |
1051 | } | 1076 | } |
1052 | 1077 | ||
1053 | err = esd_usb2_wait_msg(dev, &msg); | 1078 | err = esd_usb2_wait_msg(dev, msg); |
1054 | if (err < 0) { | 1079 | if (err < 0) { |
1055 | dev_err(&intf->dev, "no version message answer\n"); | 1080 | dev_err(&intf->dev, "no version message answer\n"); |
1056 | goto free_dev; | 1081 | goto free_msg; |
1057 | } | 1082 | } |
1058 | 1083 | ||
1059 | dev->net_count = (int)msg.msg.version_reply.nets; | 1084 | dev->net_count = (int)msg->msg.version_reply.nets; |
1060 | dev->version = le32_to_cpu(msg.msg.version_reply.version); | 1085 | dev->version = le32_to_cpu(msg->msg.version_reply.version); |
1061 | 1086 | ||
1062 | if (device_create_file(&intf->dev, &dev_attr_firmware)) | 1087 | if (device_create_file(&intf->dev, &dev_attr_firmware)) |
1063 | dev_err(&intf->dev, | 1088 | dev_err(&intf->dev, |
@@ -1075,10 +1100,10 @@ static int esd_usb2_probe(struct usb_interface *intf, | |||
1075 | for (i = 0; i < dev->net_count; i++) | 1100 | for (i = 0; i < dev->net_count; i++) |
1076 | esd_usb2_probe_one_net(intf, i); | 1101 | esd_usb2_probe_one_net(intf, i); |
1077 | 1102 | ||
1078 | return 0; | 1103 | free_msg: |
1079 | 1104 | kfree(msg); | |
1080 | free_dev: | 1105 | if (err) |
1081 | kfree(dev); | 1106 | kfree(dev); |
1082 | done: | 1107 | done: |
1083 | return err; | 1108 | return err; |
1084 | } | 1109 | } |
diff --git a/drivers/net/can/usb/kvaser_usb.c b/drivers/net/can/usb/kvaser_usb.c index 45cb9f3c1324..3b9546588240 100644 --- a/drivers/net/can/usb/kvaser_usb.c +++ b/drivers/net/can/usb/kvaser_usb.c | |||
@@ -136,6 +136,9 @@ | |||
136 | #define KVASER_CTRL_MODE_SELFRECEPTION 3 | 136 | #define KVASER_CTRL_MODE_SELFRECEPTION 3 |
137 | #define KVASER_CTRL_MODE_OFF 4 | 137 | #define KVASER_CTRL_MODE_OFF 4 |
138 | 138 | ||
139 | /* log message */ | ||
140 | #define KVASER_EXTENDED_FRAME BIT(31) | ||
141 | |||
139 | struct kvaser_msg_simple { | 142 | struct kvaser_msg_simple { |
140 | u8 tid; | 143 | u8 tid; |
141 | u8 channel; | 144 | u8 channel; |
@@ -817,8 +820,13 @@ static void kvaser_usb_rx_can_msg(const struct kvaser_usb *dev, | |||
817 | priv = dev->nets[channel]; | 820 | priv = dev->nets[channel]; |
818 | stats = &priv->netdev->stats; | 821 | stats = &priv->netdev->stats; |
819 | 822 | ||
820 | if (msg->u.rx_can.flag & (MSG_FLAG_ERROR_FRAME | MSG_FLAG_NERR | | 823 | if ((msg->u.rx_can.flag & MSG_FLAG_ERROR_FRAME) && |
821 | MSG_FLAG_OVERRUN)) { | 824 | (msg->id == CMD_LOG_MESSAGE)) { |
825 | kvaser_usb_rx_error(dev, msg); | ||
826 | return; | ||
827 | } else if (msg->u.rx_can.flag & (MSG_FLAG_ERROR_FRAME | | ||
828 | MSG_FLAG_NERR | | ||
829 | MSG_FLAG_OVERRUN)) { | ||
822 | kvaser_usb_rx_can_err(priv, msg); | 830 | kvaser_usb_rx_can_err(priv, msg); |
823 | return; | 831 | return; |
824 | } else if (msg->u.rx_can.flag & ~MSG_FLAG_REMOTE_FRAME) { | 832 | } else if (msg->u.rx_can.flag & ~MSG_FLAG_REMOTE_FRAME) { |
@@ -834,22 +842,40 @@ static void kvaser_usb_rx_can_msg(const struct kvaser_usb *dev, | |||
834 | return; | 842 | return; |
835 | } | 843 | } |
836 | 844 | ||
837 | cf->can_id = ((msg->u.rx_can.msg[0] & 0x1f) << 6) | | 845 | if (msg->id == CMD_LOG_MESSAGE) { |
838 | (msg->u.rx_can.msg[1] & 0x3f); | 846 | cf->can_id = le32_to_cpu(msg->u.log_message.id); |
839 | cf->can_dlc = get_can_dlc(msg->u.rx_can.msg[5]); | 847 | if (cf->can_id & KVASER_EXTENDED_FRAME) |
848 | cf->can_id &= CAN_EFF_MASK | CAN_EFF_FLAG; | ||
849 | else | ||
850 | cf->can_id &= CAN_SFF_MASK; | ||
840 | 851 | ||
841 | if (msg->id == CMD_RX_EXT_MESSAGE) { | 852 | cf->can_dlc = get_can_dlc(msg->u.log_message.dlc); |
842 | cf->can_id <<= 18; | ||
843 | cf->can_id |= ((msg->u.rx_can.msg[2] & 0x0f) << 14) | | ||
844 | ((msg->u.rx_can.msg[3] & 0xff) << 6) | | ||
845 | (msg->u.rx_can.msg[4] & 0x3f); | ||
846 | cf->can_id |= CAN_EFF_FLAG; | ||
847 | } | ||
848 | 853 | ||
849 | if (msg->u.rx_can.flag & MSG_FLAG_REMOTE_FRAME) | 854 | if (msg->u.log_message.flags & MSG_FLAG_REMOTE_FRAME) |
850 | cf->can_id |= CAN_RTR_FLAG; | 855 | cf->can_id |= CAN_RTR_FLAG; |
851 | else | 856 | else |
852 | memcpy(cf->data, &msg->u.rx_can.msg[6], cf->can_dlc); | 857 | memcpy(cf->data, &msg->u.log_message.data, |
858 | cf->can_dlc); | ||
859 | } else { | ||
860 | cf->can_id = ((msg->u.rx_can.msg[0] & 0x1f) << 6) | | ||
861 | (msg->u.rx_can.msg[1] & 0x3f); | ||
862 | |||
863 | if (msg->id == CMD_RX_EXT_MESSAGE) { | ||
864 | cf->can_id <<= 18; | ||
865 | cf->can_id |= ((msg->u.rx_can.msg[2] & 0x0f) << 14) | | ||
866 | ((msg->u.rx_can.msg[3] & 0xff) << 6) | | ||
867 | (msg->u.rx_can.msg[4] & 0x3f); | ||
868 | cf->can_id |= CAN_EFF_FLAG; | ||
869 | } | ||
870 | |||
871 | cf->can_dlc = get_can_dlc(msg->u.rx_can.msg[5]); | ||
872 | |||
873 | if (msg->u.rx_can.flag & MSG_FLAG_REMOTE_FRAME) | ||
874 | cf->can_id |= CAN_RTR_FLAG; | ||
875 | else | ||
876 | memcpy(cf->data, &msg->u.rx_can.msg[6], | ||
877 | cf->can_dlc); | ||
878 | } | ||
853 | 879 | ||
854 | netif_rx(skb); | 880 | netif_rx(skb); |
855 | 881 | ||
@@ -911,6 +937,7 @@ static void kvaser_usb_handle_message(const struct kvaser_usb *dev, | |||
911 | 937 | ||
912 | case CMD_RX_STD_MESSAGE: | 938 | case CMD_RX_STD_MESSAGE: |
913 | case CMD_RX_EXT_MESSAGE: | 939 | case CMD_RX_EXT_MESSAGE: |
940 | case CMD_LOG_MESSAGE: | ||
914 | kvaser_usb_rx_can_msg(dev, msg); | 941 | kvaser_usb_rx_can_msg(dev, msg); |
915 | break; | 942 | break; |
916 | 943 | ||
@@ -919,11 +946,6 @@ static void kvaser_usb_handle_message(const struct kvaser_usb *dev, | |||
919 | kvaser_usb_rx_error(dev, msg); | 946 | kvaser_usb_rx_error(dev, msg); |
920 | break; | 947 | break; |
921 | 948 | ||
922 | case CMD_LOG_MESSAGE: | ||
923 | if (msg->u.log_message.flags & MSG_FLAG_ERROR_FRAME) | ||
924 | kvaser_usb_rx_error(dev, msg); | ||
925 | break; | ||
926 | |||
927 | case CMD_TX_ACKNOWLEDGE: | 949 | case CMD_TX_ACKNOWLEDGE: |
928 | kvaser_usb_tx_acknowledge(dev, msg); | 950 | kvaser_usb_tx_acknowledge(dev, msg); |
929 | break; | 951 | break; |
diff --git a/drivers/net/can/usb/peak_usb/pcan_usb_pro.c b/drivers/net/can/usb/peak_usb/pcan_usb_pro.c index 30d79bfa5b10..8ee9d1556e6e 100644 --- a/drivers/net/can/usb/peak_usb/pcan_usb_pro.c +++ b/drivers/net/can/usb/peak_usb/pcan_usb_pro.c | |||
@@ -504,15 +504,24 @@ static int pcan_usb_pro_restart_async(struct peak_usb_device *dev, | |||
504 | return usb_submit_urb(urb, GFP_ATOMIC); | 504 | return usb_submit_urb(urb, GFP_ATOMIC); |
505 | } | 505 | } |
506 | 506 | ||
507 | static void pcan_usb_pro_drv_loaded(struct peak_usb_device *dev, int loaded) | 507 | static int pcan_usb_pro_drv_loaded(struct peak_usb_device *dev, int loaded) |
508 | { | 508 | { |
509 | u8 buffer[16]; | 509 | u8 *buffer; |
510 | int err; | ||
511 | |||
512 | buffer = kmalloc(PCAN_USBPRO_FCT_DRVLD_REQ_LEN, GFP_KERNEL); | ||
513 | if (!buffer) | ||
514 | return -ENOMEM; | ||
510 | 515 | ||
511 | buffer[0] = 0; | 516 | buffer[0] = 0; |
512 | buffer[1] = !!loaded; | 517 | buffer[1] = !!loaded; |
513 | 518 | ||
514 | pcan_usb_pro_send_req(dev, PCAN_USBPRO_REQ_FCT, | 519 | err = pcan_usb_pro_send_req(dev, PCAN_USBPRO_REQ_FCT, |
515 | PCAN_USBPRO_FCT_DRVLD, buffer, sizeof(buffer)); | 520 | PCAN_USBPRO_FCT_DRVLD, buffer, |
521 | PCAN_USBPRO_FCT_DRVLD_REQ_LEN); | ||
522 | kfree(buffer); | ||
523 | |||
524 | return err; | ||
516 | } | 525 | } |
517 | 526 | ||
518 | static inline | 527 | static inline |
@@ -851,21 +860,24 @@ static int pcan_usb_pro_stop(struct peak_usb_device *dev) | |||
851 | */ | 860 | */ |
852 | static int pcan_usb_pro_init(struct peak_usb_device *dev) | 861 | static int pcan_usb_pro_init(struct peak_usb_device *dev) |
853 | { | 862 | { |
854 | struct pcan_usb_pro_interface *usb_if; | ||
855 | struct pcan_usb_pro_device *pdev = | 863 | struct pcan_usb_pro_device *pdev = |
856 | container_of(dev, struct pcan_usb_pro_device, dev); | 864 | container_of(dev, struct pcan_usb_pro_device, dev); |
865 | struct pcan_usb_pro_interface *usb_if = NULL; | ||
866 | struct pcan_usb_pro_fwinfo *fi = NULL; | ||
867 | struct pcan_usb_pro_blinfo *bi = NULL; | ||
868 | int err; | ||
857 | 869 | ||
858 | /* do this for 1st channel only */ | 870 | /* do this for 1st channel only */ |
859 | if (!dev->prev_siblings) { | 871 | if (!dev->prev_siblings) { |
860 | struct pcan_usb_pro_fwinfo fi; | ||
861 | struct pcan_usb_pro_blinfo bi; | ||
862 | int err; | ||
863 | |||
864 | /* allocate netdevices common structure attached to first one */ | 872 | /* allocate netdevices common structure attached to first one */ |
865 | usb_if = kzalloc(sizeof(struct pcan_usb_pro_interface), | 873 | usb_if = kzalloc(sizeof(struct pcan_usb_pro_interface), |
866 | GFP_KERNEL); | 874 | GFP_KERNEL); |
867 | if (!usb_if) | 875 | fi = kmalloc(sizeof(struct pcan_usb_pro_fwinfo), GFP_KERNEL); |
868 | return -ENOMEM; | 876 | bi = kmalloc(sizeof(struct pcan_usb_pro_blinfo), GFP_KERNEL); |
877 | if (!usb_if || !fi || !bi) { | ||
878 | err = -ENOMEM; | ||
879 | goto err_out; | ||
880 | } | ||
869 | 881 | ||
870 | /* number of ts msgs to ignore before taking one into account */ | 882 | /* number of ts msgs to ignore before taking one into account */ |
871 | usb_if->cm_ignore_count = 5; | 883 | usb_if->cm_ignore_count = 5; |
@@ -877,34 +889,34 @@ static int pcan_usb_pro_init(struct peak_usb_device *dev) | |||
877 | */ | 889 | */ |
878 | err = pcan_usb_pro_send_req(dev, PCAN_USBPRO_REQ_INFO, | 890 | err = pcan_usb_pro_send_req(dev, PCAN_USBPRO_REQ_INFO, |
879 | PCAN_USBPRO_INFO_FW, | 891 | PCAN_USBPRO_INFO_FW, |
880 | &fi, sizeof(fi)); | 892 | fi, sizeof(*fi)); |
881 | if (err) { | 893 | if (err) { |
882 | kfree(usb_if); | ||
883 | dev_err(dev->netdev->dev.parent, | 894 | dev_err(dev->netdev->dev.parent, |
884 | "unable to read %s firmware info (err %d)\n", | 895 | "unable to read %s firmware info (err %d)\n", |
885 | pcan_usb_pro.name, err); | 896 | pcan_usb_pro.name, err); |
886 | return err; | 897 | goto err_out; |
887 | } | 898 | } |
888 | 899 | ||
889 | err = pcan_usb_pro_send_req(dev, PCAN_USBPRO_REQ_INFO, | 900 | err = pcan_usb_pro_send_req(dev, PCAN_USBPRO_REQ_INFO, |
890 | PCAN_USBPRO_INFO_BL, | 901 | PCAN_USBPRO_INFO_BL, |
891 | &bi, sizeof(bi)); | 902 | bi, sizeof(*bi)); |
892 | if (err) { | 903 | if (err) { |
893 | kfree(usb_if); | ||
894 | dev_err(dev->netdev->dev.parent, | 904 | dev_err(dev->netdev->dev.parent, |
895 | "unable to read %s bootloader info (err %d)\n", | 905 | "unable to read %s bootloader info (err %d)\n", |
896 | pcan_usb_pro.name, err); | 906 | pcan_usb_pro.name, err); |
897 | return err; | 907 | goto err_out; |
898 | } | 908 | } |
899 | 909 | ||
910 | /* tell the device the can driver is running */ | ||
911 | err = pcan_usb_pro_drv_loaded(dev, 1); | ||
912 | if (err) | ||
913 | goto err_out; | ||
914 | |||
900 | dev_info(dev->netdev->dev.parent, | 915 | dev_info(dev->netdev->dev.parent, |
901 | "PEAK-System %s hwrev %u serial %08X.%08X (%u channels)\n", | 916 | "PEAK-System %s hwrev %u serial %08X.%08X (%u channels)\n", |
902 | pcan_usb_pro.name, | 917 | pcan_usb_pro.name, |
903 | bi.hw_rev, bi.serial_num_hi, bi.serial_num_lo, | 918 | bi->hw_rev, bi->serial_num_hi, bi->serial_num_lo, |
904 | pcan_usb_pro.ctrl_count); | 919 | pcan_usb_pro.ctrl_count); |
905 | |||
906 | /* tell the device the can driver is running */ | ||
907 | pcan_usb_pro_drv_loaded(dev, 1); | ||
908 | } else { | 920 | } else { |
909 | usb_if = pcan_usb_pro_dev_if(dev->prev_siblings); | 921 | usb_if = pcan_usb_pro_dev_if(dev->prev_siblings); |
910 | } | 922 | } |
@@ -916,6 +928,13 @@ static int pcan_usb_pro_init(struct peak_usb_device *dev) | |||
916 | pcan_usb_pro_set_led(dev, 0, 1); | 928 | pcan_usb_pro_set_led(dev, 0, 1); |
917 | 929 | ||
918 | return 0; | 930 | return 0; |
931 | |||
932 | err_out: | ||
933 | kfree(bi); | ||
934 | kfree(fi); | ||
935 | kfree(usb_if); | ||
936 | |||
937 | return err; | ||
919 | } | 938 | } |
920 | 939 | ||
921 | static void pcan_usb_pro_exit(struct peak_usb_device *dev) | 940 | static void pcan_usb_pro_exit(struct peak_usb_device *dev) |
diff --git a/drivers/net/can/usb/peak_usb/pcan_usb_pro.h b/drivers/net/can/usb/peak_usb/pcan_usb_pro.h index a869918c5620..32275af547e0 100644 --- a/drivers/net/can/usb/peak_usb/pcan_usb_pro.h +++ b/drivers/net/can/usb/peak_usb/pcan_usb_pro.h | |||
@@ -29,6 +29,7 @@ | |||
29 | 29 | ||
30 | /* Vendor Request value for XXX_FCT */ | 30 | /* Vendor Request value for XXX_FCT */ |
31 | #define PCAN_USBPRO_FCT_DRVLD 5 /* tell device driver is loaded */ | 31 | #define PCAN_USBPRO_FCT_DRVLD 5 /* tell device driver is loaded */ |
32 | #define PCAN_USBPRO_FCT_DRVLD_REQ_LEN 16 | ||
32 | 33 | ||
33 | /* PCAN_USBPRO_INFO_BL vendor request record type */ | 34 | /* PCAN_USBPRO_INFO_BL vendor request record type */ |
34 | struct __packed pcan_usb_pro_blinfo { | 35 | struct __packed pcan_usb_pro_blinfo { |
diff --git a/drivers/net/can/usb/usb_8dev.c b/drivers/net/can/usb/usb_8dev.c index 6e15ef08f301..cbd388eea682 100644 --- a/drivers/net/can/usb/usb_8dev.c +++ b/drivers/net/can/usb/usb_8dev.c | |||
@@ -977,7 +977,7 @@ static int usb_8dev_probe(struct usb_interface *intf, | |||
977 | err = usb_8dev_cmd_version(priv, &version); | 977 | err = usb_8dev_cmd_version(priv, &version); |
978 | if (err) { | 978 | if (err) { |
979 | netdev_err(netdev, "can't get firmware version\n"); | 979 | netdev_err(netdev, "can't get firmware version\n"); |
980 | goto cleanup_cmd_msg_buffer; | 980 | goto cleanup_unregister_candev; |
981 | } else { | 981 | } else { |
982 | netdev_info(netdev, | 982 | netdev_info(netdev, |
983 | "firmware: %d.%d, hardware: %d.%d\n", | 983 | "firmware: %d.%d, hardware: %d.%d\n", |
@@ -989,6 +989,9 @@ static int usb_8dev_probe(struct usb_interface *intf, | |||
989 | 989 | ||
990 | return 0; | 990 | return 0; |
991 | 991 | ||
992 | cleanup_unregister_candev: | ||
993 | unregister_netdev(priv->netdev); | ||
994 | |||
992 | cleanup_cmd_msg_buffer: | 995 | cleanup_cmd_msg_buffer: |
993 | kfree(priv->cmd_msg_buffer); | 996 | kfree(priv->cmd_msg_buffer); |
994 | 997 | ||
diff --git a/drivers/net/ethernet/atheros/Kconfig b/drivers/net/ethernet/atheros/Kconfig index 36d6abd1cfff..ad6aa1e98348 100644 --- a/drivers/net/ethernet/atheros/Kconfig +++ b/drivers/net/ethernet/atheros/Kconfig | |||
@@ -67,4 +67,22 @@ config ATL1C | |||
67 | To compile this driver as a module, choose M here. The module | 67 | To compile this driver as a module, choose M here. The module |
68 | will be called atl1c. | 68 | will be called atl1c. |
69 | 69 | ||
70 | config ALX | ||
71 | tristate "Qualcomm Atheros AR816x/AR817x support" | ||
72 | depends on PCI | ||
73 | select CRC32 | ||
74 | select NET_CORE | ||
75 | select MDIO | ||
76 | help | ||
77 | This driver supports the Qualcomm Atheros L1F ethernet adapter, | ||
78 | i.e. the following chipsets: | ||
79 | |||
80 | 1969:1091 - AR8161 Gigabit Ethernet | ||
81 | 1969:1090 - AR8162 Fast Ethernet | ||
82 | 1969:10A1 - AR8171 Gigabit Ethernet | ||
83 | 1969:10A0 - AR8172 Fast Ethernet | ||
84 | |||
85 | To compile this driver as a module, choose M here. The module | ||
86 | will be called alx. | ||
87 | |||
70 | endif # NET_VENDOR_ATHEROS | 88 | endif # NET_VENDOR_ATHEROS |
diff --git a/drivers/net/ethernet/atheros/Makefile b/drivers/net/ethernet/atheros/Makefile index e7e76fb576ff..5cf1c65bbce9 100644 --- a/drivers/net/ethernet/atheros/Makefile +++ b/drivers/net/ethernet/atheros/Makefile | |||
@@ -6,3 +6,4 @@ obj-$(CONFIG_ATL1) += atlx/ | |||
6 | obj-$(CONFIG_ATL2) += atlx/ | 6 | obj-$(CONFIG_ATL2) += atlx/ |
7 | obj-$(CONFIG_ATL1E) += atl1e/ | 7 | obj-$(CONFIG_ATL1E) += atl1e/ |
8 | obj-$(CONFIG_ATL1C) += atl1c/ | 8 | obj-$(CONFIG_ATL1C) += atl1c/ |
9 | obj-$(CONFIG_ALX) += alx/ | ||
diff --git a/drivers/net/ethernet/atheros/alx/Makefile b/drivers/net/ethernet/atheros/alx/Makefile new file mode 100644 index 000000000000..5901fa407d52 --- /dev/null +++ b/drivers/net/ethernet/atheros/alx/Makefile | |||
@@ -0,0 +1,3 @@ | |||
1 | obj-$(CONFIG_ALX) += alx.o | ||
2 | alx-objs := main.o ethtool.o hw.o | ||
3 | ccflags-y += -D__CHECK_ENDIAN__ | ||
diff --git a/drivers/net/ethernet/atheros/alx/alx.h b/drivers/net/ethernet/atheros/alx/alx.h new file mode 100644 index 000000000000..50b3ae2b143d --- /dev/null +++ b/drivers/net/ethernet/atheros/alx/alx.h | |||
@@ -0,0 +1,114 @@ | |||
1 | /* | ||
2 | * Copyright (c) 2013 Johannes Berg <johannes@sipsolutions.net> | ||
3 | * | ||
4 | * This file is free software: you may copy, redistribute and/or modify it | ||
5 | * under the terms of the GNU General Public License as published by the | ||
6 | * Free Software Foundation, either version 2 of the License, or (at your | ||
7 | * option) any later version. | ||
8 | * | ||
9 | * This file is distributed in the hope that it will be useful, but | ||
10 | * WITHOUT ANY WARRANTY; without even the implied warranty of | ||
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
12 | * General Public License for more details. | ||
13 | * | ||
14 | * You should have received a copy of the GNU General Public License | ||
15 | * along with this program. If not, see <http://www.gnu.org/licenses/>. | ||
16 | * | ||
17 | * This file incorporates work covered by the following copyright and | ||
18 | * permission notice: | ||
19 | * | ||
20 | * Copyright (c) 2012 Qualcomm Atheros, Inc. | ||
21 | * | ||
22 | * Permission to use, copy, modify, and/or distribute this software for any | ||
23 | * purpose with or without fee is hereby granted, provided that the above | ||
24 | * copyright notice and this permission notice appear in all copies. | ||
25 | * | ||
26 | * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES | ||
27 | * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF | ||
28 | * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR | ||
29 | * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES | ||
30 | * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN | ||
31 | * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF | ||
32 | * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. | ||
33 | */ | ||
34 | |||
35 | #ifndef _ALX_H_ | ||
36 | #define _ALX_H_ | ||
37 | |||
38 | #include <linux/types.h> | ||
39 | #include <linux/etherdevice.h> | ||
40 | #include <linux/dma-mapping.h> | ||
41 | #include <linux/spinlock.h> | ||
42 | #include "hw.h" | ||
43 | |||
44 | #define ALX_WATCHDOG_TIME (5 * HZ) | ||
45 | |||
46 | struct alx_buffer { | ||
47 | struct sk_buff *skb; | ||
48 | DEFINE_DMA_UNMAP_ADDR(dma); | ||
49 | DEFINE_DMA_UNMAP_LEN(size); | ||
50 | }; | ||
51 | |||
52 | struct alx_rx_queue { | ||
53 | struct alx_rrd *rrd; | ||
54 | dma_addr_t rrd_dma; | ||
55 | |||
56 | struct alx_rfd *rfd; | ||
57 | dma_addr_t rfd_dma; | ||
58 | |||
59 | struct alx_buffer *bufs; | ||
60 | |||
61 | u16 write_idx, read_idx; | ||
62 | u16 rrd_read_idx; | ||
63 | }; | ||
64 | #define ALX_RX_ALLOC_THRESH 32 | ||
65 | |||
66 | struct alx_tx_queue { | ||
67 | struct alx_txd *tpd; | ||
68 | dma_addr_t tpd_dma; | ||
69 | struct alx_buffer *bufs; | ||
70 | u16 write_idx, read_idx; | ||
71 | }; | ||
72 | |||
73 | #define ALX_DEFAULT_TX_WORK 128 | ||
74 | |||
75 | enum alx_device_quirks { | ||
76 | ALX_DEV_QUIRK_MSI_INTX_DISABLE_BUG = BIT(0), | ||
77 | }; | ||
78 | |||
79 | struct alx_priv { | ||
80 | struct net_device *dev; | ||
81 | |||
82 | struct alx_hw hw; | ||
83 | |||
84 | /* all descriptor memory */ | ||
85 | struct { | ||
86 | dma_addr_t dma; | ||
87 | void *virt; | ||
88 | int size; | ||
89 | } descmem; | ||
90 | |||
91 | /* protect int_mask updates */ | ||
92 | spinlock_t irq_lock; | ||
93 | u32 int_mask; | ||
94 | |||
95 | int tx_ringsz; | ||
96 | int rx_ringsz; | ||
97 | int rxbuf_size; | ||
98 | |||
99 | struct napi_struct napi; | ||
100 | struct alx_tx_queue txq; | ||
101 | struct alx_rx_queue rxq; | ||
102 | |||
103 | struct work_struct link_check_wk; | ||
104 | struct work_struct reset_wk; | ||
105 | |||
106 | u16 msg_enable; | ||
107 | |||
108 | bool msi; | ||
109 | }; | ||
110 | |||
111 | extern const struct ethtool_ops alx_ethtool_ops; | ||
112 | extern const char alx_drv_name[]; | ||
113 | |||
114 | #endif | ||
diff --git a/drivers/net/ethernet/atheros/alx/ethtool.c b/drivers/net/ethernet/atheros/alx/ethtool.c new file mode 100644 index 000000000000..6fa2aec2bc81 --- /dev/null +++ b/drivers/net/ethernet/atheros/alx/ethtool.c | |||
@@ -0,0 +1,272 @@ | |||
1 | /* | ||
2 | * Copyright (c) 2013 Johannes Berg <johannes@sipsolutions.net> | ||
3 | * | ||
4 | * This file is free software: you may copy, redistribute and/or modify it | ||
5 | * under the terms of the GNU General Public License as published by the | ||
6 | * Free Software Foundation, either version 2 of the License, or (at your | ||
7 | * option) any later version. | ||
8 | * | ||
9 | * This file is distributed in the hope that it will be useful, but | ||
10 | * WITHOUT ANY WARRANTY; without even the implied warranty of | ||
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
12 | * General Public License for more details. | ||
13 | * | ||
14 | * You should have received a copy of the GNU General Public License | ||
15 | * along with this program. If not, see <http://www.gnu.org/licenses/>. | ||
16 | * | ||
17 | * This file incorporates work covered by the following copyright and | ||
18 | * permission notice: | ||
19 | * | ||
20 | * Copyright (c) 2012 Qualcomm Atheros, Inc. | ||
21 | * | ||
22 | * Permission to use, copy, modify, and/or distribute this software for any | ||
23 | * purpose with or without fee is hereby granted, provided that the above | ||
24 | * copyright notice and this permission notice appear in all copies. | ||
25 | * | ||
26 | * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES | ||
27 | * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF | ||
28 | * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR | ||
29 | * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES | ||
30 | * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN | ||
31 | * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF | ||
32 | * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. | ||
33 | */ | ||
34 | |||
35 | #include <linux/pci.h> | ||
36 | #include <linux/ip.h> | ||
37 | #include <linux/tcp.h> | ||
38 | #include <linux/netdevice.h> | ||
39 | #include <linux/etherdevice.h> | ||
40 | #include <linux/ethtool.h> | ||
41 | #include <linux/mdio.h> | ||
42 | #include <linux/interrupt.h> | ||
43 | #include <asm/byteorder.h> | ||
44 | |||
45 | #include "alx.h" | ||
46 | #include "reg.h" | ||
47 | #include "hw.h" | ||
48 | |||
49 | |||
50 | static int alx_get_settings(struct net_device *netdev, struct ethtool_cmd *ecmd) | ||
51 | { | ||
52 | struct alx_priv *alx = netdev_priv(netdev); | ||
53 | struct alx_hw *hw = &alx->hw; | ||
54 | |||
55 | ecmd->supported = SUPPORTED_10baseT_Half | | ||
56 | SUPPORTED_10baseT_Full | | ||
57 | SUPPORTED_100baseT_Half | | ||
58 | SUPPORTED_100baseT_Full | | ||
59 | SUPPORTED_Autoneg | | ||
60 | SUPPORTED_TP | | ||
61 | SUPPORTED_Pause; | ||
62 | if (alx_hw_giga(hw)) | ||
63 | ecmd->supported |= SUPPORTED_1000baseT_Full; | ||
64 | |||
65 | ecmd->advertising = ADVERTISED_TP; | ||
66 | if (hw->adv_cfg & ADVERTISED_Autoneg) | ||
67 | ecmd->advertising |= hw->adv_cfg; | ||
68 | |||
69 | ecmd->port = PORT_TP; | ||
70 | ecmd->phy_address = 0; | ||
71 | if (hw->adv_cfg & ADVERTISED_Autoneg) | ||
72 | ecmd->autoneg = AUTONEG_ENABLE; | ||
73 | else | ||
74 | ecmd->autoneg = AUTONEG_DISABLE; | ||
75 | ecmd->transceiver = XCVR_INTERNAL; | ||
76 | |||
77 | if (hw->flowctrl & ALX_FC_ANEG && hw->adv_cfg & ADVERTISED_Autoneg) { | ||
78 | if (hw->flowctrl & ALX_FC_RX) { | ||
79 | ecmd->advertising |= ADVERTISED_Pause; | ||
80 | |||
81 | if (!(hw->flowctrl & ALX_FC_TX)) | ||
82 | ecmd->advertising |= ADVERTISED_Asym_Pause; | ||
83 | } else if (hw->flowctrl & ALX_FC_TX) { | ||
84 | ecmd->advertising |= ADVERTISED_Asym_Pause; | ||
85 | } | ||
86 | } | ||
87 | |||
88 | if (hw->link_speed != SPEED_UNKNOWN) { | ||
89 | ethtool_cmd_speed_set(ecmd, | ||
90 | hw->link_speed - hw->link_speed % 10); | ||
91 | ecmd->duplex = hw->link_speed % 10; | ||
92 | } else { | ||
93 | ethtool_cmd_speed_set(ecmd, SPEED_UNKNOWN); | ||
94 | ecmd->duplex = DUPLEX_UNKNOWN; | ||
95 | } | ||
96 | |||
97 | return 0; | ||
98 | } | ||
99 | |||
100 | static int alx_set_settings(struct net_device *netdev, struct ethtool_cmd *ecmd) | ||
101 | { | ||
102 | struct alx_priv *alx = netdev_priv(netdev); | ||
103 | struct alx_hw *hw = &alx->hw; | ||
104 | u32 adv_cfg; | ||
105 | |||
106 | ASSERT_RTNL(); | ||
107 | |||
108 | if (ecmd->autoneg == AUTONEG_ENABLE) { | ||
109 | if (ecmd->advertising & ADVERTISED_1000baseT_Half) | ||
110 | return -EINVAL; | ||
111 | adv_cfg = ecmd->advertising | ADVERTISED_Autoneg; | ||
112 | } else { | ||
113 | int speed = ethtool_cmd_speed(ecmd); | ||
114 | |||
115 | switch (speed + ecmd->duplex) { | ||
116 | case SPEED_10 + DUPLEX_HALF: | ||
117 | adv_cfg = ADVERTISED_10baseT_Half; | ||
118 | break; | ||
119 | case SPEED_10 + DUPLEX_FULL: | ||
120 | adv_cfg = ADVERTISED_10baseT_Full; | ||
121 | break; | ||
122 | case SPEED_100 + DUPLEX_HALF: | ||
123 | adv_cfg = ADVERTISED_100baseT_Half; | ||
124 | break; | ||
125 | case SPEED_100 + DUPLEX_FULL: | ||
126 | adv_cfg = ADVERTISED_100baseT_Full; | ||
127 | break; | ||
128 | default: | ||
129 | return -EINVAL; | ||
130 | } | ||
131 | } | ||
132 | |||
133 | hw->adv_cfg = adv_cfg; | ||
134 | return alx_setup_speed_duplex(hw, adv_cfg, hw->flowctrl); | ||
135 | } | ||
136 | |||
137 | static void alx_get_pauseparam(struct net_device *netdev, | ||
138 | struct ethtool_pauseparam *pause) | ||
139 | { | ||
140 | struct alx_priv *alx = netdev_priv(netdev); | ||
141 | struct alx_hw *hw = &alx->hw; | ||
142 | |||
143 | if (hw->flowctrl & ALX_FC_ANEG && | ||
144 | hw->adv_cfg & ADVERTISED_Autoneg) | ||
145 | pause->autoneg = AUTONEG_ENABLE; | ||
146 | else | ||
147 | pause->autoneg = AUTONEG_DISABLE; | ||
148 | |||
149 | if (hw->flowctrl & ALX_FC_TX) | ||
150 | pause->tx_pause = 1; | ||
151 | else | ||
152 | pause->tx_pause = 0; | ||
153 | |||
154 | if (hw->flowctrl & ALX_FC_RX) | ||
155 | pause->rx_pause = 1; | ||
156 | else | ||
157 | pause->rx_pause = 0; | ||
158 | } | ||
159 | |||
160 | |||
161 | static int alx_set_pauseparam(struct net_device *netdev, | ||
162 | struct ethtool_pauseparam *pause) | ||
163 | { | ||
164 | struct alx_priv *alx = netdev_priv(netdev); | ||
165 | struct alx_hw *hw = &alx->hw; | ||
166 | int err = 0; | ||
167 | bool reconfig_phy = false; | ||
168 | u8 fc = 0; | ||
169 | |||
170 | if (pause->tx_pause) | ||
171 | fc |= ALX_FC_TX; | ||
172 | if (pause->rx_pause) | ||
173 | fc |= ALX_FC_RX; | ||
174 | if (pause->autoneg) | ||
175 | fc |= ALX_FC_ANEG; | ||
176 | |||
177 | ASSERT_RTNL(); | ||
178 | |||
179 | /* restart auto-neg for auto-mode */ | ||
180 | if (hw->adv_cfg & ADVERTISED_Autoneg) { | ||
181 | if (!((fc ^ hw->flowctrl) & ALX_FC_ANEG)) | ||
182 | reconfig_phy = true; | ||
183 | if (fc & hw->flowctrl & ALX_FC_ANEG && | ||
184 | (fc ^ hw->flowctrl) & (ALX_FC_RX | ALX_FC_TX)) | ||
185 | reconfig_phy = true; | ||
186 | } | ||
187 | |||
188 | if (reconfig_phy) { | ||
189 | err = alx_setup_speed_duplex(hw, hw->adv_cfg, fc); | ||
190 | return err; | ||
191 | } | ||
192 | |||
193 | /* flow control on mac */ | ||
194 | if ((fc ^ hw->flowctrl) & (ALX_FC_RX | ALX_FC_TX)) | ||
195 | alx_cfg_mac_flowcontrol(hw, fc); | ||
196 | |||
197 | hw->flowctrl = fc; | ||
198 | |||
199 | return 0; | ||
200 | } | ||
201 | |||
202 | static u32 alx_get_msglevel(struct net_device *netdev) | ||
203 | { | ||
204 | struct alx_priv *alx = netdev_priv(netdev); | ||
205 | |||
206 | return alx->msg_enable; | ||
207 | } | ||
208 | |||
209 | static void alx_set_msglevel(struct net_device *netdev, u32 data) | ||
210 | { | ||
211 | struct alx_priv *alx = netdev_priv(netdev); | ||
212 | |||
213 | alx->msg_enable = data; | ||
214 | } | ||
215 | |||
216 | static void alx_get_wol(struct net_device *netdev, struct ethtool_wolinfo *wol) | ||
217 | { | ||
218 | struct alx_priv *alx = netdev_priv(netdev); | ||
219 | struct alx_hw *hw = &alx->hw; | ||
220 | |||
221 | wol->supported = WAKE_MAGIC | WAKE_PHY; | ||
222 | wol->wolopts = 0; | ||
223 | |||
224 | if (hw->sleep_ctrl & ALX_SLEEP_WOL_MAGIC) | ||
225 | wol->wolopts |= WAKE_MAGIC; | ||
226 | if (hw->sleep_ctrl & ALX_SLEEP_WOL_PHY) | ||
227 | wol->wolopts |= WAKE_PHY; | ||
228 | } | ||
229 | |||
230 | static int alx_set_wol(struct net_device *netdev, struct ethtool_wolinfo *wol) | ||
231 | { | ||
232 | struct alx_priv *alx = netdev_priv(netdev); | ||
233 | struct alx_hw *hw = &alx->hw; | ||
234 | |||
235 | if (wol->wolopts & (WAKE_ARP | WAKE_MAGICSECURE | | ||
236 | WAKE_UCAST | WAKE_BCAST | WAKE_MCAST)) | ||
237 | return -EOPNOTSUPP; | ||
238 | |||
239 | hw->sleep_ctrl = 0; | ||
240 | |||
241 | if (wol->wolopts & WAKE_MAGIC) | ||
242 | hw->sleep_ctrl |= ALX_SLEEP_WOL_MAGIC; | ||
243 | if (wol->wolopts & WAKE_PHY) | ||
244 | hw->sleep_ctrl |= ALX_SLEEP_WOL_PHY; | ||
245 | |||
246 | device_set_wakeup_enable(&alx->hw.pdev->dev, hw->sleep_ctrl); | ||
247 | |||
248 | return 0; | ||
249 | } | ||
250 | |||
251 | static void alx_get_drvinfo(struct net_device *netdev, | ||
252 | struct ethtool_drvinfo *drvinfo) | ||
253 | { | ||
254 | struct alx_priv *alx = netdev_priv(netdev); | ||
255 | |||
256 | strlcpy(drvinfo->driver, alx_drv_name, sizeof(drvinfo->driver)); | ||
257 | strlcpy(drvinfo->bus_info, pci_name(alx->hw.pdev), | ||
258 | sizeof(drvinfo->bus_info)); | ||
259 | } | ||
260 | |||
261 | const struct ethtool_ops alx_ethtool_ops = { | ||
262 | .get_settings = alx_get_settings, | ||
263 | .set_settings = alx_set_settings, | ||
264 | .get_pauseparam = alx_get_pauseparam, | ||
265 | .set_pauseparam = alx_set_pauseparam, | ||
266 | .get_drvinfo = alx_get_drvinfo, | ||
267 | .get_msglevel = alx_get_msglevel, | ||
268 | .set_msglevel = alx_set_msglevel, | ||
269 | .get_wol = alx_get_wol, | ||
270 | .set_wol = alx_set_wol, | ||
271 | .get_link = ethtool_op_get_link, | ||
272 | }; | ||
diff --git a/drivers/net/ethernet/atheros/alx/hw.c b/drivers/net/ethernet/atheros/alx/hw.c new file mode 100644 index 000000000000..220a16ad0e49 --- /dev/null +++ b/drivers/net/ethernet/atheros/alx/hw.c | |||
@@ -0,0 +1,1226 @@ | |||
1 | /* | ||
2 | * Copyright (c) 2013 Johannes Berg <johannes@sipsolutions.net> | ||
3 | * | ||
4 | * This file is free software: you may copy, redistribute and/or modify it | ||
5 | * under the terms of the GNU General Public License as published by the | ||
6 | * Free Software Foundation, either version 2 of the License, or (at your | ||
7 | * option) any later version. | ||
8 | * | ||
9 | * This file is distributed in the hope that it will be useful, but | ||
10 | * WITHOUT ANY WARRANTY; without even the implied warranty of | ||
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
12 | * General Public License for more details. | ||
13 | * | ||
14 | * You should have received a copy of the GNU General Public License | ||
15 | * along with this program. If not, see <http://www.gnu.org/licenses/>. | ||
16 | * | ||
17 | * This file incorporates work covered by the following copyright and | ||
18 | * permission notice: | ||
19 | * | ||
20 | * Copyright (c) 2012 Qualcomm Atheros, Inc. | ||
21 | * | ||
22 | * Permission to use, copy, modify, and/or distribute this software for any | ||
23 | * purpose with or without fee is hereby granted, provided that the above | ||
24 | * copyright notice and this permission notice appear in all copies. | ||
25 | * | ||
26 | * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES | ||
27 | * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF | ||
28 | * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR | ||
29 | * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES | ||
30 | * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN | ||
31 | * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF | ||
32 | * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. | ||
33 | */ | ||
34 | #include <linux/etherdevice.h> | ||
35 | #include <linux/delay.h> | ||
36 | #include <linux/pci.h> | ||
37 | #include <linux/mdio.h> | ||
38 | #include "reg.h" | ||
39 | #include "hw.h" | ||
40 | |||
41 | static inline bool alx_is_rev_a(u8 rev) | ||
42 | { | ||
43 | return rev == ALX_REV_A0 || rev == ALX_REV_A1; | ||
44 | } | ||
45 | |||
46 | static int alx_wait_mdio_idle(struct alx_hw *hw) | ||
47 | { | ||
48 | u32 val; | ||
49 | int i; | ||
50 | |||
51 | for (i = 0; i < ALX_MDIO_MAX_AC_TO; i++) { | ||
52 | val = alx_read_mem32(hw, ALX_MDIO); | ||
53 | if (!(val & ALX_MDIO_BUSY)) | ||
54 | return 0; | ||
55 | udelay(10); | ||
56 | } | ||
57 | |||
58 | return -ETIMEDOUT; | ||
59 | } | ||
60 | |||
61 | static int alx_read_phy_core(struct alx_hw *hw, bool ext, u8 dev, | ||
62 | u16 reg, u16 *phy_data) | ||
63 | { | ||
64 | u32 val, clk_sel; | ||
65 | int err; | ||
66 | |||
67 | *phy_data = 0; | ||
68 | |||
69 | /* use slow clock when it's in hibernation status */ | ||
70 | clk_sel = hw->link_speed != SPEED_UNKNOWN ? | ||
71 | ALX_MDIO_CLK_SEL_25MD4 : | ||
72 | ALX_MDIO_CLK_SEL_25MD128; | ||
73 | |||
74 | if (ext) { | ||
75 | val = dev << ALX_MDIO_EXTN_DEVAD_SHIFT | | ||
76 | reg << ALX_MDIO_EXTN_REG_SHIFT; | ||
77 | alx_write_mem32(hw, ALX_MDIO_EXTN, val); | ||
78 | |||
79 | val = ALX_MDIO_SPRES_PRMBL | ALX_MDIO_START | | ||
80 | ALX_MDIO_MODE_EXT | ALX_MDIO_OP_READ | | ||
81 | clk_sel << ALX_MDIO_CLK_SEL_SHIFT; | ||
82 | } else { | ||
83 | val = ALX_MDIO_SPRES_PRMBL | | ||
84 | clk_sel << ALX_MDIO_CLK_SEL_SHIFT | | ||
85 | reg << ALX_MDIO_REG_SHIFT | | ||
86 | ALX_MDIO_START | ALX_MDIO_OP_READ; | ||
87 | } | ||
88 | alx_write_mem32(hw, ALX_MDIO, val); | ||
89 | |||
90 | err = alx_wait_mdio_idle(hw); | ||
91 | if (err) | ||
92 | return err; | ||
93 | val = alx_read_mem32(hw, ALX_MDIO); | ||
94 | *phy_data = ALX_GET_FIELD(val, ALX_MDIO_DATA); | ||
95 | return 0; | ||
96 | } | ||
97 | |||
98 | static int alx_write_phy_core(struct alx_hw *hw, bool ext, u8 dev, | ||
99 | u16 reg, u16 phy_data) | ||
100 | { | ||
101 | u32 val, clk_sel; | ||
102 | |||
103 | /* use slow clock when it's in hibernation status */ | ||
104 | clk_sel = hw->link_speed != SPEED_UNKNOWN ? | ||
105 | ALX_MDIO_CLK_SEL_25MD4 : | ||
106 | ALX_MDIO_CLK_SEL_25MD128; | ||
107 | |||
108 | if (ext) { | ||
109 | val = dev << ALX_MDIO_EXTN_DEVAD_SHIFT | | ||
110 | reg << ALX_MDIO_EXTN_REG_SHIFT; | ||
111 | alx_write_mem32(hw, ALX_MDIO_EXTN, val); | ||
112 | |||
113 | val = ALX_MDIO_SPRES_PRMBL | | ||
114 | clk_sel << ALX_MDIO_CLK_SEL_SHIFT | | ||
115 | phy_data << ALX_MDIO_DATA_SHIFT | | ||
116 | ALX_MDIO_START | ALX_MDIO_MODE_EXT; | ||
117 | } else { | ||
118 | val = ALX_MDIO_SPRES_PRMBL | | ||
119 | clk_sel << ALX_MDIO_CLK_SEL_SHIFT | | ||
120 | reg << ALX_MDIO_REG_SHIFT | | ||
121 | phy_data << ALX_MDIO_DATA_SHIFT | | ||
122 | ALX_MDIO_START; | ||
123 | } | ||
124 | alx_write_mem32(hw, ALX_MDIO, val); | ||
125 | |||
126 | return alx_wait_mdio_idle(hw); | ||
127 | } | ||
128 | |||
129 | static int __alx_read_phy_reg(struct alx_hw *hw, u16 reg, u16 *phy_data) | ||
130 | { | ||
131 | return alx_read_phy_core(hw, false, 0, reg, phy_data); | ||
132 | } | ||
133 | |||
134 | static int __alx_write_phy_reg(struct alx_hw *hw, u16 reg, u16 phy_data) | ||
135 | { | ||
136 | return alx_write_phy_core(hw, false, 0, reg, phy_data); | ||
137 | } | ||
138 | |||
139 | static int __alx_read_phy_ext(struct alx_hw *hw, u8 dev, u16 reg, u16 *pdata) | ||
140 | { | ||
141 | return alx_read_phy_core(hw, true, dev, reg, pdata); | ||
142 | } | ||
143 | |||
144 | static int __alx_write_phy_ext(struct alx_hw *hw, u8 dev, u16 reg, u16 data) | ||
145 | { | ||
146 | return alx_write_phy_core(hw, true, dev, reg, data); | ||
147 | } | ||
148 | |||
149 | static int __alx_read_phy_dbg(struct alx_hw *hw, u16 reg, u16 *pdata) | ||
150 | { | ||
151 | int err; | ||
152 | |||
153 | err = __alx_write_phy_reg(hw, ALX_MII_DBG_ADDR, reg); | ||
154 | if (err) | ||
155 | return err; | ||
156 | |||
157 | return __alx_read_phy_reg(hw, ALX_MII_DBG_DATA, pdata); | ||
158 | } | ||
159 | |||
160 | static int __alx_write_phy_dbg(struct alx_hw *hw, u16 reg, u16 data) | ||
161 | { | ||
162 | int err; | ||
163 | |||
164 | err = __alx_write_phy_reg(hw, ALX_MII_DBG_ADDR, reg); | ||
165 | if (err) | ||
166 | return err; | ||
167 | |||
168 | return __alx_write_phy_reg(hw, ALX_MII_DBG_DATA, data); | ||
169 | } | ||
170 | |||
171 | int alx_read_phy_reg(struct alx_hw *hw, u16 reg, u16 *phy_data) | ||
172 | { | ||
173 | int err; | ||
174 | |||
175 | spin_lock(&hw->mdio_lock); | ||
176 | err = __alx_read_phy_reg(hw, reg, phy_data); | ||
177 | spin_unlock(&hw->mdio_lock); | ||
178 | |||
179 | return err; | ||
180 | } | ||
181 | |||
182 | int alx_write_phy_reg(struct alx_hw *hw, u16 reg, u16 phy_data) | ||
183 | { | ||
184 | int err; | ||
185 | |||
186 | spin_lock(&hw->mdio_lock); | ||
187 | err = __alx_write_phy_reg(hw, reg, phy_data); | ||
188 | spin_unlock(&hw->mdio_lock); | ||
189 | |||
190 | return err; | ||
191 | } | ||
192 | |||
193 | int alx_read_phy_ext(struct alx_hw *hw, u8 dev, u16 reg, u16 *pdata) | ||
194 | { | ||
195 | int err; | ||
196 | |||
197 | spin_lock(&hw->mdio_lock); | ||
198 | err = __alx_read_phy_ext(hw, dev, reg, pdata); | ||
199 | spin_unlock(&hw->mdio_lock); | ||
200 | |||
201 | return err; | ||
202 | } | ||
203 | |||
204 | int alx_write_phy_ext(struct alx_hw *hw, u8 dev, u16 reg, u16 data) | ||
205 | { | ||
206 | int err; | ||
207 | |||
208 | spin_lock(&hw->mdio_lock); | ||
209 | err = __alx_write_phy_ext(hw, dev, reg, data); | ||
210 | spin_unlock(&hw->mdio_lock); | ||
211 | |||
212 | return err; | ||
213 | } | ||
214 | |||
215 | static int alx_read_phy_dbg(struct alx_hw *hw, u16 reg, u16 *pdata) | ||
216 | { | ||
217 | int err; | ||
218 | |||
219 | spin_lock(&hw->mdio_lock); | ||
220 | err = __alx_read_phy_dbg(hw, reg, pdata); | ||
221 | spin_unlock(&hw->mdio_lock); | ||
222 | |||
223 | return err; | ||
224 | } | ||
225 | |||
226 | static int alx_write_phy_dbg(struct alx_hw *hw, u16 reg, u16 data) | ||
227 | { | ||
228 | int err; | ||
229 | |||
230 | spin_lock(&hw->mdio_lock); | ||
231 | err = __alx_write_phy_dbg(hw, reg, data); | ||
232 | spin_unlock(&hw->mdio_lock); | ||
233 | |||
234 | return err; | ||
235 | } | ||
236 | |||
237 | static u16 alx_get_phy_config(struct alx_hw *hw) | ||
238 | { | ||
239 | u32 val; | ||
240 | u16 phy_val; | ||
241 | |||
242 | val = alx_read_mem32(hw, ALX_PHY_CTRL); | ||
243 | /* phy in reset */ | ||
244 | if ((val & ALX_PHY_CTRL_DSPRST_OUT) == 0) | ||
245 | return ALX_DRV_PHY_UNKNOWN; | ||
246 | |||
247 | val = alx_read_mem32(hw, ALX_DRV); | ||
248 | val = ALX_GET_FIELD(val, ALX_DRV_PHY); | ||
249 | if (ALX_DRV_PHY_UNKNOWN == val) | ||
250 | return ALX_DRV_PHY_UNKNOWN; | ||
251 | |||
252 | alx_read_phy_reg(hw, ALX_MII_DBG_ADDR, &phy_val); | ||
253 | if (ALX_PHY_INITED == phy_val) | ||
254 | return val; | ||
255 | |||
256 | return ALX_DRV_PHY_UNKNOWN; | ||
257 | } | ||
258 | |||
259 | static bool alx_wait_reg(struct alx_hw *hw, u32 reg, u32 wait, u32 *val) | ||
260 | { | ||
261 | u32 read; | ||
262 | int i; | ||
263 | |||
264 | for (i = 0; i < ALX_SLD_MAX_TO; i++) { | ||
265 | read = alx_read_mem32(hw, reg); | ||
266 | if ((read & wait) == 0) { | ||
267 | if (val) | ||
268 | *val = read; | ||
269 | return true; | ||
270 | } | ||
271 | mdelay(1); | ||
272 | } | ||
273 | |||
274 | return false; | ||
275 | } | ||
276 | |||
277 | static bool alx_read_macaddr(struct alx_hw *hw, u8 *addr) | ||
278 | { | ||
279 | u32 mac0, mac1; | ||
280 | |||
281 | mac0 = alx_read_mem32(hw, ALX_STAD0); | ||
282 | mac1 = alx_read_mem32(hw, ALX_STAD1); | ||
283 | |||
284 | /* addr should be big-endian */ | ||
285 | *(__be32 *)(addr + 2) = cpu_to_be32(mac0); | ||
286 | *(__be16 *)addr = cpu_to_be16(mac1); | ||
287 | |||
288 | return is_valid_ether_addr(addr); | ||
289 | } | ||
290 | |||
291 | int alx_get_perm_macaddr(struct alx_hw *hw, u8 *addr) | ||
292 | { | ||
293 | u32 val; | ||
294 | |||
295 | /* try to get it from register first */ | ||
296 | if (alx_read_macaddr(hw, addr)) | ||
297 | return 0; | ||
298 | |||
299 | /* try to load from efuse */ | ||
300 | if (!alx_wait_reg(hw, ALX_SLD, ALX_SLD_STAT | ALX_SLD_START, &val)) | ||
301 | return -EIO; | ||
302 | alx_write_mem32(hw, ALX_SLD, val | ALX_SLD_START); | ||
303 | if (!alx_wait_reg(hw, ALX_SLD, ALX_SLD_START, NULL)) | ||
304 | return -EIO; | ||
305 | if (alx_read_macaddr(hw, addr)) | ||
306 | return 0; | ||
307 | |||
308 | /* try to load from flash/eeprom (if present) */ | ||
309 | val = alx_read_mem32(hw, ALX_EFLD); | ||
310 | if (val & (ALX_EFLD_F_EXIST | ALX_EFLD_E_EXIST)) { | ||
311 | if (!alx_wait_reg(hw, ALX_EFLD, | ||
312 | ALX_EFLD_STAT | ALX_EFLD_START, &val)) | ||
313 | return -EIO; | ||
314 | alx_write_mem32(hw, ALX_EFLD, val | ALX_EFLD_START); | ||
315 | if (!alx_wait_reg(hw, ALX_EFLD, ALX_EFLD_START, NULL)) | ||
316 | return -EIO; | ||
317 | if (alx_read_macaddr(hw, addr)) | ||
318 | return 0; | ||
319 | } | ||
320 | |||
321 | return -EIO; | ||
322 | } | ||
323 | |||
324 | void alx_set_macaddr(struct alx_hw *hw, const u8 *addr) | ||
325 | { | ||
326 | u32 val; | ||
327 | |||
328 | /* for example: 00-0B-6A-F6-00-DC * STAD0=6AF600DC, STAD1=000B */ | ||
329 | val = be32_to_cpu(*(__be32 *)(addr + 2)); | ||
330 | alx_write_mem32(hw, ALX_STAD0, val); | ||
331 | val = be16_to_cpu(*(__be16 *)addr); | ||
332 | alx_write_mem32(hw, ALX_STAD1, val); | ||
333 | } | ||
334 | |||
335 | static void alx_enable_osc(struct alx_hw *hw) | ||
336 | { | ||
337 | u32 val; | ||
338 | |||
339 | /* rising edge */ | ||
340 | val = alx_read_mem32(hw, ALX_MISC); | ||
341 | alx_write_mem32(hw, ALX_MISC, val & ~ALX_MISC_INTNLOSC_OPEN); | ||
342 | alx_write_mem32(hw, ALX_MISC, val | ALX_MISC_INTNLOSC_OPEN); | ||
343 | } | ||
344 | |||
345 | static void alx_reset_osc(struct alx_hw *hw, u8 rev) | ||
346 | { | ||
347 | u32 val, val2; | ||
348 | |||
349 | /* clear Internal OSC settings, switching OSC by hw itself */ | ||
350 | val = alx_read_mem32(hw, ALX_MISC3); | ||
351 | alx_write_mem32(hw, ALX_MISC3, | ||
352 | (val & ~ALX_MISC3_25M_BY_SW) | | ||
353 | ALX_MISC3_25M_NOTO_INTNL); | ||
354 | |||
355 | /* 25M clk from chipset may be unstable 1s after de-assert of | ||
356 | * PERST, driver need re-calibrate before enter Sleep for WoL | ||
357 | */ | ||
358 | val = alx_read_mem32(hw, ALX_MISC); | ||
359 | if (rev >= ALX_REV_B0) { | ||
360 | /* restore over current protection def-val, | ||
361 | * this val could be reset by MAC-RST | ||
362 | */ | ||
363 | ALX_SET_FIELD(val, ALX_MISC_PSW_OCP, ALX_MISC_PSW_OCP_DEF); | ||
364 | /* a 0->1 change will update the internal val of osc */ | ||
365 | val &= ~ALX_MISC_INTNLOSC_OPEN; | ||
366 | alx_write_mem32(hw, ALX_MISC, val); | ||
367 | alx_write_mem32(hw, ALX_MISC, val | ALX_MISC_INTNLOSC_OPEN); | ||
368 | /* hw will automatically dis OSC after cab. */ | ||
369 | val2 = alx_read_mem32(hw, ALX_MSIC2); | ||
370 | val2 &= ~ALX_MSIC2_CALB_START; | ||
371 | alx_write_mem32(hw, ALX_MSIC2, val2); | ||
372 | alx_write_mem32(hw, ALX_MSIC2, val2 | ALX_MSIC2_CALB_START); | ||
373 | } else { | ||
374 | val &= ~ALX_MISC_INTNLOSC_OPEN; | ||
375 | /* disable isolate for rev A devices */ | ||
376 | if (alx_is_rev_a(rev)) | ||
377 | val &= ~ALX_MISC_ISO_EN; | ||
378 | |||
379 | alx_write_mem32(hw, ALX_MISC, val | ALX_MISC_INTNLOSC_OPEN); | ||
380 | alx_write_mem32(hw, ALX_MISC, val); | ||
381 | } | ||
382 | |||
383 | udelay(20); | ||
384 | } | ||
385 | |||
386 | static int alx_stop_mac(struct alx_hw *hw) | ||
387 | { | ||
388 | u32 rxq, txq, val; | ||
389 | u16 i; | ||
390 | |||
391 | rxq = alx_read_mem32(hw, ALX_RXQ0); | ||
392 | alx_write_mem32(hw, ALX_RXQ0, rxq & ~ALX_RXQ0_EN); | ||
393 | txq = alx_read_mem32(hw, ALX_TXQ0); | ||
394 | alx_write_mem32(hw, ALX_TXQ0, txq & ~ALX_TXQ0_EN); | ||
395 | |||
396 | udelay(40); | ||
397 | |||
398 | hw->rx_ctrl &= ~(ALX_MAC_CTRL_RX_EN | ALX_MAC_CTRL_TX_EN); | ||
399 | alx_write_mem32(hw, ALX_MAC_CTRL, hw->rx_ctrl); | ||
400 | |||
401 | for (i = 0; i < ALX_DMA_MAC_RST_TO; i++) { | ||
402 | val = alx_read_mem32(hw, ALX_MAC_STS); | ||
403 | if (!(val & ALX_MAC_STS_IDLE)) | ||
404 | return 0; | ||
405 | udelay(10); | ||
406 | } | ||
407 | |||
408 | return -ETIMEDOUT; | ||
409 | } | ||
410 | |||
411 | int alx_reset_mac(struct alx_hw *hw) | ||
412 | { | ||
413 | u32 val, pmctrl; | ||
414 | int i, ret; | ||
415 | u8 rev; | ||
416 | bool a_cr; | ||
417 | |||
418 | pmctrl = 0; | ||
419 | rev = alx_hw_revision(hw); | ||
420 | a_cr = alx_is_rev_a(rev) && alx_hw_with_cr(hw); | ||
421 | |||
422 | /* disable all interrupts, RXQ/TXQ */ | ||
423 | alx_write_mem32(hw, ALX_MSIX_MASK, 0xFFFFFFFF); | ||
424 | alx_write_mem32(hw, ALX_IMR, 0); | ||
425 | alx_write_mem32(hw, ALX_ISR, ALX_ISR_DIS); | ||
426 | |||
427 | ret = alx_stop_mac(hw); | ||
428 | if (ret) | ||
429 | return ret; | ||
430 | |||
431 | /* mac reset workaroud */ | ||
432 | alx_write_mem32(hw, ALX_RFD_PIDX, 1); | ||
433 | |||
434 | /* dis l0s/l1 before mac reset */ | ||
435 | if (a_cr) { | ||
436 | pmctrl = alx_read_mem32(hw, ALX_PMCTRL); | ||
437 | if (pmctrl & (ALX_PMCTRL_L1_EN | ALX_PMCTRL_L0S_EN)) | ||
438 | alx_write_mem32(hw, ALX_PMCTRL, | ||
439 | pmctrl & ~(ALX_PMCTRL_L1_EN | | ||
440 | ALX_PMCTRL_L0S_EN)); | ||
441 | } | ||
442 | |||
443 | /* reset whole mac safely */ | ||
444 | val = alx_read_mem32(hw, ALX_MASTER); | ||
445 | alx_write_mem32(hw, ALX_MASTER, | ||
446 | val | ALX_MASTER_DMA_MAC_RST | ALX_MASTER_OOB_DIS); | ||
447 | |||
448 | /* make sure it's real idle */ | ||
449 | udelay(10); | ||
450 | for (i = 0; i < ALX_DMA_MAC_RST_TO; i++) { | ||
451 | val = alx_read_mem32(hw, ALX_RFD_PIDX); | ||
452 | if (val == 0) | ||
453 | break; | ||
454 | udelay(10); | ||
455 | } | ||
456 | for (; i < ALX_DMA_MAC_RST_TO; i++) { | ||
457 | val = alx_read_mem32(hw, ALX_MASTER); | ||
458 | if ((val & ALX_MASTER_DMA_MAC_RST) == 0) | ||
459 | break; | ||
460 | udelay(10); | ||
461 | } | ||
462 | if (i == ALX_DMA_MAC_RST_TO) | ||
463 | return -EIO; | ||
464 | udelay(10); | ||
465 | |||
466 | if (a_cr) { | ||
467 | alx_write_mem32(hw, ALX_MASTER, val | ALX_MASTER_PCLKSEL_SRDS); | ||
468 | /* restore l0s / l1 */ | ||
469 | if (pmctrl & (ALX_PMCTRL_L1_EN | ALX_PMCTRL_L0S_EN)) | ||
470 | alx_write_mem32(hw, ALX_PMCTRL, pmctrl); | ||
471 | } | ||
472 | |||
473 | alx_reset_osc(hw, rev); | ||
474 | |||
475 | /* clear Internal OSC settings, switching OSC by hw itself, | ||
476 | * disable isolate for rev A devices | ||
477 | */ | ||
478 | val = alx_read_mem32(hw, ALX_MISC3); | ||
479 | alx_write_mem32(hw, ALX_MISC3, | ||
480 | (val & ~ALX_MISC3_25M_BY_SW) | | ||
481 | ALX_MISC3_25M_NOTO_INTNL); | ||
482 | val = alx_read_mem32(hw, ALX_MISC); | ||
483 | val &= ~ALX_MISC_INTNLOSC_OPEN; | ||
484 | if (alx_is_rev_a(rev)) | ||
485 | val &= ~ALX_MISC_ISO_EN; | ||
486 | alx_write_mem32(hw, ALX_MISC, val); | ||
487 | udelay(20); | ||
488 | |||
489 | /* driver control speed/duplex, hash-alg */ | ||
490 | alx_write_mem32(hw, ALX_MAC_CTRL, hw->rx_ctrl); | ||
491 | |||
492 | val = alx_read_mem32(hw, ALX_SERDES); | ||
493 | alx_write_mem32(hw, ALX_SERDES, | ||
494 | val | ALX_SERDES_MACCLK_SLWDWN | | ||
495 | ALX_SERDES_PHYCLK_SLWDWN); | ||
496 | |||
497 | return 0; | ||
498 | } | ||
499 | |||
500 | void alx_reset_phy(struct alx_hw *hw) | ||
501 | { | ||
502 | int i; | ||
503 | u32 val; | ||
504 | u16 phy_val; | ||
505 | |||
506 | /* (DSP)reset PHY core */ | ||
507 | val = alx_read_mem32(hw, ALX_PHY_CTRL); | ||
508 | val &= ~(ALX_PHY_CTRL_DSPRST_OUT | ALX_PHY_CTRL_IDDQ | | ||
509 | ALX_PHY_CTRL_GATE_25M | ALX_PHY_CTRL_POWER_DOWN | | ||
510 | ALX_PHY_CTRL_CLS); | ||
511 | val |= ALX_PHY_CTRL_RST_ANALOG; | ||
512 | |||
513 | val |= (ALX_PHY_CTRL_HIB_PULSE | ALX_PHY_CTRL_HIB_EN); | ||
514 | alx_write_mem32(hw, ALX_PHY_CTRL, val); | ||
515 | udelay(10); | ||
516 | alx_write_mem32(hw, ALX_PHY_CTRL, val | ALX_PHY_CTRL_DSPRST_OUT); | ||
517 | |||
518 | for (i = 0; i < ALX_PHY_CTRL_DSPRST_TO; i++) | ||
519 | udelay(10); | ||
520 | |||
521 | /* phy power saving & hib */ | ||
522 | alx_write_phy_dbg(hw, ALX_MIIDBG_LEGCYPS, ALX_LEGCYPS_DEF); | ||
523 | alx_write_phy_dbg(hw, ALX_MIIDBG_SYSMODCTRL, | ||
524 | ALX_SYSMODCTRL_IECHOADJ_DEF); | ||
525 | alx_write_phy_ext(hw, ALX_MIIEXT_PCS, ALX_MIIEXT_VDRVBIAS, | ||
526 | ALX_VDRVBIAS_DEF); | ||
527 | |||
528 | /* EEE advertisement */ | ||
529 | val = alx_read_mem32(hw, ALX_LPI_CTRL); | ||
530 | alx_write_mem32(hw, ALX_LPI_CTRL, val & ~ALX_LPI_CTRL_EN); | ||
531 | alx_write_phy_ext(hw, ALX_MIIEXT_ANEG, ALX_MIIEXT_LOCAL_EEEADV, 0); | ||
532 | |||
533 | /* phy power saving */ | ||
534 | alx_write_phy_dbg(hw, ALX_MIIDBG_TST10BTCFG, ALX_TST10BTCFG_DEF); | ||
535 | alx_write_phy_dbg(hw, ALX_MIIDBG_SRDSYSMOD, ALX_SRDSYSMOD_DEF); | ||
536 | alx_write_phy_dbg(hw, ALX_MIIDBG_TST100BTCFG, ALX_TST100BTCFG_DEF); | ||
537 | alx_write_phy_dbg(hw, ALX_MIIDBG_ANACTRL, ALX_ANACTRL_DEF); | ||
538 | alx_read_phy_dbg(hw, ALX_MIIDBG_GREENCFG2, &phy_val); | ||
539 | alx_write_phy_dbg(hw, ALX_MIIDBG_GREENCFG2, | ||
540 | phy_val & ~ALX_GREENCFG2_GATE_DFSE_EN); | ||
541 | /* rtl8139c, 120m issue */ | ||
542 | alx_write_phy_ext(hw, ALX_MIIEXT_ANEG, ALX_MIIEXT_NLP78, | ||
543 | ALX_MIIEXT_NLP78_120M_DEF); | ||
544 | alx_write_phy_ext(hw, ALX_MIIEXT_ANEG, ALX_MIIEXT_S3DIG10, | ||
545 | ALX_MIIEXT_S3DIG10_DEF); | ||
546 | |||
547 | if (hw->lnk_patch) { | ||
548 | /* Turn off half amplitude */ | ||
549 | alx_read_phy_ext(hw, ALX_MIIEXT_PCS, ALX_MIIEXT_CLDCTRL3, | ||
550 | &phy_val); | ||
551 | alx_write_phy_ext(hw, ALX_MIIEXT_PCS, ALX_MIIEXT_CLDCTRL3, | ||
552 | phy_val | ALX_CLDCTRL3_BP_CABLE1TH_DET_GT); | ||
553 | /* Turn off Green feature */ | ||
554 | alx_read_phy_dbg(hw, ALX_MIIDBG_GREENCFG2, &phy_val); | ||
555 | alx_write_phy_dbg(hw, ALX_MIIDBG_GREENCFG2, | ||
556 | phy_val | ALX_GREENCFG2_BP_GREEN); | ||
557 | /* Turn off half Bias */ | ||
558 | alx_read_phy_ext(hw, ALX_MIIEXT_PCS, ALX_MIIEXT_CLDCTRL5, | ||
559 | &phy_val); | ||
560 | alx_write_phy_ext(hw, ALX_MIIEXT_PCS, ALX_MIIEXT_CLDCTRL5, | ||
561 | phy_val | ALX_CLDCTRL5_BP_VD_HLFBIAS); | ||
562 | } | ||
563 | |||
564 | /* set phy interrupt mask */ | ||
565 | alx_write_phy_reg(hw, ALX_MII_IER, ALX_IER_LINK_UP | ALX_IER_LINK_DOWN); | ||
566 | } | ||
567 | |||
568 | #define ALX_PCI_CMD (PCI_COMMAND_MASTER | PCI_COMMAND_MEMORY | PCI_COMMAND_IO) | ||
569 | |||
570 | void alx_reset_pcie(struct alx_hw *hw) | ||
571 | { | ||
572 | u8 rev = alx_hw_revision(hw); | ||
573 | u32 val; | ||
574 | u16 val16; | ||
575 | |||
576 | /* Workaround for PCI problem when BIOS sets MMRBC incorrectly. */ | ||
577 | pci_read_config_word(hw->pdev, PCI_COMMAND, &val16); | ||
578 | if (!(val16 & ALX_PCI_CMD) || (val16 & PCI_COMMAND_INTX_DISABLE)) { | ||
579 | val16 = (val16 | ALX_PCI_CMD) & ~PCI_COMMAND_INTX_DISABLE; | ||
580 | pci_write_config_word(hw->pdev, PCI_COMMAND, val16); | ||
581 | } | ||
582 | |||
583 | /* clear WoL setting/status */ | ||
584 | val = alx_read_mem32(hw, ALX_WOL0); | ||
585 | alx_write_mem32(hw, ALX_WOL0, 0); | ||
586 | |||
587 | val = alx_read_mem32(hw, ALX_PDLL_TRNS1); | ||
588 | alx_write_mem32(hw, ALX_PDLL_TRNS1, val & ~ALX_PDLL_TRNS1_D3PLLOFF_EN); | ||
589 | |||
590 | /* mask some pcie error bits */ | ||
591 | val = alx_read_mem32(hw, ALX_UE_SVRT); | ||
592 | val &= ~(ALX_UE_SVRT_DLPROTERR | ALX_UE_SVRT_FCPROTERR); | ||
593 | alx_write_mem32(hw, ALX_UE_SVRT, val); | ||
594 | |||
595 | /* wol 25M & pclk */ | ||
596 | val = alx_read_mem32(hw, ALX_MASTER); | ||
597 | if (alx_is_rev_a(rev) && alx_hw_with_cr(hw)) { | ||
598 | if ((val & ALX_MASTER_WAKEN_25M) == 0 || | ||
599 | (val & ALX_MASTER_PCLKSEL_SRDS) == 0) | ||
600 | alx_write_mem32(hw, ALX_MASTER, | ||
601 | val | ALX_MASTER_PCLKSEL_SRDS | | ||
602 | ALX_MASTER_WAKEN_25M); | ||
603 | } else { | ||
604 | if ((val & ALX_MASTER_WAKEN_25M) == 0 || | ||
605 | (val & ALX_MASTER_PCLKSEL_SRDS) != 0) | ||
606 | alx_write_mem32(hw, ALX_MASTER, | ||
607 | (val & ~ALX_MASTER_PCLKSEL_SRDS) | | ||
608 | ALX_MASTER_WAKEN_25M); | ||
609 | } | ||
610 | |||
611 | /* ASPM setting */ | ||
612 | alx_enable_aspm(hw, true, true); | ||
613 | |||
614 | udelay(10); | ||
615 | } | ||
616 | |||
617 | void alx_start_mac(struct alx_hw *hw) | ||
618 | { | ||
619 | u32 mac, txq, rxq; | ||
620 | |||
621 | rxq = alx_read_mem32(hw, ALX_RXQ0); | ||
622 | alx_write_mem32(hw, ALX_RXQ0, rxq | ALX_RXQ0_EN); | ||
623 | txq = alx_read_mem32(hw, ALX_TXQ0); | ||
624 | alx_write_mem32(hw, ALX_TXQ0, txq | ALX_TXQ0_EN); | ||
625 | |||
626 | mac = hw->rx_ctrl; | ||
627 | if (hw->link_speed % 10 == DUPLEX_FULL) | ||
628 | mac |= ALX_MAC_CTRL_FULLD; | ||
629 | else | ||
630 | mac &= ~ALX_MAC_CTRL_FULLD; | ||
631 | ALX_SET_FIELD(mac, ALX_MAC_CTRL_SPEED, | ||
632 | hw->link_speed >= SPEED_1000 ? ALX_MAC_CTRL_SPEED_1000 : | ||
633 | ALX_MAC_CTRL_SPEED_10_100); | ||
634 | mac |= ALX_MAC_CTRL_TX_EN | ALX_MAC_CTRL_RX_EN; | ||
635 | hw->rx_ctrl = mac; | ||
636 | alx_write_mem32(hw, ALX_MAC_CTRL, mac); | ||
637 | } | ||
638 | |||
639 | void alx_cfg_mac_flowcontrol(struct alx_hw *hw, u8 fc) | ||
640 | { | ||
641 | if (fc & ALX_FC_RX) | ||
642 | hw->rx_ctrl |= ALX_MAC_CTRL_RXFC_EN; | ||
643 | else | ||
644 | hw->rx_ctrl &= ~ALX_MAC_CTRL_RXFC_EN; | ||
645 | |||
646 | if (fc & ALX_FC_TX) | ||
647 | hw->rx_ctrl |= ALX_MAC_CTRL_TXFC_EN; | ||
648 | else | ||
649 | hw->rx_ctrl &= ~ALX_MAC_CTRL_TXFC_EN; | ||
650 | |||
651 | alx_write_mem32(hw, ALX_MAC_CTRL, hw->rx_ctrl); | ||
652 | } | ||
653 | |||
654 | void alx_enable_aspm(struct alx_hw *hw, bool l0s_en, bool l1_en) | ||
655 | { | ||
656 | u32 pmctrl; | ||
657 | u8 rev = alx_hw_revision(hw); | ||
658 | |||
659 | pmctrl = alx_read_mem32(hw, ALX_PMCTRL); | ||
660 | |||
661 | ALX_SET_FIELD(pmctrl, ALX_PMCTRL_LCKDET_TIMER, | ||
662 | ALX_PMCTRL_LCKDET_TIMER_DEF); | ||
663 | pmctrl |= ALX_PMCTRL_RCVR_WT_1US | | ||
664 | ALX_PMCTRL_L1_CLKSW_EN | | ||
665 | ALX_PMCTRL_L1_SRDSRX_PWD; | ||
666 | ALX_SET_FIELD(pmctrl, ALX_PMCTRL_L1REQ_TO, ALX_PMCTRL_L1REG_TO_DEF); | ||
667 | ALX_SET_FIELD(pmctrl, ALX_PMCTRL_L1_TIMER, ALX_PMCTRL_L1_TIMER_16US); | ||
668 | pmctrl &= ~(ALX_PMCTRL_L1_SRDS_EN | | ||
669 | ALX_PMCTRL_L1_SRDSPLL_EN | | ||
670 | ALX_PMCTRL_L1_BUFSRX_EN | | ||
671 | ALX_PMCTRL_SADLY_EN | | ||
672 | ALX_PMCTRL_HOTRST_WTEN| | ||
673 | ALX_PMCTRL_L0S_EN | | ||
674 | ALX_PMCTRL_L1_EN | | ||
675 | ALX_PMCTRL_ASPM_FCEN | | ||
676 | ALX_PMCTRL_TXL1_AFTER_L0S | | ||
677 | ALX_PMCTRL_RXL1_AFTER_L0S); | ||
678 | if (alx_is_rev_a(rev) && alx_hw_with_cr(hw)) | ||
679 | pmctrl |= ALX_PMCTRL_L1_SRDS_EN | ALX_PMCTRL_L1_SRDSPLL_EN; | ||
680 | |||
681 | if (l0s_en) | ||
682 | pmctrl |= (ALX_PMCTRL_L0S_EN | ALX_PMCTRL_ASPM_FCEN); | ||
683 | if (l1_en) | ||
684 | pmctrl |= (ALX_PMCTRL_L1_EN | ALX_PMCTRL_ASPM_FCEN); | ||
685 | |||
686 | alx_write_mem32(hw, ALX_PMCTRL, pmctrl); | ||
687 | } | ||
688 | |||
689 | |||
690 | static u32 ethadv_to_hw_cfg(struct alx_hw *hw, u32 ethadv_cfg) | ||
691 | { | ||
692 | u32 cfg = 0; | ||
693 | |||
694 | if (ethadv_cfg & ADVERTISED_Autoneg) { | ||
695 | cfg |= ALX_DRV_PHY_AUTO; | ||
696 | if (ethadv_cfg & ADVERTISED_10baseT_Half) | ||
697 | cfg |= ALX_DRV_PHY_10; | ||
698 | if (ethadv_cfg & ADVERTISED_10baseT_Full) | ||
699 | cfg |= ALX_DRV_PHY_10 | ALX_DRV_PHY_DUPLEX; | ||
700 | if (ethadv_cfg & ADVERTISED_100baseT_Half) | ||
701 | cfg |= ALX_DRV_PHY_100; | ||
702 | if (ethadv_cfg & ADVERTISED_100baseT_Full) | ||
703 | cfg |= ALX_DRV_PHY_100 | ALX_DRV_PHY_DUPLEX; | ||
704 | if (ethadv_cfg & ADVERTISED_1000baseT_Half) | ||
705 | cfg |= ALX_DRV_PHY_1000; | ||
706 | if (ethadv_cfg & ADVERTISED_1000baseT_Full) | ||
707 | cfg |= ALX_DRV_PHY_100 | ALX_DRV_PHY_DUPLEX; | ||
708 | if (ethadv_cfg & ADVERTISED_Pause) | ||
709 | cfg |= ADVERTISE_PAUSE_CAP; | ||
710 | if (ethadv_cfg & ADVERTISED_Asym_Pause) | ||
711 | cfg |= ADVERTISE_PAUSE_ASYM; | ||
712 | } else { | ||
713 | switch (ethadv_cfg) { | ||
714 | case ADVERTISED_10baseT_Half: | ||
715 | cfg |= ALX_DRV_PHY_10; | ||
716 | break; | ||
717 | case ADVERTISED_100baseT_Half: | ||
718 | cfg |= ALX_DRV_PHY_100; | ||
719 | break; | ||
720 | case ADVERTISED_10baseT_Full: | ||
721 | cfg |= ALX_DRV_PHY_10 | ALX_DRV_PHY_DUPLEX; | ||
722 | break; | ||
723 | case ADVERTISED_100baseT_Full: | ||
724 | cfg |= ALX_DRV_PHY_100 | ALX_DRV_PHY_DUPLEX; | ||
725 | break; | ||
726 | } | ||
727 | } | ||
728 | |||
729 | return cfg; | ||
730 | } | ||
731 | |||
732 | int alx_setup_speed_duplex(struct alx_hw *hw, u32 ethadv, u8 flowctrl) | ||
733 | { | ||
734 | u16 adv, giga, cr; | ||
735 | u32 val; | ||
736 | int err = 0; | ||
737 | |||
738 | alx_write_phy_reg(hw, ALX_MII_DBG_ADDR, 0); | ||
739 | val = alx_read_mem32(hw, ALX_DRV); | ||
740 | ALX_SET_FIELD(val, ALX_DRV_PHY, 0); | ||
741 | |||
742 | if (ethadv & ADVERTISED_Autoneg) { | ||
743 | adv = ADVERTISE_CSMA; | ||
744 | adv |= ethtool_adv_to_mii_adv_t(ethadv); | ||
745 | |||
746 | if (flowctrl & ALX_FC_ANEG) { | ||
747 | if (flowctrl & ALX_FC_RX) { | ||
748 | adv |= ADVERTISED_Pause; | ||
749 | if (!(flowctrl & ALX_FC_TX)) | ||
750 | adv |= ADVERTISED_Asym_Pause; | ||
751 | } else if (flowctrl & ALX_FC_TX) { | ||
752 | adv |= ADVERTISED_Asym_Pause; | ||
753 | } | ||
754 | } | ||
755 | giga = 0; | ||
756 | if (alx_hw_giga(hw)) | ||
757 | giga = ethtool_adv_to_mii_ctrl1000_t(ethadv); | ||
758 | |||
759 | cr = BMCR_RESET | BMCR_ANENABLE | BMCR_ANRESTART; | ||
760 | |||
761 | if (alx_write_phy_reg(hw, MII_ADVERTISE, adv) || | ||
762 | alx_write_phy_reg(hw, MII_CTRL1000, giga) || | ||
763 | alx_write_phy_reg(hw, MII_BMCR, cr)) | ||
764 | err = -EBUSY; | ||
765 | } else { | ||
766 | cr = BMCR_RESET; | ||
767 | if (ethadv == ADVERTISED_100baseT_Half || | ||
768 | ethadv == ADVERTISED_100baseT_Full) | ||
769 | cr |= BMCR_SPEED100; | ||
770 | if (ethadv == ADVERTISED_10baseT_Full || | ||
771 | ethadv == ADVERTISED_100baseT_Full) | ||
772 | cr |= BMCR_FULLDPLX; | ||
773 | |||
774 | err = alx_write_phy_reg(hw, MII_BMCR, cr); | ||
775 | } | ||
776 | |||
777 | if (!err) { | ||
778 | alx_write_phy_reg(hw, ALX_MII_DBG_ADDR, ALX_PHY_INITED); | ||
779 | val |= ethadv_to_hw_cfg(hw, ethadv); | ||
780 | } | ||
781 | |||
782 | alx_write_mem32(hw, ALX_DRV, val); | ||
783 | |||
784 | return err; | ||
785 | } | ||
786 | |||
787 | |||
788 | void alx_post_phy_link(struct alx_hw *hw) | ||
789 | { | ||
790 | u16 phy_val, len, agc; | ||
791 | u8 revid = alx_hw_revision(hw); | ||
792 | bool adj_th = revid == ALX_REV_B0; | ||
793 | int speed; | ||
794 | |||
795 | if (hw->link_speed == SPEED_UNKNOWN) | ||
796 | speed = SPEED_UNKNOWN; | ||
797 | else | ||
798 | speed = hw->link_speed - hw->link_speed % 10; | ||
799 | |||
800 | if (revid != ALX_REV_B0 && !alx_is_rev_a(revid)) | ||
801 | return; | ||
802 | |||
803 | /* 1000BT/AZ, wrong cable length */ | ||
804 | if (speed != SPEED_UNKNOWN) { | ||
805 | alx_read_phy_ext(hw, ALX_MIIEXT_PCS, ALX_MIIEXT_CLDCTRL6, | ||
806 | &phy_val); | ||
807 | len = ALX_GET_FIELD(phy_val, ALX_CLDCTRL6_CAB_LEN); | ||
808 | alx_read_phy_dbg(hw, ALX_MIIDBG_AGC, &phy_val); | ||
809 | agc = ALX_GET_FIELD(phy_val, ALX_AGC_2_VGA); | ||
810 | |||
811 | if ((speed == SPEED_1000 && | ||
812 | (len > ALX_CLDCTRL6_CAB_LEN_SHORT1G || | ||
813 | (len == 0 && agc > ALX_AGC_LONG1G_LIMT))) || | ||
814 | (speed == SPEED_100 && | ||
815 | (len > ALX_CLDCTRL6_CAB_LEN_SHORT100M || | ||
816 | (len == 0 && agc > ALX_AGC_LONG100M_LIMT)))) { | ||
817 | alx_write_phy_dbg(hw, ALX_MIIDBG_AZ_ANADECT, | ||
818 | ALX_AZ_ANADECT_LONG); | ||
819 | alx_read_phy_ext(hw, ALX_MIIEXT_ANEG, ALX_MIIEXT_AFE, | ||
820 | &phy_val); | ||
821 | alx_write_phy_ext(hw, ALX_MIIEXT_ANEG, ALX_MIIEXT_AFE, | ||
822 | phy_val | ALX_AFE_10BT_100M_TH); | ||
823 | } else { | ||
824 | alx_write_phy_dbg(hw, ALX_MIIDBG_AZ_ANADECT, | ||
825 | ALX_AZ_ANADECT_DEF); | ||
826 | alx_read_phy_ext(hw, ALX_MIIEXT_ANEG, | ||
827 | ALX_MIIEXT_AFE, &phy_val); | ||
828 | alx_write_phy_ext(hw, ALX_MIIEXT_ANEG, ALX_MIIEXT_AFE, | ||
829 | phy_val & ~ALX_AFE_10BT_100M_TH); | ||
830 | } | ||
831 | |||
832 | /* threshold adjust */ | ||
833 | if (adj_th && hw->lnk_patch) { | ||
834 | if (speed == SPEED_100) { | ||
835 | alx_write_phy_dbg(hw, ALX_MIIDBG_MSE16DB, | ||
836 | ALX_MSE16DB_UP); | ||
837 | } else if (speed == SPEED_1000) { | ||
838 | /* | ||
839 | * Giga link threshold, raise the tolerance of | ||
840 | * noise 50% | ||
841 | */ | ||
842 | alx_read_phy_dbg(hw, ALX_MIIDBG_MSE20DB, | ||
843 | &phy_val); | ||
844 | ALX_SET_FIELD(phy_val, ALX_MSE20DB_TH, | ||
845 | ALX_MSE20DB_TH_HI); | ||
846 | alx_write_phy_dbg(hw, ALX_MIIDBG_MSE20DB, | ||
847 | phy_val); | ||
848 | } | ||
849 | } | ||
850 | } else { | ||
851 | alx_read_phy_ext(hw, ALX_MIIEXT_ANEG, ALX_MIIEXT_AFE, | ||
852 | &phy_val); | ||
853 | alx_write_phy_ext(hw, ALX_MIIEXT_ANEG, ALX_MIIEXT_AFE, | ||
854 | phy_val & ~ALX_AFE_10BT_100M_TH); | ||
855 | |||
856 | if (adj_th && hw->lnk_patch) { | ||
857 | alx_write_phy_dbg(hw, ALX_MIIDBG_MSE16DB, | ||
858 | ALX_MSE16DB_DOWN); | ||
859 | alx_read_phy_dbg(hw, ALX_MIIDBG_MSE20DB, &phy_val); | ||
860 | ALX_SET_FIELD(phy_val, ALX_MSE20DB_TH, | ||
861 | ALX_MSE20DB_TH_DEF); | ||
862 | alx_write_phy_dbg(hw, ALX_MIIDBG_MSE20DB, phy_val); | ||
863 | } | ||
864 | } | ||
865 | } | ||
866 | |||
867 | |||
868 | /* NOTE: | ||
869 | * 1. phy link must be established before calling this function | ||
870 | * 2. wol option (pattern,magic,link,etc.) is configed before call it. | ||
871 | */ | ||
872 | int alx_pre_suspend(struct alx_hw *hw, int speed) | ||
873 | { | ||
874 | u32 master, mac, phy, val; | ||
875 | int err = 0; | ||
876 | |||
877 | master = alx_read_mem32(hw, ALX_MASTER); | ||
878 | master &= ~ALX_MASTER_PCLKSEL_SRDS; | ||
879 | mac = hw->rx_ctrl; | ||
880 | /* 10/100 half */ | ||
881 | ALX_SET_FIELD(mac, ALX_MAC_CTRL_SPEED, ALX_MAC_CTRL_SPEED_10_100); | ||
882 | mac &= ~(ALX_MAC_CTRL_FULLD | ALX_MAC_CTRL_RX_EN | ALX_MAC_CTRL_TX_EN); | ||
883 | |||
884 | phy = alx_read_mem32(hw, ALX_PHY_CTRL); | ||
885 | phy &= ~(ALX_PHY_CTRL_DSPRST_OUT | ALX_PHY_CTRL_CLS); | ||
886 | phy |= ALX_PHY_CTRL_RST_ANALOG | ALX_PHY_CTRL_HIB_PULSE | | ||
887 | ALX_PHY_CTRL_HIB_EN; | ||
888 | |||
889 | /* without any activity */ | ||
890 | if (!(hw->sleep_ctrl & ALX_SLEEP_ACTIVE)) { | ||
891 | err = alx_write_phy_reg(hw, ALX_MII_IER, 0); | ||
892 | if (err) | ||
893 | return err; | ||
894 | phy |= ALX_PHY_CTRL_IDDQ | ALX_PHY_CTRL_POWER_DOWN; | ||
895 | } else { | ||
896 | if (hw->sleep_ctrl & (ALX_SLEEP_WOL_MAGIC | ALX_SLEEP_CIFS)) | ||
897 | mac |= ALX_MAC_CTRL_RX_EN | ALX_MAC_CTRL_BRD_EN; | ||
898 | if (hw->sleep_ctrl & ALX_SLEEP_CIFS) | ||
899 | mac |= ALX_MAC_CTRL_TX_EN; | ||
900 | if (speed % 10 == DUPLEX_FULL) | ||
901 | mac |= ALX_MAC_CTRL_FULLD; | ||
902 | if (speed >= SPEED_1000) | ||
903 | ALX_SET_FIELD(mac, ALX_MAC_CTRL_SPEED, | ||
904 | ALX_MAC_CTRL_SPEED_1000); | ||
905 | phy |= ALX_PHY_CTRL_DSPRST_OUT; | ||
906 | err = alx_write_phy_ext(hw, ALX_MIIEXT_ANEG, | ||
907 | ALX_MIIEXT_S3DIG10, | ||
908 | ALX_MIIEXT_S3DIG10_SL); | ||
909 | if (err) | ||
910 | return err; | ||
911 | } | ||
912 | |||
913 | alx_enable_osc(hw); | ||
914 | hw->rx_ctrl = mac; | ||
915 | alx_write_mem32(hw, ALX_MASTER, master); | ||
916 | alx_write_mem32(hw, ALX_MAC_CTRL, mac); | ||
917 | alx_write_mem32(hw, ALX_PHY_CTRL, phy); | ||
918 | |||
919 | /* set val of PDLL D3PLLOFF */ | ||
920 | val = alx_read_mem32(hw, ALX_PDLL_TRNS1); | ||
921 | val |= ALX_PDLL_TRNS1_D3PLLOFF_EN; | ||
922 | alx_write_mem32(hw, ALX_PDLL_TRNS1, val); | ||
923 | |||
924 | return 0; | ||
925 | } | ||
926 | |||
927 | bool alx_phy_configured(struct alx_hw *hw) | ||
928 | { | ||
929 | u32 cfg, hw_cfg; | ||
930 | |||
931 | cfg = ethadv_to_hw_cfg(hw, hw->adv_cfg); | ||
932 | cfg = ALX_GET_FIELD(cfg, ALX_DRV_PHY); | ||
933 | hw_cfg = alx_get_phy_config(hw); | ||
934 | |||
935 | if (hw_cfg == ALX_DRV_PHY_UNKNOWN) | ||
936 | return false; | ||
937 | |||
938 | return cfg == hw_cfg; | ||
939 | } | ||
940 | |||
941 | int alx_get_phy_link(struct alx_hw *hw, int *speed) | ||
942 | { | ||
943 | struct pci_dev *pdev = hw->pdev; | ||
944 | u16 bmsr, giga; | ||
945 | int err; | ||
946 | |||
947 | err = alx_read_phy_reg(hw, MII_BMSR, &bmsr); | ||
948 | if (err) | ||
949 | return err; | ||
950 | |||
951 | err = alx_read_phy_reg(hw, MII_BMSR, &bmsr); | ||
952 | if (err) | ||
953 | return err; | ||
954 | |||
955 | if (!(bmsr & BMSR_LSTATUS)) { | ||
956 | *speed = SPEED_UNKNOWN; | ||
957 | return 0; | ||
958 | } | ||
959 | |||
960 | /* speed/duplex result is saved in PHY Specific Status Register */ | ||
961 | err = alx_read_phy_reg(hw, ALX_MII_GIGA_PSSR, &giga); | ||
962 | if (err) | ||
963 | return err; | ||
964 | |||
965 | if (!(giga & ALX_GIGA_PSSR_SPD_DPLX_RESOLVED)) | ||
966 | goto wrong_speed; | ||
967 | |||
968 | switch (giga & ALX_GIGA_PSSR_SPEED) { | ||
969 | case ALX_GIGA_PSSR_1000MBS: | ||
970 | *speed = SPEED_1000; | ||
971 | break; | ||
972 | case ALX_GIGA_PSSR_100MBS: | ||
973 | *speed = SPEED_100; | ||
974 | break; | ||
975 | case ALX_GIGA_PSSR_10MBS: | ||
976 | *speed = SPEED_10; | ||
977 | break; | ||
978 | default: | ||
979 | goto wrong_speed; | ||
980 | } | ||
981 | |||
982 | *speed += (giga & ALX_GIGA_PSSR_DPLX) ? DUPLEX_FULL : DUPLEX_HALF; | ||
983 | return 1; | ||
984 | |||
985 | wrong_speed: | ||
986 | dev_err(&pdev->dev, "invalid PHY speed/duplex: 0x%x\n", giga); | ||
987 | return -EINVAL; | ||
988 | } | ||
989 | |||
990 | int alx_clear_phy_intr(struct alx_hw *hw) | ||
991 | { | ||
992 | u16 isr; | ||
993 | |||
994 | /* clear interrupt status by reading it */ | ||
995 | return alx_read_phy_reg(hw, ALX_MII_ISR, &isr); | ||
996 | } | ||
997 | |||
998 | int alx_config_wol(struct alx_hw *hw) | ||
999 | { | ||
1000 | u32 wol = 0; | ||
1001 | int err = 0; | ||
1002 | |||
1003 | /* turn on magic packet event */ | ||
1004 | if (hw->sleep_ctrl & ALX_SLEEP_WOL_MAGIC) | ||
1005 | wol |= ALX_WOL0_MAGIC_EN | ALX_WOL0_PME_MAGIC_EN; | ||
1006 | |||
1007 | /* turn on link up event */ | ||
1008 | if (hw->sleep_ctrl & ALX_SLEEP_WOL_PHY) { | ||
1009 | wol |= ALX_WOL0_LINK_EN | ALX_WOL0_PME_LINK; | ||
1010 | /* only link up can wake up */ | ||
1011 | err = alx_write_phy_reg(hw, ALX_MII_IER, ALX_IER_LINK_UP); | ||
1012 | } | ||
1013 | alx_write_mem32(hw, ALX_WOL0, wol); | ||
1014 | |||
1015 | return err; | ||
1016 | } | ||
1017 | |||
1018 | void alx_disable_rss(struct alx_hw *hw) | ||
1019 | { | ||
1020 | u32 ctrl = alx_read_mem32(hw, ALX_RXQ0); | ||
1021 | |||
1022 | ctrl &= ~ALX_RXQ0_RSS_HASH_EN; | ||
1023 | alx_write_mem32(hw, ALX_RXQ0, ctrl); | ||
1024 | } | ||
1025 | |||
1026 | void alx_configure_basic(struct alx_hw *hw) | ||
1027 | { | ||
1028 | u32 val, raw_mtu, max_payload; | ||
1029 | u16 val16; | ||
1030 | u8 chip_rev = alx_hw_revision(hw); | ||
1031 | |||
1032 | alx_set_macaddr(hw, hw->mac_addr); | ||
1033 | |||
1034 | alx_write_mem32(hw, ALX_CLK_GATE, ALX_CLK_GATE_ALL); | ||
1035 | |||
1036 | /* idle timeout to switch clk_125M */ | ||
1037 | if (chip_rev >= ALX_REV_B0) | ||
1038 | alx_write_mem32(hw, ALX_IDLE_DECISN_TIMER, | ||
1039 | ALX_IDLE_DECISN_TIMER_DEF); | ||
1040 | |||
1041 | alx_write_mem32(hw, ALX_SMB_TIMER, hw->smb_timer * 500UL); | ||
1042 | |||
1043 | val = alx_read_mem32(hw, ALX_MASTER); | ||
1044 | val |= ALX_MASTER_IRQMOD2_EN | | ||
1045 | ALX_MASTER_IRQMOD1_EN | | ||
1046 | ALX_MASTER_SYSALVTIMER_EN; | ||
1047 | alx_write_mem32(hw, ALX_MASTER, val); | ||
1048 | alx_write_mem32(hw, ALX_IRQ_MODU_TIMER, | ||
1049 | (hw->imt >> 1) << ALX_IRQ_MODU_TIMER1_SHIFT); | ||
1050 | /* intr re-trig timeout */ | ||
1051 | alx_write_mem32(hw, ALX_INT_RETRIG, ALX_INT_RETRIG_TO); | ||
1052 | /* tpd threshold to trig int */ | ||
1053 | alx_write_mem32(hw, ALX_TINT_TPD_THRSHLD, hw->ith_tpd); | ||
1054 | alx_write_mem32(hw, ALX_TINT_TIMER, hw->imt); | ||
1055 | |||
1056 | raw_mtu = hw->mtu + ETH_HLEN; | ||
1057 | alx_write_mem32(hw, ALX_MTU, raw_mtu + 8); | ||
1058 | if (raw_mtu > ALX_MTU_JUMBO_TH) | ||
1059 | hw->rx_ctrl &= ~ALX_MAC_CTRL_FAST_PAUSE; | ||
1060 | |||
1061 | if ((raw_mtu + 8) < ALX_TXQ1_JUMBO_TSO_TH) | ||
1062 | val = (raw_mtu + 8 + 7) >> 3; | ||
1063 | else | ||
1064 | val = ALX_TXQ1_JUMBO_TSO_TH >> 3; | ||
1065 | alx_write_mem32(hw, ALX_TXQ1, val | ALX_TXQ1_ERRLGPKT_DROP_EN); | ||
1066 | |||
1067 | max_payload = pcie_get_readrq(hw->pdev) >> 8; | ||
1068 | /* | ||
1069 | * if BIOS had changed the default dma read max length, | ||
1070 | * restore it to default value | ||
1071 | */ | ||
1072 | if (max_payload < ALX_DEV_CTRL_MAXRRS_MIN) | ||
1073 | pcie_set_readrq(hw->pdev, 128 << ALX_DEV_CTRL_MAXRRS_MIN); | ||
1074 | |||
1075 | val = ALX_TXQ_TPD_BURSTPREF_DEF << ALX_TXQ0_TPD_BURSTPREF_SHIFT | | ||
1076 | ALX_TXQ0_MODE_ENHANCE | ALX_TXQ0_LSO_8023_EN | | ||
1077 | ALX_TXQ0_SUPT_IPOPT | | ||
1078 | ALX_TXQ_TXF_BURST_PREF_DEF << ALX_TXQ0_TXF_BURST_PREF_SHIFT; | ||
1079 | alx_write_mem32(hw, ALX_TXQ0, val); | ||
1080 | val = ALX_TXQ_TPD_BURSTPREF_DEF << ALX_HQTPD_Q1_NUMPREF_SHIFT | | ||
1081 | ALX_TXQ_TPD_BURSTPREF_DEF << ALX_HQTPD_Q2_NUMPREF_SHIFT | | ||
1082 | ALX_TXQ_TPD_BURSTPREF_DEF << ALX_HQTPD_Q3_NUMPREF_SHIFT | | ||
1083 | ALX_HQTPD_BURST_EN; | ||
1084 | alx_write_mem32(hw, ALX_HQTPD, val); | ||
1085 | |||
1086 | /* rxq, flow control */ | ||
1087 | val = alx_read_mem32(hw, ALX_SRAM5); | ||
1088 | val = ALX_GET_FIELD(val, ALX_SRAM_RXF_LEN) << 3; | ||
1089 | if (val > ALX_SRAM_RXF_LEN_8K) { | ||
1090 | val16 = ALX_MTU_STD_ALGN >> 3; | ||
1091 | val = (val - ALX_RXQ2_RXF_FLOW_CTRL_RSVD) >> 3; | ||
1092 | } else { | ||
1093 | val16 = ALX_MTU_STD_ALGN >> 3; | ||
1094 | val = (val - ALX_MTU_STD_ALGN) >> 3; | ||
1095 | } | ||
1096 | alx_write_mem32(hw, ALX_RXQ2, | ||
1097 | val16 << ALX_RXQ2_RXF_XOFF_THRESH_SHIFT | | ||
1098 | val << ALX_RXQ2_RXF_XON_THRESH_SHIFT); | ||
1099 | val = ALX_RXQ0_NUM_RFD_PREF_DEF << ALX_RXQ0_NUM_RFD_PREF_SHIFT | | ||
1100 | ALX_RXQ0_RSS_MODE_DIS << ALX_RXQ0_RSS_MODE_SHIFT | | ||
1101 | ALX_RXQ0_IDT_TBL_SIZE_DEF << ALX_RXQ0_IDT_TBL_SIZE_SHIFT | | ||
1102 | ALX_RXQ0_RSS_HSTYP_ALL | ALX_RXQ0_RSS_HASH_EN | | ||
1103 | ALX_RXQ0_IPV6_PARSE_EN; | ||
1104 | |||
1105 | if (alx_hw_giga(hw)) | ||
1106 | ALX_SET_FIELD(val, ALX_RXQ0_ASPM_THRESH, | ||
1107 | ALX_RXQ0_ASPM_THRESH_100M); | ||
1108 | |||
1109 | alx_write_mem32(hw, ALX_RXQ0, val); | ||
1110 | |||
1111 | val = alx_read_mem32(hw, ALX_DMA); | ||
1112 | val = ALX_DMA_RORDER_MODE_OUT << ALX_DMA_RORDER_MODE_SHIFT | | ||
1113 | ALX_DMA_RREQ_PRI_DATA | | ||
1114 | max_payload << ALX_DMA_RREQ_BLEN_SHIFT | | ||
1115 | ALX_DMA_WDLY_CNT_DEF << ALX_DMA_WDLY_CNT_SHIFT | | ||
1116 | ALX_DMA_RDLY_CNT_DEF << ALX_DMA_RDLY_CNT_SHIFT | | ||
1117 | (hw->dma_chnl - 1) << ALX_DMA_RCHNL_SEL_SHIFT; | ||
1118 | alx_write_mem32(hw, ALX_DMA, val); | ||
1119 | |||
1120 | /* default multi-tx-q weights */ | ||
1121 | val = ALX_WRR_PRI_RESTRICT_NONE << ALX_WRR_PRI_SHIFT | | ||
1122 | 4 << ALX_WRR_PRI0_SHIFT | | ||
1123 | 4 << ALX_WRR_PRI1_SHIFT | | ||
1124 | 4 << ALX_WRR_PRI2_SHIFT | | ||
1125 | 4 << ALX_WRR_PRI3_SHIFT; | ||
1126 | alx_write_mem32(hw, ALX_WRR, val); | ||
1127 | } | ||
1128 | |||
1129 | static inline u32 alx_speed_to_ethadv(int speed) | ||
1130 | { | ||
1131 | switch (speed) { | ||
1132 | case SPEED_1000 + DUPLEX_FULL: | ||
1133 | return ADVERTISED_1000baseT_Full; | ||
1134 | case SPEED_100 + DUPLEX_FULL: | ||
1135 | return ADVERTISED_100baseT_Full; | ||
1136 | case SPEED_100 + DUPLEX_HALF: | ||
1137 | return ADVERTISED_10baseT_Half; | ||
1138 | case SPEED_10 + DUPLEX_FULL: | ||
1139 | return ADVERTISED_10baseT_Full; | ||
1140 | case SPEED_10 + DUPLEX_HALF: | ||
1141 | return ADVERTISED_10baseT_Half; | ||
1142 | default: | ||
1143 | return 0; | ||
1144 | } | ||
1145 | } | ||
1146 | |||
1147 | int alx_select_powersaving_speed(struct alx_hw *hw, int *speed) | ||
1148 | { | ||
1149 | int i, err, spd; | ||
1150 | u16 lpa; | ||
1151 | |||
1152 | err = alx_get_phy_link(hw, &spd); | ||
1153 | if (err < 0) | ||
1154 | return err; | ||
1155 | |||
1156 | if (spd == SPEED_UNKNOWN) | ||
1157 | return 0; | ||
1158 | |||
1159 | err = alx_read_phy_reg(hw, MII_LPA, &lpa); | ||
1160 | if (err) | ||
1161 | return err; | ||
1162 | |||
1163 | if (!(lpa & LPA_LPACK)) { | ||
1164 | *speed = spd; | ||
1165 | return 0; | ||
1166 | } | ||
1167 | |||
1168 | if (lpa & LPA_10FULL) | ||
1169 | *speed = SPEED_10 + DUPLEX_FULL; | ||
1170 | else if (lpa & LPA_10HALF) | ||
1171 | *speed = SPEED_10 + DUPLEX_HALF; | ||
1172 | else if (lpa & LPA_100FULL) | ||
1173 | *speed = SPEED_100 + DUPLEX_FULL; | ||
1174 | else | ||
1175 | *speed = SPEED_100 + DUPLEX_HALF; | ||
1176 | |||
1177 | if (*speed != spd) { | ||
1178 | err = alx_write_phy_reg(hw, ALX_MII_IER, 0); | ||
1179 | if (err) | ||
1180 | return err; | ||
1181 | err = alx_setup_speed_duplex(hw, | ||
1182 | alx_speed_to_ethadv(*speed) | | ||
1183 | ADVERTISED_Autoneg, | ||
1184 | ALX_FC_ANEG | ALX_FC_RX | | ||
1185 | ALX_FC_TX); | ||
1186 | if (err) | ||
1187 | return err; | ||
1188 | |||
1189 | /* wait for linkup */ | ||
1190 | for (i = 0; i < ALX_MAX_SETUP_LNK_CYCLE; i++) { | ||
1191 | int speed2; | ||
1192 | |||
1193 | msleep(100); | ||
1194 | |||
1195 | err = alx_get_phy_link(hw, &speed2); | ||
1196 | if (err < 0) | ||
1197 | return err; | ||
1198 | if (speed2 != SPEED_UNKNOWN) | ||
1199 | break; | ||
1200 | } | ||
1201 | if (i == ALX_MAX_SETUP_LNK_CYCLE) | ||
1202 | return -ETIMEDOUT; | ||
1203 | } | ||
1204 | |||
1205 | return 0; | ||
1206 | } | ||
1207 | |||
1208 | bool alx_get_phy_info(struct alx_hw *hw) | ||
1209 | { | ||
1210 | u16 devs1, devs2; | ||
1211 | |||
1212 | if (alx_read_phy_reg(hw, MII_PHYSID1, &hw->phy_id[0]) || | ||
1213 | alx_read_phy_reg(hw, MII_PHYSID2, &hw->phy_id[1])) | ||
1214 | return false; | ||
1215 | |||
1216 | /* since we haven't PMA/PMD status2 register, we can't | ||
1217 | * use mdio45_probe function for prtad and mmds. | ||
1218 | * use fixed MMD3 to get mmds. | ||
1219 | */ | ||
1220 | if (alx_read_phy_ext(hw, 3, MDIO_DEVS1, &devs1) || | ||
1221 | alx_read_phy_ext(hw, 3, MDIO_DEVS2, &devs2)) | ||
1222 | return false; | ||
1223 | hw->mdio.mmds = devs1 | devs2 << 16; | ||
1224 | |||
1225 | return true; | ||
1226 | } | ||
diff --git a/drivers/net/ethernet/atheros/alx/hw.h b/drivers/net/ethernet/atheros/alx/hw.h new file mode 100644 index 000000000000..65e723d2172a --- /dev/null +++ b/drivers/net/ethernet/atheros/alx/hw.h | |||
@@ -0,0 +1,499 @@ | |||
1 | /* | ||
2 | * Copyright (c) 2013 Johannes Berg <johannes@sipsolutions.net> | ||
3 | * | ||
4 | * This file is free software: you may copy, redistribute and/or modify it | ||
5 | * under the terms of the GNU General Public License as published by the | ||
6 | * Free Software Foundation, either version 2 of the License, or (at your | ||
7 | * option) any later version. | ||
8 | * | ||
9 | * This file is distributed in the hope that it will be useful, but | ||
10 | * WITHOUT ANY WARRANTY; without even the implied warranty of | ||
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
12 | * General Public License for more details. | ||
13 | * | ||
14 | * You should have received a copy of the GNU General Public License | ||
15 | * along with this program. If not, see <http://www.gnu.org/licenses/>. | ||
16 | * | ||
17 | * This file incorporates work covered by the following copyright and | ||
18 | * permission notice: | ||
19 | * | ||
20 | * Copyright (c) 2012 Qualcomm Atheros, Inc. | ||
21 | * | ||
22 | * Permission to use, copy, modify, and/or distribute this software for any | ||
23 | * purpose with or without fee is hereby granted, provided that the above | ||
24 | * copyright notice and this permission notice appear in all copies. | ||
25 | * | ||
26 | * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES | ||
27 | * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF | ||
28 | * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR | ||
29 | * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES | ||
30 | * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN | ||
31 | * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF | ||
32 | * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. | ||
33 | */ | ||
34 | |||
35 | #ifndef ALX_HW_H_ | ||
36 | #define ALX_HW_H_ | ||
37 | #include <linux/types.h> | ||
38 | #include <linux/mdio.h> | ||
39 | #include <linux/pci.h> | ||
40 | #include "reg.h" | ||
41 | |||
42 | /* Transmit Packet Descriptor, contains 4 32-bit words. | ||
43 | * | ||
44 | * 31 16 0 | ||
45 | * +----------------+----------------+ | ||
46 | * | vlan-tag | buf length | | ||
47 | * +----------------+----------------+ | ||
48 | * | Word 1 | | ||
49 | * +----------------+----------------+ | ||
50 | * | Word 2: buf addr lo | | ||
51 | * +----------------+----------------+ | ||
52 | * | Word 3: buf addr hi | | ||
53 | * +----------------+----------------+ | ||
54 | * | ||
55 | * Word 2 and 3 combine to form a 64-bit buffer address | ||
56 | * | ||
57 | * Word 1 has three forms, depending on the state of bit 8/12/13: | ||
58 | * if bit8 =='1', the definition is just for custom checksum offload. | ||
59 | * if bit8 == '0' && bit12 == '1' && bit13 == '1', the *FIRST* descriptor | ||
60 | * for the skb is special for LSO V2, Word 2 become total skb length , | ||
61 | * Word 3 is meaningless. | ||
62 | * other condition, the definition is for general skb or ip/tcp/udp | ||
63 | * checksum or LSO(TSO) offload. | ||
64 | * | ||
65 | * Here is the depiction: | ||
66 | * | ||
67 | * 0-+ 0-+ | ||
68 | * 1 | 1 | | ||
69 | * 2 | 2 | | ||
70 | * 3 | Payload offset 3 | L4 header offset | ||
71 | * 4 | (7:0) 4 | (7:0) | ||
72 | * 5 | 5 | | ||
73 | * 6 | 6 | | ||
74 | * 7-+ 7-+ | ||
75 | * 8 Custom csum enable = 1 8 Custom csum enable = 0 | ||
76 | * 9 General IPv4 checksum 9 General IPv4 checksum | ||
77 | * 10 General TCP checksum 10 General TCP checksum | ||
78 | * 11 General UDP checksum 11 General UDP checksum | ||
79 | * 12 Large Send Segment enable 12 Large Send Segment enable | ||
80 | * 13 Large Send Segment type 13 Large Send Segment type | ||
81 | * 14 VLAN tagged 14 VLAN tagged | ||
82 | * 15 Insert VLAN tag 15 Insert VLAN tag | ||
83 | * 16 IPv4 packet 16 IPv4 packet | ||
84 | * 17 Ethernet frame type 17 Ethernet frame type | ||
85 | * 18-+ 18-+ | ||
86 | * 19 | 19 | | ||
87 | * 20 | 20 | | ||
88 | * 21 | Custom csum offset 21 | | ||
89 | * 22 | (25:18) 22 | | ||
90 | * 23 | 23 | MSS (30:18) | ||
91 | * 24 | 24 | | ||
92 | * 25-+ 25 | | ||
93 | * 26-+ 26 | | ||
94 | * 27 | 27 | | ||
95 | * 28 | Reserved 28 | | ||
96 | * 29 | 29 | | ||
97 | * 30-+ 30-+ | ||
98 | * 31 End of packet 31 End of packet | ||
99 | */ | ||
100 | struct alx_txd { | ||
101 | __le16 len; | ||
102 | __le16 vlan_tag; | ||
103 | __le32 word1; | ||
104 | union { | ||
105 | __le64 addr; | ||
106 | struct { | ||
107 | __le32 pkt_len; | ||
108 | __le32 resvd; | ||
109 | } l; | ||
110 | } adrl; | ||
111 | } __packed; | ||
112 | |||
113 | /* tpd word 1 */ | ||
114 | #define TPD_CXSUMSTART_MASK 0x00FF | ||
115 | #define TPD_CXSUMSTART_SHIFT 0 | ||
116 | #define TPD_L4HDROFFSET_MASK 0x00FF | ||
117 | #define TPD_L4HDROFFSET_SHIFT 0 | ||
118 | #define TPD_CXSUM_EN_MASK 0x0001 | ||
119 | #define TPD_CXSUM_EN_SHIFT 8 | ||
120 | #define TPD_IP_XSUM_MASK 0x0001 | ||
121 | #define TPD_IP_XSUM_SHIFT 9 | ||
122 | #define TPD_TCP_XSUM_MASK 0x0001 | ||
123 | #define TPD_TCP_XSUM_SHIFT 10 | ||
124 | #define TPD_UDP_XSUM_MASK 0x0001 | ||
125 | #define TPD_UDP_XSUM_SHIFT 11 | ||
126 | #define TPD_LSO_EN_MASK 0x0001 | ||
127 | #define TPD_LSO_EN_SHIFT 12 | ||
128 | #define TPD_LSO_V2_MASK 0x0001 | ||
129 | #define TPD_LSO_V2_SHIFT 13 | ||
130 | #define TPD_VLTAGGED_MASK 0x0001 | ||
131 | #define TPD_VLTAGGED_SHIFT 14 | ||
132 | #define TPD_INS_VLTAG_MASK 0x0001 | ||
133 | #define TPD_INS_VLTAG_SHIFT 15 | ||
134 | #define TPD_IPV4_MASK 0x0001 | ||
135 | #define TPD_IPV4_SHIFT 16 | ||
136 | #define TPD_ETHTYPE_MASK 0x0001 | ||
137 | #define TPD_ETHTYPE_SHIFT 17 | ||
138 | #define TPD_CXSUMOFFSET_MASK 0x00FF | ||
139 | #define TPD_CXSUMOFFSET_SHIFT 18 | ||
140 | #define TPD_MSS_MASK 0x1FFF | ||
141 | #define TPD_MSS_SHIFT 18 | ||
142 | #define TPD_EOP_MASK 0x0001 | ||
143 | #define TPD_EOP_SHIFT 31 | ||
144 | |||
145 | #define DESC_GET(_x, _name) ((_x) >> _name##SHIFT & _name##MASK) | ||
146 | |||
147 | /* Receive Free Descriptor */ | ||
148 | struct alx_rfd { | ||
149 | __le64 addr; /* data buffer address, length is | ||
150 | * declared in register --- every | ||
151 | * buffer has the same size | ||
152 | */ | ||
153 | } __packed; | ||
154 | |||
155 | /* Receive Return Descriptor, contains 4 32-bit words. | ||
156 | * | ||
157 | * 31 16 0 | ||
158 | * +----------------+----------------+ | ||
159 | * | Word 0 | | ||
160 | * +----------------+----------------+ | ||
161 | * | Word 1: RSS Hash value | | ||
162 | * +----------------+----------------+ | ||
163 | * | Word 2 | | ||
164 | * +----------------+----------------+ | ||
165 | * | Word 3 | | ||
166 | * +----------------+----------------+ | ||
167 | * | ||
168 | * Word 0 depiction & Word 2 depiction: | ||
169 | * | ||
170 | * 0--+ 0--+ | ||
171 | * 1 | 1 | | ||
172 | * 2 | 2 | | ||
173 | * 3 | 3 | | ||
174 | * 4 | 4 | | ||
175 | * 5 | 5 | | ||
176 | * 6 | 6 | | ||
177 | * 7 | IP payload checksum 7 | VLAN tag | ||
178 | * 8 | (15:0) 8 | (15:0) | ||
179 | * 9 | 9 | | ||
180 | * 10 | 10 | | ||
181 | * 11 | 11 | | ||
182 | * 12 | 12 | | ||
183 | * 13 | 13 | | ||
184 | * 14 | 14 | | ||
185 | * 15-+ 15-+ | ||
186 | * 16-+ 16-+ | ||
187 | * 17 | Number of RFDs 17 | | ||
188 | * 18 | (19:16) 18 | | ||
189 | * 19-+ 19 | Protocol ID | ||
190 | * 20-+ 20 | (23:16) | ||
191 | * 21 | 21 | | ||
192 | * 22 | 22 | | ||
193 | * 23 | 23-+ | ||
194 | * 24 | 24 | Reserved | ||
195 | * 25 | Start index of RFD-ring 25-+ | ||
196 | * 26 | (31:20) 26 | RSS Q-num (27:25) | ||
197 | * 27 | 27-+ | ||
198 | * 28 | 28-+ | ||
199 | * 29 | 29 | RSS Hash algorithm | ||
200 | * 30 | 30 | (31:28) | ||
201 | * 31-+ 31-+ | ||
202 | * | ||
203 | * Word 3 depiction: | ||
204 | * | ||
205 | * 0--+ | ||
206 | * 1 | | ||
207 | * 2 | | ||
208 | * 3 | | ||
209 | * 4 | | ||
210 | * 5 | | ||
211 | * 6 | | ||
212 | * 7 | Packet length (include FCS) | ||
213 | * 8 | (13:0) | ||
214 | * 9 | | ||
215 | * 10 | | ||
216 | * 11 | | ||
217 | * 12 | | ||
218 | * 13-+ | ||
219 | * 14 L4 Header checksum error | ||
220 | * 15 IPv4 checksum error | ||
221 | * 16 VLAN tagged | ||
222 | * 17-+ | ||
223 | * 18 | Protocol ID (19:17) | ||
224 | * 19-+ | ||
225 | * 20 Receive error summary | ||
226 | * 21 FCS(CRC) error | ||
227 | * 22 Frame alignment error | ||
228 | * 23 Truncated packet | ||
229 | * 24 Runt packet | ||
230 | * 25 Incomplete packet due to insufficient rx-desc | ||
231 | * 26 Broadcast packet | ||
232 | * 27 Multicast packet | ||
233 | * 28 Ethernet type (EII or 802.3) | ||
234 | * 29 FIFO overflow | ||
235 | * 30 Length error (for 802.3, length field mismatch with actual len) | ||
236 | * 31 Updated, indicate to driver that this RRD is refreshed. | ||
237 | */ | ||
238 | struct alx_rrd { | ||
239 | __le32 word0; | ||
240 | __le32 rss_hash; | ||
241 | __le32 word2; | ||
242 | __le32 word3; | ||
243 | } __packed; | ||
244 | |||
245 | /* rrd word 0 */ | ||
246 | #define RRD_XSUM_MASK 0xFFFF | ||
247 | #define RRD_XSUM_SHIFT 0 | ||
248 | #define RRD_NOR_MASK 0x000F | ||
249 | #define RRD_NOR_SHIFT 16 | ||
250 | #define RRD_SI_MASK 0x0FFF | ||
251 | #define RRD_SI_SHIFT 20 | ||
252 | |||
253 | /* rrd word 2 */ | ||
254 | #define RRD_VLTAG_MASK 0xFFFF | ||
255 | #define RRD_VLTAG_SHIFT 0 | ||
256 | #define RRD_PID_MASK 0x00FF | ||
257 | #define RRD_PID_SHIFT 16 | ||
258 | /* non-ip packet */ | ||
259 | #define RRD_PID_NONIP 0 | ||
260 | /* ipv4(only) */ | ||
261 | #define RRD_PID_IPV4 1 | ||
262 | /* tcp/ipv6 */ | ||
263 | #define RRD_PID_IPV6TCP 2 | ||
264 | /* tcp/ipv4 */ | ||
265 | #define RRD_PID_IPV4TCP 3 | ||
266 | /* udp/ipv6 */ | ||
267 | #define RRD_PID_IPV6UDP 4 | ||
268 | /* udp/ipv4 */ | ||
269 | #define RRD_PID_IPV4UDP 5 | ||
270 | /* ipv6(only) */ | ||
271 | #define RRD_PID_IPV6 6 | ||
272 | /* LLDP packet */ | ||
273 | #define RRD_PID_LLDP 7 | ||
274 | /* 1588 packet */ | ||
275 | #define RRD_PID_1588 8 | ||
276 | #define RRD_RSSQ_MASK 0x0007 | ||
277 | #define RRD_RSSQ_SHIFT 25 | ||
278 | #define RRD_RSSALG_MASK 0x000F | ||
279 | #define RRD_RSSALG_SHIFT 28 | ||
280 | #define RRD_RSSALG_TCPV6 0x1 | ||
281 | #define RRD_RSSALG_IPV6 0x2 | ||
282 | #define RRD_RSSALG_TCPV4 0x4 | ||
283 | #define RRD_RSSALG_IPV4 0x8 | ||
284 | |||
285 | /* rrd word 3 */ | ||
286 | #define RRD_PKTLEN_MASK 0x3FFF | ||
287 | #define RRD_PKTLEN_SHIFT 0 | ||
288 | #define RRD_ERR_L4_MASK 0x0001 | ||
289 | #define RRD_ERR_L4_SHIFT 14 | ||
290 | #define RRD_ERR_IPV4_MASK 0x0001 | ||
291 | #define RRD_ERR_IPV4_SHIFT 15 | ||
292 | #define RRD_VLTAGGED_MASK 0x0001 | ||
293 | #define RRD_VLTAGGED_SHIFT 16 | ||
294 | #define RRD_OLD_PID_MASK 0x0007 | ||
295 | #define RRD_OLD_PID_SHIFT 17 | ||
296 | #define RRD_ERR_RES_MASK 0x0001 | ||
297 | #define RRD_ERR_RES_SHIFT 20 | ||
298 | #define RRD_ERR_FCS_MASK 0x0001 | ||
299 | #define RRD_ERR_FCS_SHIFT 21 | ||
300 | #define RRD_ERR_FAE_MASK 0x0001 | ||
301 | #define RRD_ERR_FAE_SHIFT 22 | ||
302 | #define RRD_ERR_TRUNC_MASK 0x0001 | ||
303 | #define RRD_ERR_TRUNC_SHIFT 23 | ||
304 | #define RRD_ERR_RUNT_MASK 0x0001 | ||
305 | #define RRD_ERR_RUNT_SHIFT 24 | ||
306 | #define RRD_ERR_ICMP_MASK 0x0001 | ||
307 | #define RRD_ERR_ICMP_SHIFT 25 | ||
308 | #define RRD_BCAST_MASK 0x0001 | ||
309 | #define RRD_BCAST_SHIFT 26 | ||
310 | #define RRD_MCAST_MASK 0x0001 | ||
311 | #define RRD_MCAST_SHIFT 27 | ||
312 | #define RRD_ETHTYPE_MASK 0x0001 | ||
313 | #define RRD_ETHTYPE_SHIFT 28 | ||
314 | #define RRD_ERR_FIFOV_MASK 0x0001 | ||
315 | #define RRD_ERR_FIFOV_SHIFT 29 | ||
316 | #define RRD_ERR_LEN_MASK 0x0001 | ||
317 | #define RRD_ERR_LEN_SHIFT 30 | ||
318 | #define RRD_UPDATED_MASK 0x0001 | ||
319 | #define RRD_UPDATED_SHIFT 31 | ||
320 | |||
321 | |||
322 | #define ALX_MAX_SETUP_LNK_CYCLE 50 | ||
323 | |||
324 | /* for FlowControl */ | ||
325 | #define ALX_FC_RX 0x01 | ||
326 | #define ALX_FC_TX 0x02 | ||
327 | #define ALX_FC_ANEG 0x04 | ||
328 | |||
329 | /* for sleep control */ | ||
330 | #define ALX_SLEEP_WOL_PHY 0x00000001 | ||
331 | #define ALX_SLEEP_WOL_MAGIC 0x00000002 | ||
332 | #define ALX_SLEEP_CIFS 0x00000004 | ||
333 | #define ALX_SLEEP_ACTIVE (ALX_SLEEP_WOL_PHY | \ | ||
334 | ALX_SLEEP_WOL_MAGIC | \ | ||
335 | ALX_SLEEP_CIFS) | ||
336 | |||
337 | /* for RSS hash type */ | ||
338 | #define ALX_RSS_HASH_TYPE_IPV4 0x1 | ||
339 | #define ALX_RSS_HASH_TYPE_IPV4_TCP 0x2 | ||
340 | #define ALX_RSS_HASH_TYPE_IPV6 0x4 | ||
341 | #define ALX_RSS_HASH_TYPE_IPV6_TCP 0x8 | ||
342 | #define ALX_RSS_HASH_TYPE_ALL (ALX_RSS_HASH_TYPE_IPV4 | \ | ||
343 | ALX_RSS_HASH_TYPE_IPV4_TCP | \ | ||
344 | ALX_RSS_HASH_TYPE_IPV6 | \ | ||
345 | ALX_RSS_HASH_TYPE_IPV6_TCP) | ||
346 | #define ALX_DEF_RXBUF_SIZE 1536 | ||
347 | #define ALX_MAX_JUMBO_PKT_SIZE (9*1024) | ||
348 | #define ALX_MAX_TSO_PKT_SIZE (7*1024) | ||
349 | #define ALX_MAX_FRAME_SIZE ALX_MAX_JUMBO_PKT_SIZE | ||
350 | #define ALX_MIN_FRAME_SIZE 68 | ||
351 | #define ALX_RAW_MTU(_mtu) (_mtu + ETH_HLEN + ETH_FCS_LEN + VLAN_HLEN) | ||
352 | |||
353 | #define ALX_MAX_RX_QUEUES 8 | ||
354 | #define ALX_MAX_TX_QUEUES 4 | ||
355 | #define ALX_MAX_HANDLED_INTRS 5 | ||
356 | |||
357 | #define ALX_ISR_MISC (ALX_ISR_PCIE_LNKDOWN | \ | ||
358 | ALX_ISR_DMAW | \ | ||
359 | ALX_ISR_DMAR | \ | ||
360 | ALX_ISR_SMB | \ | ||
361 | ALX_ISR_MANU | \ | ||
362 | ALX_ISR_TIMER) | ||
363 | |||
364 | #define ALX_ISR_FATAL (ALX_ISR_PCIE_LNKDOWN | \ | ||
365 | ALX_ISR_DMAW | ALX_ISR_DMAR) | ||
366 | |||
367 | #define ALX_ISR_ALERT (ALX_ISR_RXF_OV | \ | ||
368 | ALX_ISR_TXF_UR | \ | ||
369 | ALX_ISR_RFD_UR) | ||
370 | |||
371 | #define ALX_ISR_ALL_QUEUES (ALX_ISR_TX_Q0 | \ | ||
372 | ALX_ISR_TX_Q1 | \ | ||
373 | ALX_ISR_TX_Q2 | \ | ||
374 | ALX_ISR_TX_Q3 | \ | ||
375 | ALX_ISR_RX_Q0 | \ | ||
376 | ALX_ISR_RX_Q1 | \ | ||
377 | ALX_ISR_RX_Q2 | \ | ||
378 | ALX_ISR_RX_Q3 | \ | ||
379 | ALX_ISR_RX_Q4 | \ | ||
380 | ALX_ISR_RX_Q5 | \ | ||
381 | ALX_ISR_RX_Q6 | \ | ||
382 | ALX_ISR_RX_Q7) | ||
383 | |||
384 | /* maximum interrupt vectors for msix */ | ||
385 | #define ALX_MAX_MSIX_INTRS 16 | ||
386 | |||
387 | #define ALX_GET_FIELD(_data, _field) \ | ||
388 | (((_data) >> _field ## _SHIFT) & _field ## _MASK) | ||
389 | |||
390 | #define ALX_SET_FIELD(_data, _field, _value) do { \ | ||
391 | (_data) &= ~(_field ## _MASK << _field ## _SHIFT); \ | ||
392 | (_data) |= ((_value) & _field ## _MASK) << _field ## _SHIFT;\ | ||
393 | } while (0) | ||
394 | |||
395 | struct alx_hw { | ||
396 | struct pci_dev *pdev; | ||
397 | u8 __iomem *hw_addr; | ||
398 | |||
399 | /* current & permanent mac addr */ | ||
400 | u8 mac_addr[ETH_ALEN]; | ||
401 | u8 perm_addr[ETH_ALEN]; | ||
402 | |||
403 | u16 mtu; | ||
404 | u16 imt; | ||
405 | u8 dma_chnl; | ||
406 | u8 max_dma_chnl; | ||
407 | /* tpd threshold to trig INT */ | ||
408 | u32 ith_tpd; | ||
409 | u32 rx_ctrl; | ||
410 | u32 mc_hash[2]; | ||
411 | |||
412 | u32 smb_timer; | ||
413 | /* SPEED_* + DUPLEX_*, SPEED_UNKNOWN if link is down */ | ||
414 | int link_speed; | ||
415 | |||
416 | /* auto-neg advertisement or force mode config */ | ||
417 | u32 adv_cfg; | ||
418 | u8 flowctrl; | ||
419 | |||
420 | u32 sleep_ctrl; | ||
421 | |||
422 | spinlock_t mdio_lock; | ||
423 | struct mdio_if_info mdio; | ||
424 | u16 phy_id[2]; | ||
425 | |||
426 | /* PHY link patch flag */ | ||
427 | bool lnk_patch; | ||
428 | }; | ||
429 | |||
430 | static inline int alx_hw_revision(struct alx_hw *hw) | ||
431 | { | ||
432 | return hw->pdev->revision >> ALX_PCI_REVID_SHIFT; | ||
433 | } | ||
434 | |||
435 | static inline bool alx_hw_with_cr(struct alx_hw *hw) | ||
436 | { | ||
437 | return hw->pdev->revision & 1; | ||
438 | } | ||
439 | |||
440 | static inline bool alx_hw_giga(struct alx_hw *hw) | ||
441 | { | ||
442 | return hw->pdev->device & 1; | ||
443 | } | ||
444 | |||
445 | static inline void alx_write_mem8(struct alx_hw *hw, u32 reg, u8 val) | ||
446 | { | ||
447 | writeb(val, hw->hw_addr + reg); | ||
448 | } | ||
449 | |||
450 | static inline void alx_write_mem16(struct alx_hw *hw, u32 reg, u16 val) | ||
451 | { | ||
452 | writew(val, hw->hw_addr + reg); | ||
453 | } | ||
454 | |||
455 | static inline u16 alx_read_mem16(struct alx_hw *hw, u32 reg) | ||
456 | { | ||
457 | return readw(hw->hw_addr + reg); | ||
458 | } | ||
459 | |||
460 | static inline void alx_write_mem32(struct alx_hw *hw, u32 reg, u32 val) | ||
461 | { | ||
462 | writel(val, hw->hw_addr + reg); | ||
463 | } | ||
464 | |||
465 | static inline u32 alx_read_mem32(struct alx_hw *hw, u32 reg) | ||
466 | { | ||
467 | return readl(hw->hw_addr + reg); | ||
468 | } | ||
469 | |||
470 | static inline void alx_post_write(struct alx_hw *hw) | ||
471 | { | ||
472 | readl(hw->hw_addr); | ||
473 | } | ||
474 | |||
475 | int alx_get_perm_macaddr(struct alx_hw *hw, u8 *addr); | ||
476 | void alx_reset_phy(struct alx_hw *hw); | ||
477 | void alx_reset_pcie(struct alx_hw *hw); | ||
478 | void alx_enable_aspm(struct alx_hw *hw, bool l0s_en, bool l1_en); | ||
479 | int alx_setup_speed_duplex(struct alx_hw *hw, u32 ethadv, u8 flowctrl); | ||
480 | void alx_post_phy_link(struct alx_hw *hw); | ||
481 | int alx_pre_suspend(struct alx_hw *hw, int speed); | ||
482 | int alx_read_phy_reg(struct alx_hw *hw, u16 reg, u16 *phy_data); | ||
483 | int alx_write_phy_reg(struct alx_hw *hw, u16 reg, u16 phy_data); | ||
484 | int alx_read_phy_ext(struct alx_hw *hw, u8 dev, u16 reg, u16 *pdata); | ||
485 | int alx_write_phy_ext(struct alx_hw *hw, u8 dev, u16 reg, u16 data); | ||
486 | int alx_get_phy_link(struct alx_hw *hw, int *speed); | ||
487 | int alx_clear_phy_intr(struct alx_hw *hw); | ||
488 | int alx_config_wol(struct alx_hw *hw); | ||
489 | void alx_cfg_mac_flowcontrol(struct alx_hw *hw, u8 fc); | ||
490 | void alx_start_mac(struct alx_hw *hw); | ||
491 | int alx_reset_mac(struct alx_hw *hw); | ||
492 | void alx_set_macaddr(struct alx_hw *hw, const u8 *addr); | ||
493 | bool alx_phy_configured(struct alx_hw *hw); | ||
494 | void alx_configure_basic(struct alx_hw *hw); | ||
495 | void alx_disable_rss(struct alx_hw *hw); | ||
496 | int alx_select_powersaving_speed(struct alx_hw *hw, int *speed); | ||
497 | bool alx_get_phy_info(struct alx_hw *hw); | ||
498 | |||
499 | #endif | ||
diff --git a/drivers/net/ethernet/atheros/alx/main.c b/drivers/net/ethernet/atheros/alx/main.c new file mode 100644 index 000000000000..418de8b13165 --- /dev/null +++ b/drivers/net/ethernet/atheros/alx/main.c | |||
@@ -0,0 +1,1625 @@ | |||
1 | /* | ||
2 | * Copyright (c) 2013 Johannes Berg <johannes@sipsolutions.net> | ||
3 | * | ||
4 | * This file is free software: you may copy, redistribute and/or modify it | ||
5 | * under the terms of the GNU General Public License as published by the | ||
6 | * Free Software Foundation, either version 2 of the License, or (at your | ||
7 | * option) any later version. | ||
8 | * | ||
9 | * This file is distributed in the hope that it will be useful, but | ||
10 | * WITHOUT ANY WARRANTY; without even the implied warranty of | ||
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
12 | * General Public License for more details. | ||
13 | * | ||
14 | * You should have received a copy of the GNU General Public License | ||
15 | * along with this program. If not, see <http://www.gnu.org/licenses/>. | ||
16 | * | ||
17 | * This file incorporates work covered by the following copyright and | ||
18 | * permission notice: | ||
19 | * | ||
20 | * Copyright (c) 2012 Qualcomm Atheros, Inc. | ||
21 | * | ||
22 | * Permission to use, copy, modify, and/or distribute this software for any | ||
23 | * purpose with or without fee is hereby granted, provided that the above | ||
24 | * copyright notice and this permission notice appear in all copies. | ||
25 | * | ||
26 | * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES | ||
27 | * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF | ||
28 | * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR | ||
29 | * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES | ||
30 | * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN | ||
31 | * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF | ||
32 | * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. | ||
33 | */ | ||
34 | |||
35 | #include <linux/module.h> | ||
36 | #include <linux/pci.h> | ||
37 | #include <linux/interrupt.h> | ||
38 | #include <linux/ip.h> | ||
39 | #include <linux/ipv6.h> | ||
40 | #include <linux/if_vlan.h> | ||
41 | #include <linux/mdio.h> | ||
42 | #include <linux/aer.h> | ||
43 | #include <linux/bitops.h> | ||
44 | #include <linux/netdevice.h> | ||
45 | #include <linux/etherdevice.h> | ||
46 | #include <net/ip6_checksum.h> | ||
47 | #include <linux/crc32.h> | ||
48 | #include "alx.h" | ||
49 | #include "hw.h" | ||
50 | #include "reg.h" | ||
51 | |||
52 | const char alx_drv_name[] = "alx"; | ||
53 | |||
54 | |||
55 | static void alx_free_txbuf(struct alx_priv *alx, int entry) | ||
56 | { | ||
57 | struct alx_buffer *txb = &alx->txq.bufs[entry]; | ||
58 | |||
59 | if (dma_unmap_len(txb, size)) { | ||
60 | dma_unmap_single(&alx->hw.pdev->dev, | ||
61 | dma_unmap_addr(txb, dma), | ||
62 | dma_unmap_len(txb, size), | ||
63 | DMA_TO_DEVICE); | ||
64 | dma_unmap_len_set(txb, size, 0); | ||
65 | } | ||
66 | |||
67 | if (txb->skb) { | ||
68 | dev_kfree_skb_any(txb->skb); | ||
69 | txb->skb = NULL; | ||
70 | } | ||
71 | } | ||
72 | |||
73 | static int alx_refill_rx_ring(struct alx_priv *alx, gfp_t gfp) | ||
74 | { | ||
75 | struct alx_rx_queue *rxq = &alx->rxq; | ||
76 | struct sk_buff *skb; | ||
77 | struct alx_buffer *cur_buf; | ||
78 | dma_addr_t dma; | ||
79 | u16 cur, next, count = 0; | ||
80 | |||
81 | next = cur = rxq->write_idx; | ||
82 | if (++next == alx->rx_ringsz) | ||
83 | next = 0; | ||
84 | cur_buf = &rxq->bufs[cur]; | ||
85 | |||
86 | while (!cur_buf->skb && next != rxq->read_idx) { | ||
87 | struct alx_rfd *rfd = &rxq->rfd[cur]; | ||
88 | |||
89 | skb = __netdev_alloc_skb(alx->dev, alx->rxbuf_size, gfp); | ||
90 | if (!skb) | ||
91 | break; | ||
92 | dma = dma_map_single(&alx->hw.pdev->dev, | ||
93 | skb->data, alx->rxbuf_size, | ||
94 | DMA_FROM_DEVICE); | ||
95 | if (dma_mapping_error(&alx->hw.pdev->dev, dma)) { | ||
96 | dev_kfree_skb(skb); | ||
97 | break; | ||
98 | } | ||
99 | |||
100 | /* Unfortunately, RX descriptor buffers must be 4-byte | ||
101 | * aligned, so we can't use IP alignment. | ||
102 | */ | ||
103 | if (WARN_ON(dma & 3)) { | ||
104 | dev_kfree_skb(skb); | ||
105 | break; | ||
106 | } | ||
107 | |||
108 | cur_buf->skb = skb; | ||
109 | dma_unmap_len_set(cur_buf, size, alx->rxbuf_size); | ||
110 | dma_unmap_addr_set(cur_buf, dma, dma); | ||
111 | rfd->addr = cpu_to_le64(dma); | ||
112 | |||
113 | cur = next; | ||
114 | if (++next == alx->rx_ringsz) | ||
115 | next = 0; | ||
116 | cur_buf = &rxq->bufs[cur]; | ||
117 | count++; | ||
118 | } | ||
119 | |||
120 | if (count) { | ||
121 | /* flush all updates before updating hardware */ | ||
122 | wmb(); | ||
123 | rxq->write_idx = cur; | ||
124 | alx_write_mem16(&alx->hw, ALX_RFD_PIDX, cur); | ||
125 | } | ||
126 | |||
127 | return count; | ||
128 | } | ||
129 | |||
130 | static inline int alx_tpd_avail(struct alx_priv *alx) | ||
131 | { | ||
132 | struct alx_tx_queue *txq = &alx->txq; | ||
133 | |||
134 | if (txq->write_idx >= txq->read_idx) | ||
135 | return alx->tx_ringsz + txq->read_idx - txq->write_idx - 1; | ||
136 | return txq->read_idx - txq->write_idx - 1; | ||
137 | } | ||
138 | |||
139 | static bool alx_clean_tx_irq(struct alx_priv *alx) | ||
140 | { | ||
141 | struct alx_tx_queue *txq = &alx->txq; | ||
142 | u16 hw_read_idx, sw_read_idx; | ||
143 | unsigned int total_bytes = 0, total_packets = 0; | ||
144 | int budget = ALX_DEFAULT_TX_WORK; | ||
145 | |||
146 | sw_read_idx = txq->read_idx; | ||
147 | hw_read_idx = alx_read_mem16(&alx->hw, ALX_TPD_PRI0_CIDX); | ||
148 | |||
149 | if (sw_read_idx != hw_read_idx) { | ||
150 | while (sw_read_idx != hw_read_idx && budget > 0) { | ||
151 | struct sk_buff *skb; | ||
152 | |||
153 | skb = txq->bufs[sw_read_idx].skb; | ||
154 | if (skb) { | ||
155 | total_bytes += skb->len; | ||
156 | total_packets++; | ||
157 | budget--; | ||
158 | } | ||
159 | |||
160 | alx_free_txbuf(alx, sw_read_idx); | ||
161 | |||
162 | if (++sw_read_idx == alx->tx_ringsz) | ||
163 | sw_read_idx = 0; | ||
164 | } | ||
165 | txq->read_idx = sw_read_idx; | ||
166 | |||
167 | netdev_completed_queue(alx->dev, total_packets, total_bytes); | ||
168 | } | ||
169 | |||
170 | if (netif_queue_stopped(alx->dev) && netif_carrier_ok(alx->dev) && | ||
171 | alx_tpd_avail(alx) > alx->tx_ringsz/4) | ||
172 | netif_wake_queue(alx->dev); | ||
173 | |||
174 | return sw_read_idx == hw_read_idx; | ||
175 | } | ||
176 | |||
177 | static void alx_schedule_link_check(struct alx_priv *alx) | ||
178 | { | ||
179 | schedule_work(&alx->link_check_wk); | ||
180 | } | ||
181 | |||
182 | static void alx_schedule_reset(struct alx_priv *alx) | ||
183 | { | ||
184 | schedule_work(&alx->reset_wk); | ||
185 | } | ||
186 | |||
187 | static bool alx_clean_rx_irq(struct alx_priv *alx, int budget) | ||
188 | { | ||
189 | struct alx_rx_queue *rxq = &alx->rxq; | ||
190 | struct alx_rrd *rrd; | ||
191 | struct alx_buffer *rxb; | ||
192 | struct sk_buff *skb; | ||
193 | u16 length, rfd_cleaned = 0; | ||
194 | |||
195 | while (budget > 0) { | ||
196 | rrd = &rxq->rrd[rxq->rrd_read_idx]; | ||
197 | if (!(rrd->word3 & cpu_to_le32(1 << RRD_UPDATED_SHIFT))) | ||
198 | break; | ||
199 | rrd->word3 &= ~cpu_to_le32(1 << RRD_UPDATED_SHIFT); | ||
200 | |||
201 | if (ALX_GET_FIELD(le32_to_cpu(rrd->word0), | ||
202 | RRD_SI) != rxq->read_idx || | ||
203 | ALX_GET_FIELD(le32_to_cpu(rrd->word0), | ||
204 | RRD_NOR) != 1) { | ||
205 | alx_schedule_reset(alx); | ||
206 | return 0; | ||
207 | } | ||
208 | |||
209 | rxb = &rxq->bufs[rxq->read_idx]; | ||
210 | dma_unmap_single(&alx->hw.pdev->dev, | ||
211 | dma_unmap_addr(rxb, dma), | ||
212 | dma_unmap_len(rxb, size), | ||
213 | DMA_FROM_DEVICE); | ||
214 | dma_unmap_len_set(rxb, size, 0); | ||
215 | skb = rxb->skb; | ||
216 | rxb->skb = NULL; | ||
217 | |||
218 | if (rrd->word3 & cpu_to_le32(1 << RRD_ERR_RES_SHIFT) || | ||
219 | rrd->word3 & cpu_to_le32(1 << RRD_ERR_LEN_SHIFT)) { | ||
220 | rrd->word3 = 0; | ||
221 | dev_kfree_skb_any(skb); | ||
222 | goto next_pkt; | ||
223 | } | ||
224 | |||
225 | length = ALX_GET_FIELD(le32_to_cpu(rrd->word3), | ||
226 | RRD_PKTLEN) - ETH_FCS_LEN; | ||
227 | skb_put(skb, length); | ||
228 | skb->protocol = eth_type_trans(skb, alx->dev); | ||
229 | |||
230 | skb_checksum_none_assert(skb); | ||
231 | if (alx->dev->features & NETIF_F_RXCSUM && | ||
232 | !(rrd->word3 & (cpu_to_le32(1 << RRD_ERR_L4_SHIFT) | | ||
233 | cpu_to_le32(1 << RRD_ERR_IPV4_SHIFT)))) { | ||
234 | switch (ALX_GET_FIELD(le32_to_cpu(rrd->word2), | ||
235 | RRD_PID)) { | ||
236 | case RRD_PID_IPV6UDP: | ||
237 | case RRD_PID_IPV4UDP: | ||
238 | case RRD_PID_IPV4TCP: | ||
239 | case RRD_PID_IPV6TCP: | ||
240 | skb->ip_summed = CHECKSUM_UNNECESSARY; | ||
241 | break; | ||
242 | } | ||
243 | } | ||
244 | |||
245 | napi_gro_receive(&alx->napi, skb); | ||
246 | budget--; | ||
247 | |||
248 | next_pkt: | ||
249 | if (++rxq->read_idx == alx->rx_ringsz) | ||
250 | rxq->read_idx = 0; | ||
251 | if (++rxq->rrd_read_idx == alx->rx_ringsz) | ||
252 | rxq->rrd_read_idx = 0; | ||
253 | |||
254 | if (++rfd_cleaned > ALX_RX_ALLOC_THRESH) | ||
255 | rfd_cleaned -= alx_refill_rx_ring(alx, GFP_ATOMIC); | ||
256 | } | ||
257 | |||
258 | if (rfd_cleaned) | ||
259 | alx_refill_rx_ring(alx, GFP_ATOMIC); | ||
260 | |||
261 | return budget > 0; | ||
262 | } | ||
263 | |||
264 | static int alx_poll(struct napi_struct *napi, int budget) | ||
265 | { | ||
266 | struct alx_priv *alx = container_of(napi, struct alx_priv, napi); | ||
267 | struct alx_hw *hw = &alx->hw; | ||
268 | bool complete = true; | ||
269 | unsigned long flags; | ||
270 | |||
271 | complete = alx_clean_tx_irq(alx) && | ||
272 | alx_clean_rx_irq(alx, budget); | ||
273 | |||
274 | if (!complete) | ||
275 | return 1; | ||
276 | |||
277 | napi_complete(&alx->napi); | ||
278 | |||
279 | /* enable interrupt */ | ||
280 | spin_lock_irqsave(&alx->irq_lock, flags); | ||
281 | alx->int_mask |= ALX_ISR_TX_Q0 | ALX_ISR_RX_Q0; | ||
282 | alx_write_mem32(hw, ALX_IMR, alx->int_mask); | ||
283 | spin_unlock_irqrestore(&alx->irq_lock, flags); | ||
284 | |||
285 | alx_post_write(hw); | ||
286 | |||
287 | return 0; | ||
288 | } | ||
289 | |||
290 | static irqreturn_t alx_intr_handle(struct alx_priv *alx, u32 intr) | ||
291 | { | ||
292 | struct alx_hw *hw = &alx->hw; | ||
293 | bool write_int_mask = false; | ||
294 | |||
295 | spin_lock(&alx->irq_lock); | ||
296 | |||
297 | /* ACK interrupt */ | ||
298 | alx_write_mem32(hw, ALX_ISR, intr | ALX_ISR_DIS); | ||
299 | intr &= alx->int_mask; | ||
300 | |||
301 | if (intr & ALX_ISR_FATAL) { | ||
302 | netif_warn(alx, hw, alx->dev, | ||
303 | "fatal interrupt 0x%x, resetting\n", intr); | ||
304 | alx_schedule_reset(alx); | ||
305 | goto out; | ||
306 | } | ||
307 | |||
308 | if (intr & ALX_ISR_ALERT) | ||
309 | netdev_warn(alx->dev, "alert interrupt: 0x%x\n", intr); | ||
310 | |||
311 | if (intr & ALX_ISR_PHY) { | ||
312 | /* suppress PHY interrupt, because the source | ||
313 | * is from PHY internal. only the internal status | ||
314 | * is cleared, the interrupt status could be cleared. | ||
315 | */ | ||
316 | alx->int_mask &= ~ALX_ISR_PHY; | ||
317 | write_int_mask = true; | ||
318 | alx_schedule_link_check(alx); | ||
319 | } | ||
320 | |||
321 | if (intr & (ALX_ISR_TX_Q0 | ALX_ISR_RX_Q0)) { | ||
322 | napi_schedule(&alx->napi); | ||
323 | /* mask rx/tx interrupt, enable them when napi complete */ | ||
324 | alx->int_mask &= ~ALX_ISR_ALL_QUEUES; | ||
325 | write_int_mask = true; | ||
326 | } | ||
327 | |||
328 | if (write_int_mask) | ||
329 | alx_write_mem32(hw, ALX_IMR, alx->int_mask); | ||
330 | |||
331 | alx_write_mem32(hw, ALX_ISR, 0); | ||
332 | |||
333 | out: | ||
334 | spin_unlock(&alx->irq_lock); | ||
335 | return IRQ_HANDLED; | ||
336 | } | ||
337 | |||
338 | static irqreturn_t alx_intr_msi(int irq, void *data) | ||
339 | { | ||
340 | struct alx_priv *alx = data; | ||
341 | |||
342 | return alx_intr_handle(alx, alx_read_mem32(&alx->hw, ALX_ISR)); | ||
343 | } | ||
344 | |||
345 | static irqreturn_t alx_intr_legacy(int irq, void *data) | ||
346 | { | ||
347 | struct alx_priv *alx = data; | ||
348 | struct alx_hw *hw = &alx->hw; | ||
349 | u32 intr; | ||
350 | |||
351 | intr = alx_read_mem32(hw, ALX_ISR); | ||
352 | |||
353 | if (intr & ALX_ISR_DIS || !(intr & alx->int_mask)) | ||
354 | return IRQ_NONE; | ||
355 | |||
356 | return alx_intr_handle(alx, intr); | ||
357 | } | ||
358 | |||
359 | static void alx_init_ring_ptrs(struct alx_priv *alx) | ||
360 | { | ||
361 | struct alx_hw *hw = &alx->hw; | ||
362 | u32 addr_hi = ((u64)alx->descmem.dma) >> 32; | ||
363 | |||
364 | alx->rxq.read_idx = 0; | ||
365 | alx->rxq.write_idx = 0; | ||
366 | alx->rxq.rrd_read_idx = 0; | ||
367 | alx_write_mem32(hw, ALX_RX_BASE_ADDR_HI, addr_hi); | ||
368 | alx_write_mem32(hw, ALX_RRD_ADDR_LO, alx->rxq.rrd_dma); | ||
369 | alx_write_mem32(hw, ALX_RRD_RING_SZ, alx->rx_ringsz); | ||
370 | alx_write_mem32(hw, ALX_RFD_ADDR_LO, alx->rxq.rfd_dma); | ||
371 | alx_write_mem32(hw, ALX_RFD_RING_SZ, alx->rx_ringsz); | ||
372 | alx_write_mem32(hw, ALX_RFD_BUF_SZ, alx->rxbuf_size); | ||
373 | |||
374 | alx->txq.read_idx = 0; | ||
375 | alx->txq.write_idx = 0; | ||
376 | alx_write_mem32(hw, ALX_TX_BASE_ADDR_HI, addr_hi); | ||
377 | alx_write_mem32(hw, ALX_TPD_PRI0_ADDR_LO, alx->txq.tpd_dma); | ||
378 | alx_write_mem32(hw, ALX_TPD_RING_SZ, alx->tx_ringsz); | ||
379 | |||
380 | /* load these pointers into the chip */ | ||
381 | alx_write_mem32(hw, ALX_SRAM9, ALX_SRAM_LOAD_PTR); | ||
382 | } | ||
383 | |||
384 | static void alx_free_txring_buf(struct alx_priv *alx) | ||
385 | { | ||
386 | struct alx_tx_queue *txq = &alx->txq; | ||
387 | int i; | ||
388 | |||
389 | if (!txq->bufs) | ||
390 | return; | ||
391 | |||
392 | for (i = 0; i < alx->tx_ringsz; i++) | ||
393 | alx_free_txbuf(alx, i); | ||
394 | |||
395 | memset(txq->bufs, 0, alx->tx_ringsz * sizeof(struct alx_buffer)); | ||
396 | memset(txq->tpd, 0, alx->tx_ringsz * sizeof(struct alx_txd)); | ||
397 | txq->write_idx = 0; | ||
398 | txq->read_idx = 0; | ||
399 | |||
400 | netdev_reset_queue(alx->dev); | ||
401 | } | ||
402 | |||
403 | static void alx_free_rxring_buf(struct alx_priv *alx) | ||
404 | { | ||
405 | struct alx_rx_queue *rxq = &alx->rxq; | ||
406 | struct alx_buffer *cur_buf; | ||
407 | u16 i; | ||
408 | |||
409 | if (rxq == NULL) | ||
410 | return; | ||
411 | |||
412 | for (i = 0; i < alx->rx_ringsz; i++) { | ||
413 | cur_buf = rxq->bufs + i; | ||
414 | if (cur_buf->skb) { | ||
415 | dma_unmap_single(&alx->hw.pdev->dev, | ||
416 | dma_unmap_addr(cur_buf, dma), | ||
417 | dma_unmap_len(cur_buf, size), | ||
418 | DMA_FROM_DEVICE); | ||
419 | dev_kfree_skb(cur_buf->skb); | ||
420 | cur_buf->skb = NULL; | ||
421 | dma_unmap_len_set(cur_buf, size, 0); | ||
422 | dma_unmap_addr_set(cur_buf, dma, 0); | ||
423 | } | ||
424 | } | ||
425 | |||
426 | rxq->write_idx = 0; | ||
427 | rxq->read_idx = 0; | ||
428 | rxq->rrd_read_idx = 0; | ||
429 | } | ||
430 | |||
431 | static void alx_free_buffers(struct alx_priv *alx) | ||
432 | { | ||
433 | alx_free_txring_buf(alx); | ||
434 | alx_free_rxring_buf(alx); | ||
435 | } | ||
436 | |||
437 | static int alx_reinit_rings(struct alx_priv *alx) | ||
438 | { | ||
439 | alx_free_buffers(alx); | ||
440 | |||
441 | alx_init_ring_ptrs(alx); | ||
442 | |||
443 | if (!alx_refill_rx_ring(alx, GFP_KERNEL)) | ||
444 | return -ENOMEM; | ||
445 | |||
446 | return 0; | ||
447 | } | ||
448 | |||
449 | static void alx_add_mc_addr(struct alx_hw *hw, const u8 *addr, u32 *mc_hash) | ||
450 | { | ||
451 | u32 crc32, bit, reg; | ||
452 | |||
453 | crc32 = ether_crc(ETH_ALEN, addr); | ||
454 | reg = (crc32 >> 31) & 0x1; | ||
455 | bit = (crc32 >> 26) & 0x1F; | ||
456 | |||
457 | mc_hash[reg] |= BIT(bit); | ||
458 | } | ||
459 | |||
460 | static void __alx_set_rx_mode(struct net_device *netdev) | ||
461 | { | ||
462 | struct alx_priv *alx = netdev_priv(netdev); | ||
463 | struct alx_hw *hw = &alx->hw; | ||
464 | struct netdev_hw_addr *ha; | ||
465 | u32 mc_hash[2] = {}; | ||
466 | |||
467 | if (!(netdev->flags & IFF_ALLMULTI)) { | ||
468 | netdev_for_each_mc_addr(ha, netdev) | ||
469 | alx_add_mc_addr(hw, ha->addr, mc_hash); | ||
470 | |||
471 | alx_write_mem32(hw, ALX_HASH_TBL0, mc_hash[0]); | ||
472 | alx_write_mem32(hw, ALX_HASH_TBL1, mc_hash[1]); | ||
473 | } | ||
474 | |||
475 | hw->rx_ctrl &= ~(ALX_MAC_CTRL_MULTIALL_EN | ALX_MAC_CTRL_PROMISC_EN); | ||
476 | if (netdev->flags & IFF_PROMISC) | ||
477 | hw->rx_ctrl |= ALX_MAC_CTRL_PROMISC_EN; | ||
478 | if (netdev->flags & IFF_ALLMULTI) | ||
479 | hw->rx_ctrl |= ALX_MAC_CTRL_MULTIALL_EN; | ||
480 | |||
481 | alx_write_mem32(hw, ALX_MAC_CTRL, hw->rx_ctrl); | ||
482 | } | ||
483 | |||
484 | static void alx_set_rx_mode(struct net_device *netdev) | ||
485 | { | ||
486 | __alx_set_rx_mode(netdev); | ||
487 | } | ||
488 | |||
489 | static int alx_set_mac_address(struct net_device *netdev, void *data) | ||
490 | { | ||
491 | struct alx_priv *alx = netdev_priv(netdev); | ||
492 | struct alx_hw *hw = &alx->hw; | ||
493 | struct sockaddr *addr = data; | ||
494 | |||
495 | if (!is_valid_ether_addr(addr->sa_data)) | ||
496 | return -EADDRNOTAVAIL; | ||
497 | |||
498 | if (netdev->addr_assign_type & NET_ADDR_RANDOM) | ||
499 | netdev->addr_assign_type ^= NET_ADDR_RANDOM; | ||
500 | |||
501 | memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len); | ||
502 | memcpy(hw->mac_addr, addr->sa_data, netdev->addr_len); | ||
503 | alx_set_macaddr(hw, hw->mac_addr); | ||
504 | |||
505 | return 0; | ||
506 | } | ||
507 | |||
508 | static int alx_alloc_descriptors(struct alx_priv *alx) | ||
509 | { | ||
510 | alx->txq.bufs = kcalloc(alx->tx_ringsz, | ||
511 | sizeof(struct alx_buffer), | ||
512 | GFP_KERNEL); | ||
513 | if (!alx->txq.bufs) | ||
514 | return -ENOMEM; | ||
515 | |||
516 | alx->rxq.bufs = kcalloc(alx->rx_ringsz, | ||
517 | sizeof(struct alx_buffer), | ||
518 | GFP_KERNEL); | ||
519 | if (!alx->rxq.bufs) | ||
520 | goto out_free; | ||
521 | |||
522 | /* physical tx/rx ring descriptors | ||
523 | * | ||
524 | * Allocate them as a single chunk because they must not cross a | ||
525 | * 4G boundary (hardware has a single register for high 32 bits | ||
526 | * of addresses only) | ||
527 | */ | ||
528 | alx->descmem.size = sizeof(struct alx_txd) * alx->tx_ringsz + | ||
529 | sizeof(struct alx_rrd) * alx->rx_ringsz + | ||
530 | sizeof(struct alx_rfd) * alx->rx_ringsz; | ||
531 | alx->descmem.virt = dma_zalloc_coherent(&alx->hw.pdev->dev, | ||
532 | alx->descmem.size, | ||
533 | &alx->descmem.dma, | ||
534 | GFP_KERNEL); | ||
535 | if (!alx->descmem.virt) | ||
536 | goto out_free; | ||
537 | |||
538 | alx->txq.tpd = (void *)alx->descmem.virt; | ||
539 | alx->txq.tpd_dma = alx->descmem.dma; | ||
540 | |||
541 | /* alignment requirement for next block */ | ||
542 | BUILD_BUG_ON(sizeof(struct alx_txd) % 8); | ||
543 | |||
544 | alx->rxq.rrd = | ||
545 | (void *)((u8 *)alx->descmem.virt + | ||
546 | sizeof(struct alx_txd) * alx->tx_ringsz); | ||
547 | alx->rxq.rrd_dma = alx->descmem.dma + | ||
548 | sizeof(struct alx_txd) * alx->tx_ringsz; | ||
549 | |||
550 | /* alignment requirement for next block */ | ||
551 | BUILD_BUG_ON(sizeof(struct alx_rrd) % 8); | ||
552 | |||
553 | alx->rxq.rfd = | ||
554 | (void *)((u8 *)alx->descmem.virt + | ||
555 | sizeof(struct alx_txd) * alx->tx_ringsz + | ||
556 | sizeof(struct alx_rrd) * alx->rx_ringsz); | ||
557 | alx->rxq.rfd_dma = alx->descmem.dma + | ||
558 | sizeof(struct alx_txd) * alx->tx_ringsz + | ||
559 | sizeof(struct alx_rrd) * alx->rx_ringsz; | ||
560 | |||
561 | return 0; | ||
562 | out_free: | ||
563 | kfree(alx->txq.bufs); | ||
564 | kfree(alx->rxq.bufs); | ||
565 | return -ENOMEM; | ||
566 | } | ||
567 | |||
568 | static int alx_alloc_rings(struct alx_priv *alx) | ||
569 | { | ||
570 | int err; | ||
571 | |||
572 | err = alx_alloc_descriptors(alx); | ||
573 | if (err) | ||
574 | return err; | ||
575 | |||
576 | alx->int_mask &= ~ALX_ISR_ALL_QUEUES; | ||
577 | alx->int_mask |= ALX_ISR_TX_Q0 | ALX_ISR_RX_Q0; | ||
578 | alx->tx_ringsz = alx->tx_ringsz; | ||
579 | |||
580 | netif_napi_add(alx->dev, &alx->napi, alx_poll, 64); | ||
581 | |||
582 | alx_reinit_rings(alx); | ||
583 | return 0; | ||
584 | } | ||
585 | |||
586 | static void alx_free_rings(struct alx_priv *alx) | ||
587 | { | ||
588 | netif_napi_del(&alx->napi); | ||
589 | alx_free_buffers(alx); | ||
590 | |||
591 | kfree(alx->txq.bufs); | ||
592 | kfree(alx->rxq.bufs); | ||
593 | |||
594 | dma_free_coherent(&alx->hw.pdev->dev, | ||
595 | alx->descmem.size, | ||
596 | alx->descmem.virt, | ||
597 | alx->descmem.dma); | ||
598 | } | ||
599 | |||
600 | static void alx_config_vector_mapping(struct alx_priv *alx) | ||
601 | { | ||
602 | struct alx_hw *hw = &alx->hw; | ||
603 | |||
604 | alx_write_mem32(hw, ALX_MSI_MAP_TBL1, 0); | ||
605 | alx_write_mem32(hw, ALX_MSI_MAP_TBL2, 0); | ||
606 | alx_write_mem32(hw, ALX_MSI_ID_MAP, 0); | ||
607 | } | ||
608 | |||
609 | static void alx_irq_enable(struct alx_priv *alx) | ||
610 | { | ||
611 | struct alx_hw *hw = &alx->hw; | ||
612 | |||
613 | /* level-1 interrupt switch */ | ||
614 | alx_write_mem32(hw, ALX_ISR, 0); | ||
615 | alx_write_mem32(hw, ALX_IMR, alx->int_mask); | ||
616 | alx_post_write(hw); | ||
617 | } | ||
618 | |||
619 | static void alx_irq_disable(struct alx_priv *alx) | ||
620 | { | ||
621 | struct alx_hw *hw = &alx->hw; | ||
622 | |||
623 | alx_write_mem32(hw, ALX_ISR, ALX_ISR_DIS); | ||
624 | alx_write_mem32(hw, ALX_IMR, 0); | ||
625 | alx_post_write(hw); | ||
626 | |||
627 | synchronize_irq(alx->hw.pdev->irq); | ||
628 | } | ||
629 | |||
630 | static int alx_request_irq(struct alx_priv *alx) | ||
631 | { | ||
632 | struct pci_dev *pdev = alx->hw.pdev; | ||
633 | struct alx_hw *hw = &alx->hw; | ||
634 | int err; | ||
635 | u32 msi_ctrl; | ||
636 | |||
637 | msi_ctrl = (hw->imt >> 1) << ALX_MSI_RETRANS_TM_SHIFT; | ||
638 | |||
639 | if (!pci_enable_msi(alx->hw.pdev)) { | ||
640 | alx->msi = true; | ||
641 | |||
642 | alx_write_mem32(hw, ALX_MSI_RETRANS_TIMER, | ||
643 | msi_ctrl | ALX_MSI_MASK_SEL_LINE); | ||
644 | err = request_irq(pdev->irq, alx_intr_msi, 0, | ||
645 | alx->dev->name, alx); | ||
646 | if (!err) | ||
647 | goto out; | ||
648 | /* fall back to legacy interrupt */ | ||
649 | pci_disable_msi(alx->hw.pdev); | ||
650 | } | ||
651 | |||
652 | alx_write_mem32(hw, ALX_MSI_RETRANS_TIMER, 0); | ||
653 | err = request_irq(pdev->irq, alx_intr_legacy, IRQF_SHARED, | ||
654 | alx->dev->name, alx); | ||
655 | out: | ||
656 | if (!err) | ||
657 | alx_config_vector_mapping(alx); | ||
658 | return err; | ||
659 | } | ||
660 | |||
661 | static void alx_free_irq(struct alx_priv *alx) | ||
662 | { | ||
663 | struct pci_dev *pdev = alx->hw.pdev; | ||
664 | |||
665 | free_irq(pdev->irq, alx); | ||
666 | |||
667 | if (alx->msi) { | ||
668 | pci_disable_msi(alx->hw.pdev); | ||
669 | alx->msi = false; | ||
670 | } | ||
671 | } | ||
672 | |||
673 | static int alx_identify_hw(struct alx_priv *alx) | ||
674 | { | ||
675 | struct alx_hw *hw = &alx->hw; | ||
676 | int rev = alx_hw_revision(hw); | ||
677 | |||
678 | if (rev > ALX_REV_C0) | ||
679 | return -EINVAL; | ||
680 | |||
681 | hw->max_dma_chnl = rev >= ALX_REV_B0 ? 4 : 2; | ||
682 | |||
683 | return 0; | ||
684 | } | ||
685 | |||
686 | static int alx_init_sw(struct alx_priv *alx) | ||
687 | { | ||
688 | struct pci_dev *pdev = alx->hw.pdev; | ||
689 | struct alx_hw *hw = &alx->hw; | ||
690 | int err; | ||
691 | |||
692 | err = alx_identify_hw(alx); | ||
693 | if (err) { | ||
694 | dev_err(&pdev->dev, "unrecognized chip, aborting\n"); | ||
695 | return err; | ||
696 | } | ||
697 | |||
698 | alx->hw.lnk_patch = | ||
699 | pdev->device == ALX_DEV_ID_AR8161 && | ||
700 | pdev->subsystem_vendor == PCI_VENDOR_ID_ATTANSIC && | ||
701 | pdev->subsystem_device == 0x0091 && | ||
702 | pdev->revision == 0; | ||
703 | |||
704 | hw->smb_timer = 400; | ||
705 | hw->mtu = alx->dev->mtu; | ||
706 | alx->rxbuf_size = ALIGN(ALX_RAW_MTU(hw->mtu), 8); | ||
707 | alx->tx_ringsz = 256; | ||
708 | alx->rx_ringsz = 512; | ||
709 | hw->sleep_ctrl = ALX_SLEEP_WOL_MAGIC | ALX_SLEEP_WOL_PHY; | ||
710 | hw->imt = 200; | ||
711 | alx->int_mask = ALX_ISR_MISC; | ||
712 | hw->dma_chnl = hw->max_dma_chnl; | ||
713 | hw->ith_tpd = alx->tx_ringsz / 3; | ||
714 | hw->link_speed = SPEED_UNKNOWN; | ||
715 | hw->adv_cfg = ADVERTISED_Autoneg | | ||
716 | ADVERTISED_10baseT_Half | | ||
717 | ADVERTISED_10baseT_Full | | ||
718 | ADVERTISED_100baseT_Full | | ||
719 | ADVERTISED_100baseT_Half | | ||
720 | ADVERTISED_1000baseT_Full; | ||
721 | hw->flowctrl = ALX_FC_ANEG | ALX_FC_RX | ALX_FC_TX; | ||
722 | |||
723 | hw->rx_ctrl = ALX_MAC_CTRL_WOLSPED_SWEN | | ||
724 | ALX_MAC_CTRL_MHASH_ALG_HI5B | | ||
725 | ALX_MAC_CTRL_BRD_EN | | ||
726 | ALX_MAC_CTRL_PCRCE | | ||
727 | ALX_MAC_CTRL_CRCE | | ||
728 | ALX_MAC_CTRL_RXFC_EN | | ||
729 | ALX_MAC_CTRL_TXFC_EN | | ||
730 | 7 << ALX_MAC_CTRL_PRMBLEN_SHIFT; | ||
731 | |||
732 | return err; | ||
733 | } | ||
734 | |||
735 | |||
736 | static netdev_features_t alx_fix_features(struct net_device *netdev, | ||
737 | netdev_features_t features) | ||
738 | { | ||
739 | if (netdev->mtu > ALX_MAX_TSO_PKT_SIZE) | ||
740 | features &= ~(NETIF_F_TSO | NETIF_F_TSO6); | ||
741 | |||
742 | return features; | ||
743 | } | ||
744 | |||
745 | static void alx_netif_stop(struct alx_priv *alx) | ||
746 | { | ||
747 | alx->dev->trans_start = jiffies; | ||
748 | if (netif_carrier_ok(alx->dev)) { | ||
749 | netif_carrier_off(alx->dev); | ||
750 | netif_tx_disable(alx->dev); | ||
751 | napi_disable(&alx->napi); | ||
752 | } | ||
753 | } | ||
754 | |||
755 | static void alx_halt(struct alx_priv *alx) | ||
756 | { | ||
757 | struct alx_hw *hw = &alx->hw; | ||
758 | |||
759 | alx_netif_stop(alx); | ||
760 | hw->link_speed = SPEED_UNKNOWN; | ||
761 | |||
762 | alx_reset_mac(hw); | ||
763 | |||
764 | /* disable l0s/l1 */ | ||
765 | alx_enable_aspm(hw, false, false); | ||
766 | alx_irq_disable(alx); | ||
767 | alx_free_buffers(alx); | ||
768 | } | ||
769 | |||
770 | static void alx_configure(struct alx_priv *alx) | ||
771 | { | ||
772 | struct alx_hw *hw = &alx->hw; | ||
773 | |||
774 | alx_configure_basic(hw); | ||
775 | alx_disable_rss(hw); | ||
776 | __alx_set_rx_mode(alx->dev); | ||
777 | |||
778 | alx_write_mem32(hw, ALX_MAC_CTRL, hw->rx_ctrl); | ||
779 | } | ||
780 | |||
781 | static void alx_activate(struct alx_priv *alx) | ||
782 | { | ||
783 | /* hardware setting lost, restore it */ | ||
784 | alx_reinit_rings(alx); | ||
785 | alx_configure(alx); | ||
786 | |||
787 | /* clear old interrupts */ | ||
788 | alx_write_mem32(&alx->hw, ALX_ISR, ~(u32)ALX_ISR_DIS); | ||
789 | |||
790 | alx_irq_enable(alx); | ||
791 | |||
792 | alx_schedule_link_check(alx); | ||
793 | } | ||
794 | |||
795 | static void alx_reinit(struct alx_priv *alx) | ||
796 | { | ||
797 | ASSERT_RTNL(); | ||
798 | |||
799 | alx_halt(alx); | ||
800 | alx_activate(alx); | ||
801 | } | ||
802 | |||
803 | static int alx_change_mtu(struct net_device *netdev, int mtu) | ||
804 | { | ||
805 | struct alx_priv *alx = netdev_priv(netdev); | ||
806 | int max_frame = mtu + ETH_HLEN + ETH_FCS_LEN + VLAN_HLEN; | ||
807 | |||
808 | if ((max_frame < ALX_MIN_FRAME_SIZE) || | ||
809 | (max_frame > ALX_MAX_FRAME_SIZE)) | ||
810 | return -EINVAL; | ||
811 | |||
812 | if (netdev->mtu == mtu) | ||
813 | return 0; | ||
814 | |||
815 | netdev->mtu = mtu; | ||
816 | alx->hw.mtu = mtu; | ||
817 | alx->rxbuf_size = mtu > ALX_DEF_RXBUF_SIZE ? | ||
818 | ALIGN(max_frame, 8) : ALX_DEF_RXBUF_SIZE; | ||
819 | netdev_update_features(netdev); | ||
820 | if (netif_running(netdev)) | ||
821 | alx_reinit(alx); | ||
822 | return 0; | ||
823 | } | ||
824 | |||
825 | static void alx_netif_start(struct alx_priv *alx) | ||
826 | { | ||
827 | netif_tx_wake_all_queues(alx->dev); | ||
828 | napi_enable(&alx->napi); | ||
829 | netif_carrier_on(alx->dev); | ||
830 | } | ||
831 | |||
832 | static int __alx_open(struct alx_priv *alx, bool resume) | ||
833 | { | ||
834 | int err; | ||
835 | |||
836 | if (!resume) | ||
837 | netif_carrier_off(alx->dev); | ||
838 | |||
839 | err = alx_alloc_rings(alx); | ||
840 | if (err) | ||
841 | return err; | ||
842 | |||
843 | alx_configure(alx); | ||
844 | |||
845 | err = alx_request_irq(alx); | ||
846 | if (err) | ||
847 | goto out_free_rings; | ||
848 | |||
849 | /* clear old interrupts */ | ||
850 | alx_write_mem32(&alx->hw, ALX_ISR, ~(u32)ALX_ISR_DIS); | ||
851 | |||
852 | alx_irq_enable(alx); | ||
853 | |||
854 | if (!resume) | ||
855 | netif_tx_start_all_queues(alx->dev); | ||
856 | |||
857 | alx_schedule_link_check(alx); | ||
858 | return 0; | ||
859 | |||
860 | out_free_rings: | ||
861 | alx_free_rings(alx); | ||
862 | return err; | ||
863 | } | ||
864 | |||
865 | static void __alx_stop(struct alx_priv *alx) | ||
866 | { | ||
867 | alx_halt(alx); | ||
868 | alx_free_irq(alx); | ||
869 | alx_free_rings(alx); | ||
870 | } | ||
871 | |||
872 | static const char *alx_speed_desc(u16 speed) | ||
873 | { | ||
874 | switch (speed) { | ||
875 | case SPEED_1000 + DUPLEX_FULL: | ||
876 | return "1 Gbps Full"; | ||
877 | case SPEED_100 + DUPLEX_FULL: | ||
878 | return "100 Mbps Full"; | ||
879 | case SPEED_100 + DUPLEX_HALF: | ||
880 | return "100 Mbps Half"; | ||
881 | case SPEED_10 + DUPLEX_FULL: | ||
882 | return "10 Mbps Full"; | ||
883 | case SPEED_10 + DUPLEX_HALF: | ||
884 | return "10 Mbps Half"; | ||
885 | default: | ||
886 | return "Unknown speed"; | ||
887 | } | ||
888 | } | ||
889 | |||
890 | static void alx_check_link(struct alx_priv *alx) | ||
891 | { | ||
892 | struct alx_hw *hw = &alx->hw; | ||
893 | unsigned long flags; | ||
894 | int speed, old_speed; | ||
895 | int err; | ||
896 | |||
897 | /* clear PHY internal interrupt status, otherwise the main | ||
898 | * interrupt status will be asserted forever | ||
899 | */ | ||
900 | alx_clear_phy_intr(hw); | ||
901 | |||
902 | err = alx_get_phy_link(hw, &speed); | ||
903 | if (err < 0) | ||
904 | goto reset; | ||
905 | |||
906 | spin_lock_irqsave(&alx->irq_lock, flags); | ||
907 | alx->int_mask |= ALX_ISR_PHY; | ||
908 | alx_write_mem32(hw, ALX_IMR, alx->int_mask); | ||
909 | spin_unlock_irqrestore(&alx->irq_lock, flags); | ||
910 | |||
911 | old_speed = hw->link_speed; | ||
912 | |||
913 | if (old_speed == speed) | ||
914 | return; | ||
915 | hw->link_speed = speed; | ||
916 | |||
917 | if (speed != SPEED_UNKNOWN) { | ||
918 | netif_info(alx, link, alx->dev, | ||
919 | "NIC Up: %s\n", alx_speed_desc(speed)); | ||
920 | alx_post_phy_link(hw); | ||
921 | alx_enable_aspm(hw, true, true); | ||
922 | alx_start_mac(hw); | ||
923 | |||
924 | if (old_speed == SPEED_UNKNOWN) | ||
925 | alx_netif_start(alx); | ||
926 | } else { | ||
927 | /* link is now down */ | ||
928 | alx_netif_stop(alx); | ||
929 | netif_info(alx, link, alx->dev, "Link Down\n"); | ||
930 | err = alx_reset_mac(hw); | ||
931 | if (err) | ||
932 | goto reset; | ||
933 | alx_irq_disable(alx); | ||
934 | |||
935 | /* MAC reset causes all HW settings to be lost, restore all */ | ||
936 | err = alx_reinit_rings(alx); | ||
937 | if (err) | ||
938 | goto reset; | ||
939 | alx_configure(alx); | ||
940 | alx_enable_aspm(hw, false, true); | ||
941 | alx_post_phy_link(hw); | ||
942 | alx_irq_enable(alx); | ||
943 | } | ||
944 | |||
945 | return; | ||
946 | |||
947 | reset: | ||
948 | alx_schedule_reset(alx); | ||
949 | } | ||
950 | |||
951 | static int alx_open(struct net_device *netdev) | ||
952 | { | ||
953 | return __alx_open(netdev_priv(netdev), false); | ||
954 | } | ||
955 | |||
956 | static int alx_stop(struct net_device *netdev) | ||
957 | { | ||
958 | __alx_stop(netdev_priv(netdev)); | ||
959 | return 0; | ||
960 | } | ||
961 | |||
962 | static int __alx_shutdown(struct pci_dev *pdev, bool *wol_en) | ||
963 | { | ||
964 | struct alx_priv *alx = pci_get_drvdata(pdev); | ||
965 | struct net_device *netdev = alx->dev; | ||
966 | struct alx_hw *hw = &alx->hw; | ||
967 | int err, speed; | ||
968 | |||
969 | netif_device_detach(netdev); | ||
970 | |||
971 | if (netif_running(netdev)) | ||
972 | __alx_stop(alx); | ||
973 | |||
974 | #ifdef CONFIG_PM_SLEEP | ||
975 | err = pci_save_state(pdev); | ||
976 | if (err) | ||
977 | return err; | ||
978 | #endif | ||
979 | |||
980 | err = alx_select_powersaving_speed(hw, &speed); | ||
981 | if (err) | ||
982 | return err; | ||
983 | err = alx_clear_phy_intr(hw); | ||
984 | if (err) | ||
985 | return err; | ||
986 | err = alx_pre_suspend(hw, speed); | ||
987 | if (err) | ||
988 | return err; | ||
989 | err = alx_config_wol(hw); | ||
990 | if (err) | ||
991 | return err; | ||
992 | |||
993 | *wol_en = false; | ||
994 | if (hw->sleep_ctrl & ALX_SLEEP_ACTIVE) { | ||
995 | netif_info(alx, wol, netdev, | ||
996 | "wol: ctrl=%X, speed=%X\n", | ||
997 | hw->sleep_ctrl, speed); | ||
998 | device_set_wakeup_enable(&pdev->dev, true); | ||
999 | *wol_en = true; | ||
1000 | } | ||
1001 | |||
1002 | pci_disable_device(pdev); | ||
1003 | |||
1004 | return 0; | ||
1005 | } | ||
1006 | |||
1007 | static void alx_shutdown(struct pci_dev *pdev) | ||
1008 | { | ||
1009 | int err; | ||
1010 | bool wol_en; | ||
1011 | |||
1012 | err = __alx_shutdown(pdev, &wol_en); | ||
1013 | if (!err) { | ||
1014 | pci_wake_from_d3(pdev, wol_en); | ||
1015 | pci_set_power_state(pdev, PCI_D3hot); | ||
1016 | } else { | ||
1017 | dev_err(&pdev->dev, "shutdown fail %d\n", err); | ||
1018 | } | ||
1019 | } | ||
1020 | |||
1021 | static void alx_link_check(struct work_struct *work) | ||
1022 | { | ||
1023 | struct alx_priv *alx; | ||
1024 | |||
1025 | alx = container_of(work, struct alx_priv, link_check_wk); | ||
1026 | |||
1027 | rtnl_lock(); | ||
1028 | alx_check_link(alx); | ||
1029 | rtnl_unlock(); | ||
1030 | } | ||
1031 | |||
1032 | static void alx_reset(struct work_struct *work) | ||
1033 | { | ||
1034 | struct alx_priv *alx = container_of(work, struct alx_priv, reset_wk); | ||
1035 | |||
1036 | rtnl_lock(); | ||
1037 | alx_reinit(alx); | ||
1038 | rtnl_unlock(); | ||
1039 | } | ||
1040 | |||
1041 | static int alx_tx_csum(struct sk_buff *skb, struct alx_txd *first) | ||
1042 | { | ||
1043 | u8 cso, css; | ||
1044 | |||
1045 | if (skb->ip_summed != CHECKSUM_PARTIAL) | ||
1046 | return 0; | ||
1047 | |||
1048 | cso = skb_checksum_start_offset(skb); | ||
1049 | if (cso & 1) | ||
1050 | return -EINVAL; | ||
1051 | |||
1052 | css = cso + skb->csum_offset; | ||
1053 | first->word1 |= cpu_to_le32((cso >> 1) << TPD_CXSUMSTART_SHIFT); | ||
1054 | first->word1 |= cpu_to_le32((css >> 1) << TPD_CXSUMOFFSET_SHIFT); | ||
1055 | first->word1 |= cpu_to_le32(1 << TPD_CXSUM_EN_SHIFT); | ||
1056 | |||
1057 | return 0; | ||
1058 | } | ||
1059 | |||
1060 | static int alx_map_tx_skb(struct alx_priv *alx, struct sk_buff *skb) | ||
1061 | { | ||
1062 | struct alx_tx_queue *txq = &alx->txq; | ||
1063 | struct alx_txd *tpd, *first_tpd; | ||
1064 | dma_addr_t dma; | ||
1065 | int maplen, f, first_idx = txq->write_idx; | ||
1066 | |||
1067 | first_tpd = &txq->tpd[txq->write_idx]; | ||
1068 | tpd = first_tpd; | ||
1069 | |||
1070 | maplen = skb_headlen(skb); | ||
1071 | dma = dma_map_single(&alx->hw.pdev->dev, skb->data, maplen, | ||
1072 | DMA_TO_DEVICE); | ||
1073 | if (dma_mapping_error(&alx->hw.pdev->dev, dma)) | ||
1074 | goto err_dma; | ||
1075 | |||
1076 | dma_unmap_len_set(&txq->bufs[txq->write_idx], size, maplen); | ||
1077 | dma_unmap_addr_set(&txq->bufs[txq->write_idx], dma, dma); | ||
1078 | |||
1079 | tpd->adrl.addr = cpu_to_le64(dma); | ||
1080 | tpd->len = cpu_to_le16(maplen); | ||
1081 | |||
1082 | for (f = 0; f < skb_shinfo(skb)->nr_frags; f++) { | ||
1083 | struct skb_frag_struct *frag; | ||
1084 | |||
1085 | frag = &skb_shinfo(skb)->frags[f]; | ||
1086 | |||
1087 | if (++txq->write_idx == alx->tx_ringsz) | ||
1088 | txq->write_idx = 0; | ||
1089 | tpd = &txq->tpd[txq->write_idx]; | ||
1090 | |||
1091 | tpd->word1 = first_tpd->word1; | ||
1092 | |||
1093 | maplen = skb_frag_size(frag); | ||
1094 | dma = skb_frag_dma_map(&alx->hw.pdev->dev, frag, 0, | ||
1095 | maplen, DMA_TO_DEVICE); | ||
1096 | if (dma_mapping_error(&alx->hw.pdev->dev, dma)) | ||
1097 | goto err_dma; | ||
1098 | dma_unmap_len_set(&txq->bufs[txq->write_idx], size, maplen); | ||
1099 | dma_unmap_addr_set(&txq->bufs[txq->write_idx], dma, dma); | ||
1100 | |||
1101 | tpd->adrl.addr = cpu_to_le64(dma); | ||
1102 | tpd->len = cpu_to_le16(maplen); | ||
1103 | } | ||
1104 | |||
1105 | /* last TPD, set EOP flag and store skb */ | ||
1106 | tpd->word1 |= cpu_to_le32(1 << TPD_EOP_SHIFT); | ||
1107 | txq->bufs[txq->write_idx].skb = skb; | ||
1108 | |||
1109 | if (++txq->write_idx == alx->tx_ringsz) | ||
1110 | txq->write_idx = 0; | ||
1111 | |||
1112 | return 0; | ||
1113 | |||
1114 | err_dma: | ||
1115 | f = first_idx; | ||
1116 | while (f != txq->write_idx) { | ||
1117 | alx_free_txbuf(alx, f); | ||
1118 | if (++f == alx->tx_ringsz) | ||
1119 | f = 0; | ||
1120 | } | ||
1121 | return -ENOMEM; | ||
1122 | } | ||
1123 | |||
1124 | static netdev_tx_t alx_start_xmit(struct sk_buff *skb, | ||
1125 | struct net_device *netdev) | ||
1126 | { | ||
1127 | struct alx_priv *alx = netdev_priv(netdev); | ||
1128 | struct alx_tx_queue *txq = &alx->txq; | ||
1129 | struct alx_txd *first; | ||
1130 | int tpdreq = skb_shinfo(skb)->nr_frags + 1; | ||
1131 | |||
1132 | if (alx_tpd_avail(alx) < tpdreq) { | ||
1133 | netif_stop_queue(alx->dev); | ||
1134 | goto drop; | ||
1135 | } | ||
1136 | |||
1137 | first = &txq->tpd[txq->write_idx]; | ||
1138 | memset(first, 0, sizeof(*first)); | ||
1139 | |||
1140 | if (alx_tx_csum(skb, first)) | ||
1141 | goto drop; | ||
1142 | |||
1143 | if (alx_map_tx_skb(alx, skb) < 0) | ||
1144 | goto drop; | ||
1145 | |||
1146 | netdev_sent_queue(alx->dev, skb->len); | ||
1147 | |||
1148 | /* flush updates before updating hardware */ | ||
1149 | wmb(); | ||
1150 | alx_write_mem16(&alx->hw, ALX_TPD_PRI0_PIDX, txq->write_idx); | ||
1151 | |||
1152 | if (alx_tpd_avail(alx) < alx->tx_ringsz/8) | ||
1153 | netif_stop_queue(alx->dev); | ||
1154 | |||
1155 | return NETDEV_TX_OK; | ||
1156 | |||
1157 | drop: | ||
1158 | dev_kfree_skb(skb); | ||
1159 | return NETDEV_TX_OK; | ||
1160 | } | ||
1161 | |||
1162 | static void alx_tx_timeout(struct net_device *dev) | ||
1163 | { | ||
1164 | struct alx_priv *alx = netdev_priv(dev); | ||
1165 | |||
1166 | alx_schedule_reset(alx); | ||
1167 | } | ||
1168 | |||
1169 | static int alx_mdio_read(struct net_device *netdev, | ||
1170 | int prtad, int devad, u16 addr) | ||
1171 | { | ||
1172 | struct alx_priv *alx = netdev_priv(netdev); | ||
1173 | struct alx_hw *hw = &alx->hw; | ||
1174 | u16 val; | ||
1175 | int err; | ||
1176 | |||
1177 | if (prtad != hw->mdio.prtad) | ||
1178 | return -EINVAL; | ||
1179 | |||
1180 | if (devad == MDIO_DEVAD_NONE) | ||
1181 | err = alx_read_phy_reg(hw, addr, &val); | ||
1182 | else | ||
1183 | err = alx_read_phy_ext(hw, devad, addr, &val); | ||
1184 | |||
1185 | if (err) | ||
1186 | return err; | ||
1187 | return val; | ||
1188 | } | ||
1189 | |||
1190 | static int alx_mdio_write(struct net_device *netdev, | ||
1191 | int prtad, int devad, u16 addr, u16 val) | ||
1192 | { | ||
1193 | struct alx_priv *alx = netdev_priv(netdev); | ||
1194 | struct alx_hw *hw = &alx->hw; | ||
1195 | |||
1196 | if (prtad != hw->mdio.prtad) | ||
1197 | return -EINVAL; | ||
1198 | |||
1199 | if (devad == MDIO_DEVAD_NONE) | ||
1200 | return alx_write_phy_reg(hw, addr, val); | ||
1201 | |||
1202 | return alx_write_phy_ext(hw, devad, addr, val); | ||
1203 | } | ||
1204 | |||
1205 | static int alx_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd) | ||
1206 | { | ||
1207 | struct alx_priv *alx = netdev_priv(netdev); | ||
1208 | |||
1209 | if (!netif_running(netdev)) | ||
1210 | return -EAGAIN; | ||
1211 | |||
1212 | return mdio_mii_ioctl(&alx->hw.mdio, if_mii(ifr), cmd); | ||
1213 | } | ||
1214 | |||
1215 | #ifdef CONFIG_NET_POLL_CONTROLLER | ||
1216 | static void alx_poll_controller(struct net_device *netdev) | ||
1217 | { | ||
1218 | struct alx_priv *alx = netdev_priv(netdev); | ||
1219 | |||
1220 | if (alx->msi) | ||
1221 | alx_intr_msi(0, alx); | ||
1222 | else | ||
1223 | alx_intr_legacy(0, alx); | ||
1224 | } | ||
1225 | #endif | ||
1226 | |||
1227 | static const struct net_device_ops alx_netdev_ops = { | ||
1228 | .ndo_open = alx_open, | ||
1229 | .ndo_stop = alx_stop, | ||
1230 | .ndo_start_xmit = alx_start_xmit, | ||
1231 | .ndo_set_rx_mode = alx_set_rx_mode, | ||
1232 | .ndo_validate_addr = eth_validate_addr, | ||
1233 | .ndo_set_mac_address = alx_set_mac_address, | ||
1234 | .ndo_change_mtu = alx_change_mtu, | ||
1235 | .ndo_do_ioctl = alx_ioctl, | ||
1236 | .ndo_tx_timeout = alx_tx_timeout, | ||
1237 | .ndo_fix_features = alx_fix_features, | ||
1238 | #ifdef CONFIG_NET_POLL_CONTROLLER | ||
1239 | .ndo_poll_controller = alx_poll_controller, | ||
1240 | #endif | ||
1241 | }; | ||
1242 | |||
1243 | static int alx_probe(struct pci_dev *pdev, const struct pci_device_id *ent) | ||
1244 | { | ||
1245 | struct net_device *netdev; | ||
1246 | struct alx_priv *alx; | ||
1247 | struct alx_hw *hw; | ||
1248 | bool phy_configured; | ||
1249 | int bars, pm_cap, err; | ||
1250 | |||
1251 | err = pci_enable_device_mem(pdev); | ||
1252 | if (err) | ||
1253 | return err; | ||
1254 | |||
1255 | /* The alx chip can DMA to 64-bit addresses, but it uses a single | ||
1256 | * shared register for the high 32 bits, so only a single, aligned, | ||
1257 | * 4 GB physical address range can be used for descriptors. | ||
1258 | */ | ||
1259 | if (!dma_set_mask(&pdev->dev, DMA_BIT_MASK(64)) && | ||
1260 | !dma_set_coherent_mask(&pdev->dev, DMA_BIT_MASK(64))) { | ||
1261 | dev_dbg(&pdev->dev, "DMA to 64-BIT addresses\n"); | ||
1262 | } else { | ||
1263 | err = dma_set_mask(&pdev->dev, DMA_BIT_MASK(32)); | ||
1264 | if (err) { | ||
1265 | err = dma_set_coherent_mask(&pdev->dev, | ||
1266 | DMA_BIT_MASK(32)); | ||
1267 | if (err) { | ||
1268 | dev_err(&pdev->dev, | ||
1269 | "No usable DMA config, aborting\n"); | ||
1270 | goto out_pci_disable; | ||
1271 | } | ||
1272 | } | ||
1273 | } | ||
1274 | |||
1275 | bars = pci_select_bars(pdev, IORESOURCE_MEM); | ||
1276 | err = pci_request_selected_regions(pdev, bars, alx_drv_name); | ||
1277 | if (err) { | ||
1278 | dev_err(&pdev->dev, | ||
1279 | "pci_request_selected_regions failed(bars:%d)\n", bars); | ||
1280 | goto out_pci_disable; | ||
1281 | } | ||
1282 | |||
1283 | pci_enable_pcie_error_reporting(pdev); | ||
1284 | pci_set_master(pdev); | ||
1285 | |||
1286 | pm_cap = pci_find_capability(pdev, PCI_CAP_ID_PM); | ||
1287 | if (pm_cap == 0) { | ||
1288 | dev_err(&pdev->dev, | ||
1289 | "Can't find power management capability, aborting\n"); | ||
1290 | err = -EIO; | ||
1291 | goto out_pci_release; | ||
1292 | } | ||
1293 | |||
1294 | err = pci_set_power_state(pdev, PCI_D0); | ||
1295 | if (err) | ||
1296 | goto out_pci_release; | ||
1297 | |||
1298 | netdev = alloc_etherdev(sizeof(*alx)); | ||
1299 | if (!netdev) { | ||
1300 | err = -ENOMEM; | ||
1301 | goto out_pci_release; | ||
1302 | } | ||
1303 | |||
1304 | SET_NETDEV_DEV(netdev, &pdev->dev); | ||
1305 | alx = netdev_priv(netdev); | ||
1306 | alx->dev = netdev; | ||
1307 | alx->hw.pdev = pdev; | ||
1308 | alx->msg_enable = NETIF_MSG_LINK | NETIF_MSG_HW | NETIF_MSG_IFUP | | ||
1309 | NETIF_MSG_TX_ERR | NETIF_MSG_RX_ERR | NETIF_MSG_WOL; | ||
1310 | hw = &alx->hw; | ||
1311 | pci_set_drvdata(pdev, alx); | ||
1312 | |||
1313 | hw->hw_addr = pci_ioremap_bar(pdev, 0); | ||
1314 | if (!hw->hw_addr) { | ||
1315 | dev_err(&pdev->dev, "cannot map device registers\n"); | ||
1316 | err = -EIO; | ||
1317 | goto out_free_netdev; | ||
1318 | } | ||
1319 | |||
1320 | netdev->netdev_ops = &alx_netdev_ops; | ||
1321 | SET_ETHTOOL_OPS(netdev, &alx_ethtool_ops); | ||
1322 | netdev->irq = pdev->irq; | ||
1323 | netdev->watchdog_timeo = ALX_WATCHDOG_TIME; | ||
1324 | |||
1325 | if (ent->driver_data & ALX_DEV_QUIRK_MSI_INTX_DISABLE_BUG) | ||
1326 | pdev->dev_flags |= PCI_DEV_FLAGS_MSI_INTX_DISABLE_BUG; | ||
1327 | |||
1328 | err = alx_init_sw(alx); | ||
1329 | if (err) { | ||
1330 | dev_err(&pdev->dev, "net device private data init failed\n"); | ||
1331 | goto out_unmap; | ||
1332 | } | ||
1333 | |||
1334 | alx_reset_pcie(hw); | ||
1335 | |||
1336 | phy_configured = alx_phy_configured(hw); | ||
1337 | |||
1338 | if (!phy_configured) | ||
1339 | alx_reset_phy(hw); | ||
1340 | |||
1341 | err = alx_reset_mac(hw); | ||
1342 | if (err) { | ||
1343 | dev_err(&pdev->dev, "MAC Reset failed, error = %d\n", err); | ||
1344 | goto out_unmap; | ||
1345 | } | ||
1346 | |||
1347 | /* setup link to put it in a known good starting state */ | ||
1348 | if (!phy_configured) { | ||
1349 | err = alx_setup_speed_duplex(hw, hw->adv_cfg, hw->flowctrl); | ||
1350 | if (err) { | ||
1351 | dev_err(&pdev->dev, | ||
1352 | "failed to configure PHY speed/duplex (err=%d)\n", | ||
1353 | err); | ||
1354 | goto out_unmap; | ||
1355 | } | ||
1356 | } | ||
1357 | |||
1358 | netdev->hw_features = NETIF_F_SG | NETIF_F_HW_CSUM; | ||
1359 | |||
1360 | if (alx_get_perm_macaddr(hw, hw->perm_addr)) { | ||
1361 | dev_warn(&pdev->dev, | ||
1362 | "Invalid permanent address programmed, using random one\n"); | ||
1363 | eth_hw_addr_random(netdev); | ||
1364 | memcpy(hw->perm_addr, netdev->dev_addr, netdev->addr_len); | ||
1365 | } | ||
1366 | |||
1367 | memcpy(hw->mac_addr, hw->perm_addr, ETH_ALEN); | ||
1368 | memcpy(netdev->dev_addr, hw->mac_addr, ETH_ALEN); | ||
1369 | memcpy(netdev->perm_addr, hw->perm_addr, ETH_ALEN); | ||
1370 | |||
1371 | hw->mdio.prtad = 0; | ||
1372 | hw->mdio.mmds = 0; | ||
1373 | hw->mdio.dev = netdev; | ||
1374 | hw->mdio.mode_support = MDIO_SUPPORTS_C45 | | ||
1375 | MDIO_SUPPORTS_C22 | | ||
1376 | MDIO_EMULATE_C22; | ||
1377 | hw->mdio.mdio_read = alx_mdio_read; | ||
1378 | hw->mdio.mdio_write = alx_mdio_write; | ||
1379 | |||
1380 | if (!alx_get_phy_info(hw)) { | ||
1381 | dev_err(&pdev->dev, "failed to identify PHY\n"); | ||
1382 | err = -EIO; | ||
1383 | goto out_unmap; | ||
1384 | } | ||
1385 | |||
1386 | INIT_WORK(&alx->link_check_wk, alx_link_check); | ||
1387 | INIT_WORK(&alx->reset_wk, alx_reset); | ||
1388 | spin_lock_init(&alx->hw.mdio_lock); | ||
1389 | spin_lock_init(&alx->irq_lock); | ||
1390 | |||
1391 | netif_carrier_off(netdev); | ||
1392 | |||
1393 | err = register_netdev(netdev); | ||
1394 | if (err) { | ||
1395 | dev_err(&pdev->dev, "register netdevice failed\n"); | ||
1396 | goto out_unmap; | ||
1397 | } | ||
1398 | |||
1399 | device_set_wakeup_enable(&pdev->dev, hw->sleep_ctrl); | ||
1400 | |||
1401 | netdev_info(netdev, | ||
1402 | "Qualcomm Atheros AR816x/AR817x Ethernet [%pM]\n", | ||
1403 | netdev->dev_addr); | ||
1404 | |||
1405 | return 0; | ||
1406 | |||
1407 | out_unmap: | ||
1408 | iounmap(hw->hw_addr); | ||
1409 | out_free_netdev: | ||
1410 | free_netdev(netdev); | ||
1411 | out_pci_release: | ||
1412 | pci_release_selected_regions(pdev, bars); | ||
1413 | out_pci_disable: | ||
1414 | pci_disable_device(pdev); | ||
1415 | return err; | ||
1416 | } | ||
1417 | |||
1418 | static void alx_remove(struct pci_dev *pdev) | ||
1419 | { | ||
1420 | struct alx_priv *alx = pci_get_drvdata(pdev); | ||
1421 | struct alx_hw *hw = &alx->hw; | ||
1422 | |||
1423 | cancel_work_sync(&alx->link_check_wk); | ||
1424 | cancel_work_sync(&alx->reset_wk); | ||
1425 | |||
1426 | /* restore permanent mac address */ | ||
1427 | alx_set_macaddr(hw, hw->perm_addr); | ||
1428 | |||
1429 | unregister_netdev(alx->dev); | ||
1430 | iounmap(hw->hw_addr); | ||
1431 | pci_release_selected_regions(pdev, | ||
1432 | pci_select_bars(pdev, IORESOURCE_MEM)); | ||
1433 | |||
1434 | pci_disable_pcie_error_reporting(pdev); | ||
1435 | pci_disable_device(pdev); | ||
1436 | pci_set_drvdata(pdev, NULL); | ||
1437 | |||
1438 | free_netdev(alx->dev); | ||
1439 | } | ||
1440 | |||
1441 | #ifdef CONFIG_PM_SLEEP | ||
1442 | static int alx_suspend(struct device *dev) | ||
1443 | { | ||
1444 | struct pci_dev *pdev = to_pci_dev(dev); | ||
1445 | int err; | ||
1446 | bool wol_en; | ||
1447 | |||
1448 | err = __alx_shutdown(pdev, &wol_en); | ||
1449 | if (err) { | ||
1450 | dev_err(&pdev->dev, "shutdown fail in suspend %d\n", err); | ||
1451 | return err; | ||
1452 | } | ||
1453 | |||
1454 | if (wol_en) { | ||
1455 | pci_prepare_to_sleep(pdev); | ||
1456 | } else { | ||
1457 | pci_wake_from_d3(pdev, false); | ||
1458 | pci_set_power_state(pdev, PCI_D3hot); | ||
1459 | } | ||
1460 | |||
1461 | return 0; | ||
1462 | } | ||
1463 | |||
1464 | static int alx_resume(struct device *dev) | ||
1465 | { | ||
1466 | struct pci_dev *pdev = to_pci_dev(dev); | ||
1467 | struct alx_priv *alx = pci_get_drvdata(pdev); | ||
1468 | struct net_device *netdev = alx->dev; | ||
1469 | struct alx_hw *hw = &alx->hw; | ||
1470 | int err; | ||
1471 | |||
1472 | pci_set_power_state(pdev, PCI_D0); | ||
1473 | pci_restore_state(pdev); | ||
1474 | pci_save_state(pdev); | ||
1475 | |||
1476 | pci_enable_wake(pdev, PCI_D3hot, 0); | ||
1477 | pci_enable_wake(pdev, PCI_D3cold, 0); | ||
1478 | |||
1479 | hw->link_speed = SPEED_UNKNOWN; | ||
1480 | alx->int_mask = ALX_ISR_MISC; | ||
1481 | |||
1482 | alx_reset_pcie(hw); | ||
1483 | alx_reset_phy(hw); | ||
1484 | |||
1485 | err = alx_reset_mac(hw); | ||
1486 | if (err) { | ||
1487 | netif_err(alx, hw, alx->dev, | ||
1488 | "resume:reset_mac fail %d\n", err); | ||
1489 | return -EIO; | ||
1490 | } | ||
1491 | |||
1492 | err = alx_setup_speed_duplex(hw, hw->adv_cfg, hw->flowctrl); | ||
1493 | if (err) { | ||
1494 | netif_err(alx, hw, alx->dev, | ||
1495 | "resume:setup_speed_duplex fail %d\n", err); | ||
1496 | return -EIO; | ||
1497 | } | ||
1498 | |||
1499 | if (netif_running(netdev)) { | ||
1500 | err = __alx_open(alx, true); | ||
1501 | if (err) | ||
1502 | return err; | ||
1503 | } | ||
1504 | |||
1505 | netif_device_attach(netdev); | ||
1506 | |||
1507 | return err; | ||
1508 | } | ||
1509 | #endif | ||
1510 | |||
1511 | static pci_ers_result_t alx_pci_error_detected(struct pci_dev *pdev, | ||
1512 | pci_channel_state_t state) | ||
1513 | { | ||
1514 | struct alx_priv *alx = pci_get_drvdata(pdev); | ||
1515 | struct net_device *netdev = alx->dev; | ||
1516 | pci_ers_result_t rc = PCI_ERS_RESULT_NEED_RESET; | ||
1517 | |||
1518 | dev_info(&pdev->dev, "pci error detected\n"); | ||
1519 | |||
1520 | rtnl_lock(); | ||
1521 | |||
1522 | if (netif_running(netdev)) { | ||
1523 | netif_device_detach(netdev); | ||
1524 | alx_halt(alx); | ||
1525 | } | ||
1526 | |||
1527 | if (state == pci_channel_io_perm_failure) | ||
1528 | rc = PCI_ERS_RESULT_DISCONNECT; | ||
1529 | else | ||
1530 | pci_disable_device(pdev); | ||
1531 | |||
1532 | rtnl_unlock(); | ||
1533 | |||
1534 | return rc; | ||
1535 | } | ||
1536 | |||
1537 | static pci_ers_result_t alx_pci_error_slot_reset(struct pci_dev *pdev) | ||
1538 | { | ||
1539 | struct alx_priv *alx = pci_get_drvdata(pdev); | ||
1540 | struct alx_hw *hw = &alx->hw; | ||
1541 | pci_ers_result_t rc = PCI_ERS_RESULT_DISCONNECT; | ||
1542 | |||
1543 | dev_info(&pdev->dev, "pci error slot reset\n"); | ||
1544 | |||
1545 | rtnl_lock(); | ||
1546 | |||
1547 | if (pci_enable_device(pdev)) { | ||
1548 | dev_err(&pdev->dev, "Failed to re-enable PCI device after reset\n"); | ||
1549 | goto out; | ||
1550 | } | ||
1551 | |||
1552 | pci_set_master(pdev); | ||
1553 | pci_enable_wake(pdev, PCI_D3hot, 0); | ||
1554 | pci_enable_wake(pdev, PCI_D3cold, 0); | ||
1555 | |||
1556 | alx_reset_pcie(hw); | ||
1557 | if (!alx_reset_mac(hw)) | ||
1558 | rc = PCI_ERS_RESULT_RECOVERED; | ||
1559 | out: | ||
1560 | pci_cleanup_aer_uncorrect_error_status(pdev); | ||
1561 | |||
1562 | rtnl_unlock(); | ||
1563 | |||
1564 | return rc; | ||
1565 | } | ||
1566 | |||
1567 | static void alx_pci_error_resume(struct pci_dev *pdev) | ||
1568 | { | ||
1569 | struct alx_priv *alx = pci_get_drvdata(pdev); | ||
1570 | struct net_device *netdev = alx->dev; | ||
1571 | |||
1572 | dev_info(&pdev->dev, "pci error resume\n"); | ||
1573 | |||
1574 | rtnl_lock(); | ||
1575 | |||
1576 | if (netif_running(netdev)) { | ||
1577 | alx_activate(alx); | ||
1578 | netif_device_attach(netdev); | ||
1579 | } | ||
1580 | |||
1581 | rtnl_unlock(); | ||
1582 | } | ||
1583 | |||
1584 | static const struct pci_error_handlers alx_err_handlers = { | ||
1585 | .error_detected = alx_pci_error_detected, | ||
1586 | .slot_reset = alx_pci_error_slot_reset, | ||
1587 | .resume = alx_pci_error_resume, | ||
1588 | }; | ||
1589 | |||
1590 | #ifdef CONFIG_PM_SLEEP | ||
1591 | static SIMPLE_DEV_PM_OPS(alx_pm_ops, alx_suspend, alx_resume); | ||
1592 | #define ALX_PM_OPS (&alx_pm_ops) | ||
1593 | #else | ||
1594 | #define ALX_PM_OPS NULL | ||
1595 | #endif | ||
1596 | |||
1597 | static DEFINE_PCI_DEVICE_TABLE(alx_pci_tbl) = { | ||
1598 | { PCI_VDEVICE(ATTANSIC, ALX_DEV_ID_AR8161), | ||
1599 | .driver_data = ALX_DEV_QUIRK_MSI_INTX_DISABLE_BUG }, | ||
1600 | { PCI_VDEVICE(ATTANSIC, ALX_DEV_ID_E2200), | ||
1601 | .driver_data = ALX_DEV_QUIRK_MSI_INTX_DISABLE_BUG }, | ||
1602 | { PCI_VDEVICE(ATTANSIC, ALX_DEV_ID_AR8162), | ||
1603 | .driver_data = ALX_DEV_QUIRK_MSI_INTX_DISABLE_BUG }, | ||
1604 | { PCI_VDEVICE(ATTANSIC, ALX_DEV_ID_AR8171) }, | ||
1605 | { PCI_VDEVICE(ATTANSIC, ALX_DEV_ID_AR8172) }, | ||
1606 | {} | ||
1607 | }; | ||
1608 | |||
1609 | static struct pci_driver alx_driver = { | ||
1610 | .name = alx_drv_name, | ||
1611 | .id_table = alx_pci_tbl, | ||
1612 | .probe = alx_probe, | ||
1613 | .remove = alx_remove, | ||
1614 | .shutdown = alx_shutdown, | ||
1615 | .err_handler = &alx_err_handlers, | ||
1616 | .driver.pm = ALX_PM_OPS, | ||
1617 | }; | ||
1618 | |||
1619 | module_pci_driver(alx_driver); | ||
1620 | MODULE_DEVICE_TABLE(pci, alx_pci_tbl); | ||
1621 | MODULE_AUTHOR("Johannes Berg <johannes@sipsolutions.net>"); | ||
1622 | MODULE_AUTHOR("Qualcomm Corporation, <nic-devel@qualcomm.com>"); | ||
1623 | MODULE_DESCRIPTION( | ||
1624 | "Qualcomm Atheros(R) AR816x/AR817x PCI-E Ethernet Network Driver"); | ||
1625 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/net/ethernet/atheros/alx/reg.h b/drivers/net/ethernet/atheros/alx/reg.h new file mode 100644 index 000000000000..e4358c98bc4e --- /dev/null +++ b/drivers/net/ethernet/atheros/alx/reg.h | |||
@@ -0,0 +1,810 @@ | |||
1 | /* | ||
2 | * Copyright (c) 2013 Johannes Berg <johannes@sipsolutions.net> | ||
3 | * | ||
4 | * This file is free software: you may copy, redistribute and/or modify it | ||
5 | * under the terms of the GNU General Public License as published by the | ||
6 | * Free Software Foundation, either version 2 of the License, or (at your | ||
7 | * option) any later version. | ||
8 | * | ||
9 | * This file is distributed in the hope that it will be useful, but | ||
10 | * WITHOUT ANY WARRANTY; without even the implied warranty of | ||
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
12 | * General Public License for more details. | ||
13 | * | ||
14 | * You should have received a copy of the GNU General Public License | ||
15 | * along with this program. If not, see <http://www.gnu.org/licenses/>. | ||
16 | * | ||
17 | * This file incorporates work covered by the following copyright and | ||
18 | * permission notice: | ||
19 | * | ||
20 | * Copyright (c) 2012 Qualcomm Atheros, Inc. | ||
21 | * | ||
22 | * Permission to use, copy, modify, and/or distribute this software for any | ||
23 | * purpose with or without fee is hereby granted, provided that the above | ||
24 | * copyright notice and this permission notice appear in all copies. | ||
25 | * | ||
26 | * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES | ||
27 | * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF | ||
28 | * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR | ||
29 | * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES | ||
30 | * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN | ||
31 | * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF | ||
32 | * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. | ||
33 | */ | ||
34 | |||
35 | #ifndef ALX_REG_H | ||
36 | #define ALX_REG_H | ||
37 | |||
38 | #define ALX_DEV_ID_AR8161 0x1091 | ||
39 | #define ALX_DEV_ID_E2200 0xe091 | ||
40 | #define ALX_DEV_ID_AR8162 0x1090 | ||
41 | #define ALX_DEV_ID_AR8171 0x10A1 | ||
42 | #define ALX_DEV_ID_AR8172 0x10A0 | ||
43 | |||
44 | /* rev definition, | ||
45 | * bit(0): with xD support | ||
46 | * bit(1): with Card Reader function | ||
47 | * bit(7:2): real revision | ||
48 | */ | ||
49 | #define ALX_PCI_REVID_SHIFT 3 | ||
50 | #define ALX_REV_A0 0 | ||
51 | #define ALX_REV_A1 1 | ||
52 | #define ALX_REV_B0 2 | ||
53 | #define ALX_REV_C0 3 | ||
54 | |||
55 | #define ALX_DEV_CTRL 0x0060 | ||
56 | #define ALX_DEV_CTRL_MAXRRS_MIN 2 | ||
57 | |||
58 | #define ALX_MSIX_MASK 0x0090 | ||
59 | |||
60 | #define ALX_UE_SVRT 0x010C | ||
61 | #define ALX_UE_SVRT_FCPROTERR BIT(13) | ||
62 | #define ALX_UE_SVRT_DLPROTERR BIT(4) | ||
63 | |||
64 | /* eeprom & flash load register */ | ||
65 | #define ALX_EFLD 0x0204 | ||
66 | #define ALX_EFLD_F_EXIST BIT(10) | ||
67 | #define ALX_EFLD_E_EXIST BIT(9) | ||
68 | #define ALX_EFLD_STAT BIT(5) | ||
69 | #define ALX_EFLD_START BIT(0) | ||
70 | |||
71 | /* eFuse load register */ | ||
72 | #define ALX_SLD 0x0218 | ||
73 | #define ALX_SLD_STAT BIT(12) | ||
74 | #define ALX_SLD_START BIT(11) | ||
75 | #define ALX_SLD_MAX_TO 100 | ||
76 | |||
77 | #define ALX_PDLL_TRNS1 0x1104 | ||
78 | #define ALX_PDLL_TRNS1_D3PLLOFF_EN BIT(11) | ||
79 | |||
80 | #define ALX_PMCTRL 0x12F8 | ||
81 | #define ALX_PMCTRL_HOTRST_WTEN BIT(31) | ||
82 | /* bit30: L0s/L1 controlled by MAC based on throughput(setting in 15A0) */ | ||
83 | #define ALX_PMCTRL_ASPM_FCEN BIT(30) | ||
84 | #define ALX_PMCTRL_SADLY_EN BIT(29) | ||
85 | #define ALX_PMCTRL_LCKDET_TIMER_MASK 0xF | ||
86 | #define ALX_PMCTRL_LCKDET_TIMER_SHIFT 24 | ||
87 | #define ALX_PMCTRL_LCKDET_TIMER_DEF 0xC | ||
88 | /* bit[23:20] if pm_request_l1 time > @, then enter L0s not L1 */ | ||
89 | #define ALX_PMCTRL_L1REQ_TO_MASK 0xF | ||
90 | #define ALX_PMCTRL_L1REQ_TO_SHIFT 20 | ||
91 | #define ALX_PMCTRL_L1REG_TO_DEF 0xF | ||
92 | #define ALX_PMCTRL_TXL1_AFTER_L0S BIT(19) | ||
93 | #define ALX_PMCTRL_L1_TIMER_MASK 0x7 | ||
94 | #define ALX_PMCTRL_L1_TIMER_SHIFT 16 | ||
95 | #define ALX_PMCTRL_L1_TIMER_16US 4 | ||
96 | #define ALX_PMCTRL_RCVR_WT_1US BIT(15) | ||
97 | /* bit13: enable pcie clk switch in L1 state */ | ||
98 | #define ALX_PMCTRL_L1_CLKSW_EN BIT(13) | ||
99 | #define ALX_PMCTRL_L0S_EN BIT(12) | ||
100 | #define ALX_PMCTRL_RXL1_AFTER_L0S BIT(11) | ||
101 | #define ALX_PMCTRL_L1_BUFSRX_EN BIT(7) | ||
102 | /* bit6: power down serdes RX */ | ||
103 | #define ALX_PMCTRL_L1_SRDSRX_PWD BIT(6) | ||
104 | #define ALX_PMCTRL_L1_SRDSPLL_EN BIT(5) | ||
105 | #define ALX_PMCTRL_L1_SRDS_EN BIT(4) | ||
106 | #define ALX_PMCTRL_L1_EN BIT(3) | ||
107 | |||
108 | /*******************************************************/ | ||
109 | /* following registers are mapped only to memory space */ | ||
110 | /*******************************************************/ | ||
111 | |||
112 | #define ALX_MASTER 0x1400 | ||
113 | /* bit12: 1:alwys select pclk from serdes, not sw to 25M */ | ||
114 | #define ALX_MASTER_PCLKSEL_SRDS BIT(12) | ||
115 | /* bit11: irq moduration for rx */ | ||
116 | #define ALX_MASTER_IRQMOD2_EN BIT(11) | ||
117 | /* bit10: irq moduration for tx/rx */ | ||
118 | #define ALX_MASTER_IRQMOD1_EN BIT(10) | ||
119 | #define ALX_MASTER_SYSALVTIMER_EN BIT(7) | ||
120 | #define ALX_MASTER_OOB_DIS BIT(6) | ||
121 | /* bit5: wakeup without pcie clk */ | ||
122 | #define ALX_MASTER_WAKEN_25M BIT(5) | ||
123 | /* bit0: MAC & DMA reset */ | ||
124 | #define ALX_MASTER_DMA_MAC_RST BIT(0) | ||
125 | #define ALX_DMA_MAC_RST_TO 50 | ||
126 | |||
127 | #define ALX_IRQ_MODU_TIMER 0x1408 | ||
128 | #define ALX_IRQ_MODU_TIMER1_MASK 0xFFFF | ||
129 | #define ALX_IRQ_MODU_TIMER1_SHIFT 0 | ||
130 | |||
131 | #define ALX_PHY_CTRL 0x140C | ||
132 | #define ALX_PHY_CTRL_100AB_EN BIT(17) | ||
133 | /* bit14: affect MAC & PHY, go to low power sts */ | ||
134 | #define ALX_PHY_CTRL_POWER_DOWN BIT(14) | ||
135 | /* bit13: 1:pll always ON, 0:can switch in lpw */ | ||
136 | #define ALX_PHY_CTRL_PLL_ON BIT(13) | ||
137 | #define ALX_PHY_CTRL_RST_ANALOG BIT(12) | ||
138 | #define ALX_PHY_CTRL_HIB_PULSE BIT(11) | ||
139 | #define ALX_PHY_CTRL_HIB_EN BIT(10) | ||
140 | #define ALX_PHY_CTRL_IDDQ BIT(7) | ||
141 | #define ALX_PHY_CTRL_GATE_25M BIT(5) | ||
142 | #define ALX_PHY_CTRL_LED_MODE BIT(2) | ||
143 | /* bit0: out of dsp RST state */ | ||
144 | #define ALX_PHY_CTRL_DSPRST_OUT BIT(0) | ||
145 | #define ALX_PHY_CTRL_DSPRST_TO 80 | ||
146 | #define ALX_PHY_CTRL_CLS (ALX_PHY_CTRL_LED_MODE | \ | ||
147 | ALX_PHY_CTRL_100AB_EN | \ | ||
148 | ALX_PHY_CTRL_PLL_ON) | ||
149 | |||
150 | #define ALX_MAC_STS 0x1410 | ||
151 | #define ALX_MAC_STS_TXQ_BUSY BIT(3) | ||
152 | #define ALX_MAC_STS_RXQ_BUSY BIT(2) | ||
153 | #define ALX_MAC_STS_TXMAC_BUSY BIT(1) | ||
154 | #define ALX_MAC_STS_RXMAC_BUSY BIT(0) | ||
155 | #define ALX_MAC_STS_IDLE (ALX_MAC_STS_TXQ_BUSY | \ | ||
156 | ALX_MAC_STS_RXQ_BUSY | \ | ||
157 | ALX_MAC_STS_TXMAC_BUSY | \ | ||
158 | ALX_MAC_STS_RXMAC_BUSY) | ||
159 | |||
160 | #define ALX_MDIO 0x1414 | ||
161 | #define ALX_MDIO_MODE_EXT BIT(30) | ||
162 | #define ALX_MDIO_BUSY BIT(27) | ||
163 | #define ALX_MDIO_CLK_SEL_MASK 0x7 | ||
164 | #define ALX_MDIO_CLK_SEL_SHIFT 24 | ||
165 | #define ALX_MDIO_CLK_SEL_25MD4 0 | ||
166 | #define ALX_MDIO_CLK_SEL_25MD128 7 | ||
167 | #define ALX_MDIO_START BIT(23) | ||
168 | #define ALX_MDIO_SPRES_PRMBL BIT(22) | ||
169 | /* bit21: 1:read,0:write */ | ||
170 | #define ALX_MDIO_OP_READ BIT(21) | ||
171 | #define ALX_MDIO_REG_MASK 0x1F | ||
172 | #define ALX_MDIO_REG_SHIFT 16 | ||
173 | #define ALX_MDIO_DATA_MASK 0xFFFF | ||
174 | #define ALX_MDIO_DATA_SHIFT 0 | ||
175 | #define ALX_MDIO_MAX_AC_TO 120 | ||
176 | |||
177 | #define ALX_MDIO_EXTN 0x1448 | ||
178 | #define ALX_MDIO_EXTN_DEVAD_MASK 0x1F | ||
179 | #define ALX_MDIO_EXTN_DEVAD_SHIFT 16 | ||
180 | #define ALX_MDIO_EXTN_REG_MASK 0xFFFF | ||
181 | #define ALX_MDIO_EXTN_REG_SHIFT 0 | ||
182 | |||
183 | #define ALX_SERDES 0x1424 | ||
184 | #define ALX_SERDES_PHYCLK_SLWDWN BIT(18) | ||
185 | #define ALX_SERDES_MACCLK_SLWDWN BIT(17) | ||
186 | |||
187 | #define ALX_LPI_CTRL 0x1440 | ||
188 | #define ALX_LPI_CTRL_EN BIT(0) | ||
189 | |||
190 | /* for B0+, bit[13..] for C0+ */ | ||
191 | #define ALX_HRTBT_EXT_CTRL 0x1AD0 | ||
192 | #define L1F_HRTBT_EXT_CTRL_PERIOD_HIGH_MASK 0x3F | ||
193 | #define L1F_HRTBT_EXT_CTRL_PERIOD_HIGH_SHIFT 24 | ||
194 | #define L1F_HRTBT_EXT_CTRL_SWOI_STARTUP_PKT_EN BIT(23) | ||
195 | #define L1F_HRTBT_EXT_CTRL_IOAC_2_FRAGMENTED BIT(22) | ||
196 | #define L1F_HRTBT_EXT_CTRL_IOAC_1_FRAGMENTED BIT(21) | ||
197 | #define L1F_HRTBT_EXT_CTRL_IOAC_1_KEEPALIVE_EN BIT(20) | ||
198 | #define L1F_HRTBT_EXT_CTRL_IOAC_1_HAS_VLAN BIT(19) | ||
199 | #define L1F_HRTBT_EXT_CTRL_IOAC_1_IS_8023 BIT(18) | ||
200 | #define L1F_HRTBT_EXT_CTRL_IOAC_1_IS_IPV6 BIT(17) | ||
201 | #define L1F_HRTBT_EXT_CTRL_IOAC_2_KEEPALIVE_EN BIT(16) | ||
202 | #define L1F_HRTBT_EXT_CTRL_IOAC_2_HAS_VLAN BIT(15) | ||
203 | #define L1F_HRTBT_EXT_CTRL_IOAC_2_IS_8023 BIT(14) | ||
204 | #define L1F_HRTBT_EXT_CTRL_IOAC_2_IS_IPV6 BIT(13) | ||
205 | #define ALX_HRTBT_EXT_CTRL_NS_EN BIT(12) | ||
206 | #define ALX_HRTBT_EXT_CTRL_FRAG_LEN_MASK 0xFF | ||
207 | #define ALX_HRTBT_EXT_CTRL_FRAG_LEN_SHIFT 4 | ||
208 | #define ALX_HRTBT_EXT_CTRL_IS_8023 BIT(3) | ||
209 | #define ALX_HRTBT_EXT_CTRL_IS_IPV6 BIT(2) | ||
210 | #define ALX_HRTBT_EXT_CTRL_WAKEUP_EN BIT(1) | ||
211 | #define ALX_HRTBT_EXT_CTRL_ARP_EN BIT(0) | ||
212 | |||
213 | #define ALX_HRTBT_REM_IPV4_ADDR 0x1AD4 | ||
214 | #define ALX_HRTBT_HOST_IPV4_ADDR 0x1478 | ||
215 | #define ALX_HRTBT_REM_IPV6_ADDR3 0x1AD8 | ||
216 | #define ALX_HRTBT_REM_IPV6_ADDR2 0x1ADC | ||
217 | #define ALX_HRTBT_REM_IPV6_ADDR1 0x1AE0 | ||
218 | #define ALX_HRTBT_REM_IPV6_ADDR0 0x1AE4 | ||
219 | |||
220 | /* 1B8C ~ 1B94 for C0+ */ | ||
221 | #define ALX_SWOI_ACER_CTRL 0x1B8C | ||
222 | #define ALX_SWOI_ORIG_ACK_NAK_EN BIT(20) | ||
223 | #define ALX_SWOI_ORIG_ACK_NAK_PKT_LEN_MASK 0XFF | ||
224 | #define ALX_SWOI_ORIG_ACK_NAK_PKT_LEN_SHIFT 12 | ||
225 | #define ALX_SWOI_ORIG_ACK_ADDR_MASK 0XFFF | ||
226 | #define ALX_SWOI_ORIG_ACK_ADDR_SHIFT 0 | ||
227 | |||
228 | #define ALX_SWOI_IOAC_CTRL_2 0x1B90 | ||
229 | #define ALX_SWOI_IOAC_CTRL_2_SWOI_1_FRAG_LEN_MASK 0xFF | ||
230 | #define ALX_SWOI_IOAC_CTRL_2_SWOI_1_FRAG_LEN_SHIFT 24 | ||
231 | #define ALX_SWOI_IOAC_CTRL_2_SWOI_1_PKT_LEN_MASK 0xFFF | ||
232 | #define ALX_SWOI_IOAC_CTRL_2_SWOI_1_PKT_LEN_SHIFT 12 | ||
233 | #define ALX_SWOI_IOAC_CTRL_2_SWOI_1_HDR_ADDR_MASK 0xFFF | ||
234 | #define ALX_SWOI_IOAC_CTRL_2_SWOI_1_HDR_ADDR_SHIFT 0 | ||
235 | |||
236 | #define ALX_SWOI_IOAC_CTRL_3 0x1B94 | ||
237 | #define ALX_SWOI_IOAC_CTRL_3_SWOI_2_FRAG_LEN_MASK 0xFF | ||
238 | #define ALX_SWOI_IOAC_CTRL_3_SWOI_2_FRAG_LEN_SHIFT 24 | ||
239 | #define ALX_SWOI_IOAC_CTRL_3_SWOI_2_PKT_LEN_MASK 0xFFF | ||
240 | #define ALX_SWOI_IOAC_CTRL_3_SWOI_2_PKT_LEN_SHIFT 12 | ||
241 | #define ALX_SWOI_IOAC_CTRL_3_SWOI_2_HDR_ADDR_MASK 0xFFF | ||
242 | #define ALX_SWOI_IOAC_CTRL_3_SWOI_2_HDR_ADDR_SHIFT 0 | ||
243 | |||
244 | /* for B0 */ | ||
245 | #define ALX_IDLE_DECISN_TIMER 0x1474 | ||
246 | /* 1ms */ | ||
247 | #define ALX_IDLE_DECISN_TIMER_DEF 0x400 | ||
248 | |||
249 | #define ALX_MAC_CTRL 0x1480 | ||
250 | #define ALX_MAC_CTRL_FAST_PAUSE BIT(31) | ||
251 | #define ALX_MAC_CTRL_WOLSPED_SWEN BIT(30) | ||
252 | /* bit29: 1:legacy(hi5b), 0:marvl(lo5b)*/ | ||
253 | #define ALX_MAC_CTRL_MHASH_ALG_HI5B BIT(29) | ||
254 | #define ALX_MAC_CTRL_BRD_EN BIT(26) | ||
255 | #define ALX_MAC_CTRL_MULTIALL_EN BIT(25) | ||
256 | #define ALX_MAC_CTRL_SPEED_MASK 0x3 | ||
257 | #define ALX_MAC_CTRL_SPEED_SHIFT 20 | ||
258 | #define ALX_MAC_CTRL_SPEED_10_100 1 | ||
259 | #define ALX_MAC_CTRL_SPEED_1000 2 | ||
260 | #define ALX_MAC_CTRL_PROMISC_EN BIT(15) | ||
261 | #define ALX_MAC_CTRL_VLANSTRIP BIT(14) | ||
262 | #define ALX_MAC_CTRL_PRMBLEN_MASK 0xF | ||
263 | #define ALX_MAC_CTRL_PRMBLEN_SHIFT 10 | ||
264 | #define ALX_MAC_CTRL_PCRCE BIT(7) | ||
265 | #define ALX_MAC_CTRL_CRCE BIT(6) | ||
266 | #define ALX_MAC_CTRL_FULLD BIT(5) | ||
267 | #define ALX_MAC_CTRL_RXFC_EN BIT(3) | ||
268 | #define ALX_MAC_CTRL_TXFC_EN BIT(2) | ||
269 | #define ALX_MAC_CTRL_RX_EN BIT(1) | ||
270 | #define ALX_MAC_CTRL_TX_EN BIT(0) | ||
271 | |||
272 | #define ALX_STAD0 0x1488 | ||
273 | #define ALX_STAD1 0x148C | ||
274 | |||
275 | #define ALX_HASH_TBL0 0x1490 | ||
276 | #define ALX_HASH_TBL1 0x1494 | ||
277 | |||
278 | #define ALX_MTU 0x149C | ||
279 | #define ALX_MTU_JUMBO_TH 1514 | ||
280 | #define ALX_MTU_STD_ALGN 1536 | ||
281 | |||
282 | #define ALX_SRAM5 0x1524 | ||
283 | #define ALX_SRAM_RXF_LEN_MASK 0xFFF | ||
284 | #define ALX_SRAM_RXF_LEN_SHIFT 0 | ||
285 | #define ALX_SRAM_RXF_LEN_8K (8*1024) | ||
286 | |||
287 | #define ALX_SRAM9 0x1534 | ||
288 | #define ALX_SRAM_LOAD_PTR BIT(0) | ||
289 | |||
290 | #define ALX_RX_BASE_ADDR_HI 0x1540 | ||
291 | |||
292 | #define ALX_TX_BASE_ADDR_HI 0x1544 | ||
293 | |||
294 | #define ALX_RFD_ADDR_LO 0x1550 | ||
295 | #define ALX_RFD_RING_SZ 0x1560 | ||
296 | #define ALX_RFD_BUF_SZ 0x1564 | ||
297 | |||
298 | #define ALX_RRD_ADDR_LO 0x1568 | ||
299 | #define ALX_RRD_RING_SZ 0x1578 | ||
300 | |||
301 | /* pri3: highest, pri0: lowest */ | ||
302 | #define ALX_TPD_PRI3_ADDR_LO 0x14E4 | ||
303 | #define ALX_TPD_PRI2_ADDR_LO 0x14E0 | ||
304 | #define ALX_TPD_PRI1_ADDR_LO 0x157C | ||
305 | #define ALX_TPD_PRI0_ADDR_LO 0x1580 | ||
306 | |||
307 | /* producer index is 16bit */ | ||
308 | #define ALX_TPD_PRI3_PIDX 0x1618 | ||
309 | #define ALX_TPD_PRI2_PIDX 0x161A | ||
310 | #define ALX_TPD_PRI1_PIDX 0x15F0 | ||
311 | #define ALX_TPD_PRI0_PIDX 0x15F2 | ||
312 | |||
313 | /* consumer index is 16bit */ | ||
314 | #define ALX_TPD_PRI3_CIDX 0x161C | ||
315 | #define ALX_TPD_PRI2_CIDX 0x161E | ||
316 | #define ALX_TPD_PRI1_CIDX 0x15F4 | ||
317 | #define ALX_TPD_PRI0_CIDX 0x15F6 | ||
318 | |||
319 | #define ALX_TPD_RING_SZ 0x1584 | ||
320 | |||
321 | #define ALX_TXQ0 0x1590 | ||
322 | #define ALX_TXQ0_TXF_BURST_PREF_MASK 0xFFFF | ||
323 | #define ALX_TXQ0_TXF_BURST_PREF_SHIFT 16 | ||
324 | #define ALX_TXQ_TXF_BURST_PREF_DEF 0x200 | ||
325 | #define ALX_TXQ0_LSO_8023_EN BIT(7) | ||
326 | #define ALX_TXQ0_MODE_ENHANCE BIT(6) | ||
327 | #define ALX_TXQ0_EN BIT(5) | ||
328 | #define ALX_TXQ0_SUPT_IPOPT BIT(4) | ||
329 | #define ALX_TXQ0_TPD_BURSTPREF_MASK 0xF | ||
330 | #define ALX_TXQ0_TPD_BURSTPREF_SHIFT 0 | ||
331 | #define ALX_TXQ_TPD_BURSTPREF_DEF 5 | ||
332 | |||
333 | #define ALX_TXQ1 0x1594 | ||
334 | /* bit11: drop large packet, len > (rfd buf) */ | ||
335 | #define ALX_TXQ1_ERRLGPKT_DROP_EN BIT(11) | ||
336 | #define ALX_TXQ1_JUMBO_TSO_TH (7*1024) | ||
337 | |||
338 | #define ALX_RXQ0 0x15A0 | ||
339 | #define ALX_RXQ0_EN BIT(31) | ||
340 | #define ALX_RXQ0_RSS_HASH_EN BIT(29) | ||
341 | #define ALX_RXQ0_RSS_MODE_MASK 0x3 | ||
342 | #define ALX_RXQ0_RSS_MODE_SHIFT 26 | ||
343 | #define ALX_RXQ0_RSS_MODE_DIS 0 | ||
344 | #define ALX_RXQ0_RSS_MODE_MQMI 3 | ||
345 | #define ALX_RXQ0_NUM_RFD_PREF_MASK 0x3F | ||
346 | #define ALX_RXQ0_NUM_RFD_PREF_SHIFT 20 | ||
347 | #define ALX_RXQ0_NUM_RFD_PREF_DEF 8 | ||
348 | #define ALX_RXQ0_IDT_TBL_SIZE_MASK 0x1FF | ||
349 | #define ALX_RXQ0_IDT_TBL_SIZE_SHIFT 8 | ||
350 | #define ALX_RXQ0_IDT_TBL_SIZE_DEF 0x100 | ||
351 | #define ALX_RXQ0_IDT_TBL_SIZE_NORMAL 128 | ||
352 | #define ALX_RXQ0_IPV6_PARSE_EN BIT(7) | ||
353 | #define ALX_RXQ0_RSS_HSTYP_MASK 0xF | ||
354 | #define ALX_RXQ0_RSS_HSTYP_SHIFT 2 | ||
355 | #define ALX_RXQ0_RSS_HSTYP_IPV6_TCP_EN BIT(5) | ||
356 | #define ALX_RXQ0_RSS_HSTYP_IPV6_EN BIT(4) | ||
357 | #define ALX_RXQ0_RSS_HSTYP_IPV4_TCP_EN BIT(3) | ||
358 | #define ALX_RXQ0_RSS_HSTYP_IPV4_EN BIT(2) | ||
359 | #define ALX_RXQ0_RSS_HSTYP_ALL (ALX_RXQ0_RSS_HSTYP_IPV6_TCP_EN | \ | ||
360 | ALX_RXQ0_RSS_HSTYP_IPV4_TCP_EN | \ | ||
361 | ALX_RXQ0_RSS_HSTYP_IPV6_EN | \ | ||
362 | ALX_RXQ0_RSS_HSTYP_IPV4_EN) | ||
363 | #define ALX_RXQ0_ASPM_THRESH_MASK 0x3 | ||
364 | #define ALX_RXQ0_ASPM_THRESH_SHIFT 0 | ||
365 | #define ALX_RXQ0_ASPM_THRESH_100M 3 | ||
366 | |||
367 | #define ALX_RXQ2 0x15A8 | ||
368 | #define ALX_RXQ2_RXF_XOFF_THRESH_MASK 0xFFF | ||
369 | #define ALX_RXQ2_RXF_XOFF_THRESH_SHIFT 16 | ||
370 | #define ALX_RXQ2_RXF_XON_THRESH_MASK 0xFFF | ||
371 | #define ALX_RXQ2_RXF_XON_THRESH_SHIFT 0 | ||
372 | /* Size = tx-packet(1522) + IPG(12) + SOF(8) + 64(Pause) + IPG(12) + SOF(8) + | ||
373 | * rx-packet(1522) + delay-of-link(64) | ||
374 | * = 3212. | ||
375 | */ | ||
376 | #define ALX_RXQ2_RXF_FLOW_CTRL_RSVD 3212 | ||
377 | |||
378 | #define ALX_DMA 0x15C0 | ||
379 | #define ALX_DMA_RCHNL_SEL_MASK 0x3 | ||
380 | #define ALX_DMA_RCHNL_SEL_SHIFT 26 | ||
381 | #define ALX_DMA_WDLY_CNT_MASK 0xF | ||
382 | #define ALX_DMA_WDLY_CNT_SHIFT 16 | ||
383 | #define ALX_DMA_WDLY_CNT_DEF 4 | ||
384 | #define ALX_DMA_RDLY_CNT_MASK 0x1F | ||
385 | #define ALX_DMA_RDLY_CNT_SHIFT 11 | ||
386 | #define ALX_DMA_RDLY_CNT_DEF 15 | ||
387 | /* bit10: 0:tpd with pri, 1: data */ | ||
388 | #define ALX_DMA_RREQ_PRI_DATA BIT(10) | ||
389 | #define ALX_DMA_RREQ_BLEN_MASK 0x7 | ||
390 | #define ALX_DMA_RREQ_BLEN_SHIFT 4 | ||
391 | #define ALX_DMA_RORDER_MODE_MASK 0x7 | ||
392 | #define ALX_DMA_RORDER_MODE_SHIFT 0 | ||
393 | #define ALX_DMA_RORDER_MODE_OUT 4 | ||
394 | |||
395 | #define ALX_WOL0 0x14A0 | ||
396 | #define ALX_WOL0_PME_LINK BIT(5) | ||
397 | #define ALX_WOL0_LINK_EN BIT(4) | ||
398 | #define ALX_WOL0_PME_MAGIC_EN BIT(3) | ||
399 | #define ALX_WOL0_MAGIC_EN BIT(2) | ||
400 | |||
401 | #define ALX_RFD_PIDX 0x15E0 | ||
402 | |||
403 | #define ALX_RFD_CIDX 0x15F8 | ||
404 | |||
405 | /* MIB */ | ||
406 | #define ALX_MIB_BASE 0x1700 | ||
407 | #define ALX_MIB_RX_OK (ALX_MIB_BASE + 0) | ||
408 | #define ALX_MIB_RX_ERRADDR (ALX_MIB_BASE + 92) | ||
409 | #define ALX_MIB_TX_OK (ALX_MIB_BASE + 96) | ||
410 | #define ALX_MIB_TX_MCCNT (ALX_MIB_BASE + 192) | ||
411 | |||
412 | #define ALX_RX_STATS_BIN ALX_MIB_RX_OK | ||
413 | #define ALX_RX_STATS_END ALX_MIB_RX_ERRADDR | ||
414 | #define ALX_TX_STATS_BIN ALX_MIB_TX_OK | ||
415 | #define ALX_TX_STATS_END ALX_MIB_TX_MCCNT | ||
416 | |||
417 | #define ALX_ISR 0x1600 | ||
418 | #define ALX_ISR_DIS BIT(31) | ||
419 | #define ALX_ISR_RX_Q7 BIT(30) | ||
420 | #define ALX_ISR_RX_Q6 BIT(29) | ||
421 | #define ALX_ISR_RX_Q5 BIT(28) | ||
422 | #define ALX_ISR_RX_Q4 BIT(27) | ||
423 | #define ALX_ISR_PCIE_LNKDOWN BIT(26) | ||
424 | #define ALX_ISR_RX_Q3 BIT(19) | ||
425 | #define ALX_ISR_RX_Q2 BIT(18) | ||
426 | #define ALX_ISR_RX_Q1 BIT(17) | ||
427 | #define ALX_ISR_RX_Q0 BIT(16) | ||
428 | #define ALX_ISR_TX_Q0 BIT(15) | ||
429 | #define ALX_ISR_PHY BIT(12) | ||
430 | #define ALX_ISR_DMAW BIT(10) | ||
431 | #define ALX_ISR_DMAR BIT(9) | ||
432 | #define ALX_ISR_TXF_UR BIT(8) | ||
433 | #define ALX_ISR_TX_Q3 BIT(7) | ||
434 | #define ALX_ISR_TX_Q2 BIT(6) | ||
435 | #define ALX_ISR_TX_Q1 BIT(5) | ||
436 | #define ALX_ISR_RFD_UR BIT(4) | ||
437 | #define ALX_ISR_RXF_OV BIT(3) | ||
438 | #define ALX_ISR_MANU BIT(2) | ||
439 | #define ALX_ISR_TIMER BIT(1) | ||
440 | #define ALX_ISR_SMB BIT(0) | ||
441 | |||
442 | #define ALX_IMR 0x1604 | ||
443 | |||
444 | /* re-send assert msg if SW no response */ | ||
445 | #define ALX_INT_RETRIG 0x1608 | ||
446 | /* 40ms */ | ||
447 | #define ALX_INT_RETRIG_TO 20000 | ||
448 | |||
449 | #define ALX_SMB_TIMER 0x15C4 | ||
450 | |||
451 | #define ALX_TINT_TPD_THRSHLD 0x15C8 | ||
452 | |||
453 | #define ALX_TINT_TIMER 0x15CC | ||
454 | |||
455 | #define ALX_CLK_GATE 0x1814 | ||
456 | #define ALX_CLK_GATE_RXMAC BIT(5) | ||
457 | #define ALX_CLK_GATE_TXMAC BIT(4) | ||
458 | #define ALX_CLK_GATE_RXQ BIT(3) | ||
459 | #define ALX_CLK_GATE_TXQ BIT(2) | ||
460 | #define ALX_CLK_GATE_DMAR BIT(1) | ||
461 | #define ALX_CLK_GATE_DMAW BIT(0) | ||
462 | #define ALX_CLK_GATE_ALL (ALX_CLK_GATE_RXMAC | \ | ||
463 | ALX_CLK_GATE_TXMAC | \ | ||
464 | ALX_CLK_GATE_RXQ | \ | ||
465 | ALX_CLK_GATE_TXQ | \ | ||
466 | ALX_CLK_GATE_DMAR | \ | ||
467 | ALX_CLK_GATE_DMAW) | ||
468 | |||
469 | /* interop between drivers */ | ||
470 | #define ALX_DRV 0x1804 | ||
471 | #define ALX_DRV_PHY_AUTO BIT(28) | ||
472 | #define ALX_DRV_PHY_1000 BIT(27) | ||
473 | #define ALX_DRV_PHY_100 BIT(26) | ||
474 | #define ALX_DRV_PHY_10 BIT(25) | ||
475 | #define ALX_DRV_PHY_DUPLEX BIT(24) | ||
476 | /* bit23: adv Pause */ | ||
477 | #define ALX_DRV_PHY_PAUSE BIT(23) | ||
478 | /* bit22: adv Asym Pause */ | ||
479 | #define ALX_DRV_PHY_MASK 0xFF | ||
480 | #define ALX_DRV_PHY_SHIFT 21 | ||
481 | #define ALX_DRV_PHY_UNKNOWN 0 | ||
482 | |||
483 | /* flag of phy inited */ | ||
484 | #define ALX_PHY_INITED 0x003F | ||
485 | |||
486 | /* reg 1830 ~ 186C for C0+, 16 bit map patterns and wake packet detection */ | ||
487 | #define ALX_WOL_CTRL2 0x1830 | ||
488 | #define ALX_WOL_CTRL2_DATA_STORE BIT(3) | ||
489 | #define ALX_WOL_CTRL2_PTRN_EVT BIT(2) | ||
490 | #define ALX_WOL_CTRL2_PME_PTRN_EN BIT(1) | ||
491 | #define ALX_WOL_CTRL2_PTRN_EN BIT(0) | ||
492 | |||
493 | #define ALX_WOL_CTRL3 0x1834 | ||
494 | #define ALX_WOL_CTRL3_PTRN_ADDR_MASK 0xFFFFF | ||
495 | #define ALX_WOL_CTRL3_PTRN_ADDR_SHIFT 0 | ||
496 | |||
497 | #define ALX_WOL_CTRL4 0x1838 | ||
498 | #define ALX_WOL_CTRL4_PT15_MATCH BIT(31) | ||
499 | #define ALX_WOL_CTRL4_PT14_MATCH BIT(30) | ||
500 | #define ALX_WOL_CTRL4_PT13_MATCH BIT(29) | ||
501 | #define ALX_WOL_CTRL4_PT12_MATCH BIT(28) | ||
502 | #define ALX_WOL_CTRL4_PT11_MATCH BIT(27) | ||
503 | #define ALX_WOL_CTRL4_PT10_MATCH BIT(26) | ||
504 | #define ALX_WOL_CTRL4_PT9_MATCH BIT(25) | ||
505 | #define ALX_WOL_CTRL4_PT8_MATCH BIT(24) | ||
506 | #define ALX_WOL_CTRL4_PT7_MATCH BIT(23) | ||
507 | #define ALX_WOL_CTRL4_PT6_MATCH BIT(22) | ||
508 | #define ALX_WOL_CTRL4_PT5_MATCH BIT(21) | ||
509 | #define ALX_WOL_CTRL4_PT4_MATCH BIT(20) | ||
510 | #define ALX_WOL_CTRL4_PT3_MATCH BIT(19) | ||
511 | #define ALX_WOL_CTRL4_PT2_MATCH BIT(18) | ||
512 | #define ALX_WOL_CTRL4_PT1_MATCH BIT(17) | ||
513 | #define ALX_WOL_CTRL4_PT0_MATCH BIT(16) | ||
514 | #define ALX_WOL_CTRL4_PT15_EN BIT(15) | ||
515 | #define ALX_WOL_CTRL4_PT14_EN BIT(14) | ||
516 | #define ALX_WOL_CTRL4_PT13_EN BIT(13) | ||
517 | #define ALX_WOL_CTRL4_PT12_EN BIT(12) | ||
518 | #define ALX_WOL_CTRL4_PT11_EN BIT(11) | ||
519 | #define ALX_WOL_CTRL4_PT10_EN BIT(10) | ||
520 | #define ALX_WOL_CTRL4_PT9_EN BIT(9) | ||
521 | #define ALX_WOL_CTRL4_PT8_EN BIT(8) | ||
522 | #define ALX_WOL_CTRL4_PT7_EN BIT(7) | ||
523 | #define ALX_WOL_CTRL4_PT6_EN BIT(6) | ||
524 | #define ALX_WOL_CTRL4_PT5_EN BIT(5) | ||
525 | #define ALX_WOL_CTRL4_PT4_EN BIT(4) | ||
526 | #define ALX_WOL_CTRL4_PT3_EN BIT(3) | ||
527 | #define ALX_WOL_CTRL4_PT2_EN BIT(2) | ||
528 | #define ALX_WOL_CTRL4_PT1_EN BIT(1) | ||
529 | #define ALX_WOL_CTRL4_PT0_EN BIT(0) | ||
530 | |||
531 | #define ALX_WOL_CTRL5 0x183C | ||
532 | #define ALX_WOL_CTRL5_PT3_LEN_MASK 0xFF | ||
533 | #define ALX_WOL_CTRL5_PT3_LEN_SHIFT 24 | ||
534 | #define ALX_WOL_CTRL5_PT2_LEN_MASK 0xFF | ||
535 | #define ALX_WOL_CTRL5_PT2_LEN_SHIFT 16 | ||
536 | #define ALX_WOL_CTRL5_PT1_LEN_MASK 0xFF | ||
537 | #define ALX_WOL_CTRL5_PT1_LEN_SHIFT 8 | ||
538 | #define ALX_WOL_CTRL5_PT0_LEN_MASK 0xFF | ||
539 | #define ALX_WOL_CTRL5_PT0_LEN_SHIFT 0 | ||
540 | |||
541 | #define ALX_WOL_CTRL6 0x1840 | ||
542 | #define ALX_WOL_CTRL5_PT7_LEN_MASK 0xFF | ||
543 | #define ALX_WOL_CTRL5_PT7_LEN_SHIFT 24 | ||
544 | #define ALX_WOL_CTRL5_PT6_LEN_MASK 0xFF | ||
545 | #define ALX_WOL_CTRL5_PT6_LEN_SHIFT 16 | ||
546 | #define ALX_WOL_CTRL5_PT5_LEN_MASK 0xFF | ||
547 | #define ALX_WOL_CTRL5_PT5_LEN_SHIFT 8 | ||
548 | #define ALX_WOL_CTRL5_PT4_LEN_MASK 0xFF | ||
549 | #define ALX_WOL_CTRL5_PT4_LEN_SHIFT 0 | ||
550 | |||
551 | #define ALX_WOL_CTRL7 0x1844 | ||
552 | #define ALX_WOL_CTRL5_PT11_LEN_MASK 0xFF | ||
553 | #define ALX_WOL_CTRL5_PT11_LEN_SHIFT 24 | ||
554 | #define ALX_WOL_CTRL5_PT10_LEN_MASK 0xFF | ||
555 | #define ALX_WOL_CTRL5_PT10_LEN_SHIFT 16 | ||
556 | #define ALX_WOL_CTRL5_PT9_LEN_MASK 0xFF | ||
557 | #define ALX_WOL_CTRL5_PT9_LEN_SHIFT 8 | ||
558 | #define ALX_WOL_CTRL5_PT8_LEN_MASK 0xFF | ||
559 | #define ALX_WOL_CTRL5_PT8_LEN_SHIFT 0 | ||
560 | |||
561 | #define ALX_WOL_CTRL8 0x1848 | ||
562 | #define ALX_WOL_CTRL5_PT15_LEN_MASK 0xFF | ||
563 | #define ALX_WOL_CTRL5_PT15_LEN_SHIFT 24 | ||
564 | #define ALX_WOL_CTRL5_PT14_LEN_MASK 0xFF | ||
565 | #define ALX_WOL_CTRL5_PT14_LEN_SHIFT 16 | ||
566 | #define ALX_WOL_CTRL5_PT13_LEN_MASK 0xFF | ||
567 | #define ALX_WOL_CTRL5_PT13_LEN_SHIFT 8 | ||
568 | #define ALX_WOL_CTRL5_PT12_LEN_MASK 0xFF | ||
569 | #define ALX_WOL_CTRL5_PT12_LEN_SHIFT 0 | ||
570 | |||
571 | #define ALX_ACER_FIXED_PTN0 0x1850 | ||
572 | #define ALX_ACER_FIXED_PTN0_MASK 0xFFFFFFFF | ||
573 | #define ALX_ACER_FIXED_PTN0_SHIFT 0 | ||
574 | |||
575 | #define ALX_ACER_FIXED_PTN1 0x1854 | ||
576 | #define ALX_ACER_FIXED_PTN1_MASK 0xFFFF | ||
577 | #define ALX_ACER_FIXED_PTN1_SHIFT 0 | ||
578 | |||
579 | #define ALX_ACER_RANDOM_NUM0 0x1858 | ||
580 | #define ALX_ACER_RANDOM_NUM0_MASK 0xFFFFFFFF | ||
581 | #define ALX_ACER_RANDOM_NUM0_SHIFT 0 | ||
582 | |||
583 | #define ALX_ACER_RANDOM_NUM1 0x185C | ||
584 | #define ALX_ACER_RANDOM_NUM1_MASK 0xFFFFFFFF | ||
585 | #define ALX_ACER_RANDOM_NUM1_SHIFT 0 | ||
586 | |||
587 | #define ALX_ACER_RANDOM_NUM2 0x1860 | ||
588 | #define ALX_ACER_RANDOM_NUM2_MASK 0xFFFFFFFF | ||
589 | #define ALX_ACER_RANDOM_NUM2_SHIFT 0 | ||
590 | |||
591 | #define ALX_ACER_RANDOM_NUM3 0x1864 | ||
592 | #define ALX_ACER_RANDOM_NUM3_MASK 0xFFFFFFFF | ||
593 | #define ALX_ACER_RANDOM_NUM3_SHIFT 0 | ||
594 | |||
595 | #define ALX_ACER_MAGIC 0x1868 | ||
596 | #define ALX_ACER_MAGIC_EN BIT(31) | ||
597 | #define ALX_ACER_MAGIC_PME_EN BIT(30) | ||
598 | #define ALX_ACER_MAGIC_MATCH BIT(29) | ||
599 | #define ALX_ACER_MAGIC_FF_CHECK BIT(10) | ||
600 | #define ALX_ACER_MAGIC_RAN_LEN_MASK 0x1F | ||
601 | #define ALX_ACER_MAGIC_RAN_LEN_SHIFT 5 | ||
602 | #define ALX_ACER_MAGIC_FIX_LEN_MASK 0x1F | ||
603 | #define ALX_ACER_MAGIC_FIX_LEN_SHIFT 0 | ||
604 | |||
605 | #define ALX_ACER_TIMER 0x186C | ||
606 | #define ALX_ACER_TIMER_EN BIT(31) | ||
607 | #define ALX_ACER_TIMER_PME_EN BIT(30) | ||
608 | #define ALX_ACER_TIMER_MATCH BIT(29) | ||
609 | #define ALX_ACER_TIMER_THRES_MASK 0x1FFFF | ||
610 | #define ALX_ACER_TIMER_THRES_SHIFT 0 | ||
611 | #define ALX_ACER_TIMER_THRES_DEF 1 | ||
612 | |||
613 | /* RSS definitions */ | ||
614 | #define ALX_RSS_KEY0 0x14B0 | ||
615 | #define ALX_RSS_KEY1 0x14B4 | ||
616 | #define ALX_RSS_KEY2 0x14B8 | ||
617 | #define ALX_RSS_KEY3 0x14BC | ||
618 | #define ALX_RSS_KEY4 0x14C0 | ||
619 | #define ALX_RSS_KEY5 0x14C4 | ||
620 | #define ALX_RSS_KEY6 0x14C8 | ||
621 | #define ALX_RSS_KEY7 0x14CC | ||
622 | #define ALX_RSS_KEY8 0x14D0 | ||
623 | #define ALX_RSS_KEY9 0x14D4 | ||
624 | |||
625 | #define ALX_RSS_IDT_TBL0 0x1B00 | ||
626 | |||
627 | #define ALX_MSI_MAP_TBL1 0x15D0 | ||
628 | #define ALX_MSI_MAP_TBL1_TXQ1_SHIFT 20 | ||
629 | #define ALX_MSI_MAP_TBL1_TXQ0_SHIFT 16 | ||
630 | #define ALX_MSI_MAP_TBL1_RXQ3_SHIFT 12 | ||
631 | #define ALX_MSI_MAP_TBL1_RXQ2_SHIFT 8 | ||
632 | #define ALX_MSI_MAP_TBL1_RXQ1_SHIFT 4 | ||
633 | #define ALX_MSI_MAP_TBL1_RXQ0_SHIFT 0 | ||
634 | |||
635 | #define ALX_MSI_MAP_TBL2 0x15D8 | ||
636 | #define ALX_MSI_MAP_TBL2_TXQ3_SHIFT 20 | ||
637 | #define ALX_MSI_MAP_TBL2_TXQ2_SHIFT 16 | ||
638 | #define ALX_MSI_MAP_TBL2_RXQ7_SHIFT 12 | ||
639 | #define ALX_MSI_MAP_TBL2_RXQ6_SHIFT 8 | ||
640 | #define ALX_MSI_MAP_TBL2_RXQ5_SHIFT 4 | ||
641 | #define ALX_MSI_MAP_TBL2_RXQ4_SHIFT 0 | ||
642 | |||
643 | #define ALX_MSI_ID_MAP 0x15D4 | ||
644 | |||
645 | #define ALX_MSI_RETRANS_TIMER 0x1920 | ||
646 | /* bit16: 1:line,0:standard */ | ||
647 | #define ALX_MSI_MASK_SEL_LINE BIT(16) | ||
648 | #define ALX_MSI_RETRANS_TM_MASK 0xFFFF | ||
649 | #define ALX_MSI_RETRANS_TM_SHIFT 0 | ||
650 | |||
651 | /* CR DMA ctrl */ | ||
652 | |||
653 | /* TX QoS */ | ||
654 | #define ALX_WRR 0x1938 | ||
655 | #define ALX_WRR_PRI_MASK 0x3 | ||
656 | #define ALX_WRR_PRI_SHIFT 29 | ||
657 | #define ALX_WRR_PRI_RESTRICT_NONE 3 | ||
658 | #define ALX_WRR_PRI3_MASK 0x1F | ||
659 | #define ALX_WRR_PRI3_SHIFT 24 | ||
660 | #define ALX_WRR_PRI2_MASK 0x1F | ||
661 | #define ALX_WRR_PRI2_SHIFT 16 | ||
662 | #define ALX_WRR_PRI1_MASK 0x1F | ||
663 | #define ALX_WRR_PRI1_SHIFT 8 | ||
664 | #define ALX_WRR_PRI0_MASK 0x1F | ||
665 | #define ALX_WRR_PRI0_SHIFT 0 | ||
666 | |||
667 | #define ALX_HQTPD 0x193C | ||
668 | #define ALX_HQTPD_BURST_EN BIT(31) | ||
669 | #define ALX_HQTPD_Q3_NUMPREF_MASK 0xF | ||
670 | #define ALX_HQTPD_Q3_NUMPREF_SHIFT 8 | ||
671 | #define ALX_HQTPD_Q2_NUMPREF_MASK 0xF | ||
672 | #define ALX_HQTPD_Q2_NUMPREF_SHIFT 4 | ||
673 | #define ALX_HQTPD_Q1_NUMPREF_MASK 0xF | ||
674 | #define ALX_HQTPD_Q1_NUMPREF_SHIFT 0 | ||
675 | |||
676 | #define ALX_MISC 0x19C0 | ||
677 | #define ALX_MISC_PSW_OCP_MASK 0x7 | ||
678 | #define ALX_MISC_PSW_OCP_SHIFT 21 | ||
679 | #define ALX_MISC_PSW_OCP_DEF 0x7 | ||
680 | #define ALX_MISC_ISO_EN BIT(12) | ||
681 | #define ALX_MISC_INTNLOSC_OPEN BIT(3) | ||
682 | |||
683 | #define ALX_MSIC2 0x19C8 | ||
684 | #define ALX_MSIC2_CALB_START BIT(0) | ||
685 | |||
686 | #define ALX_MISC3 0x19CC | ||
687 | /* bit1: 1:Software control 25M */ | ||
688 | #define ALX_MISC3_25M_BY_SW BIT(1) | ||
689 | /* bit0: 25M switch to intnl OSC */ | ||
690 | #define ALX_MISC3_25M_NOTO_INTNL BIT(0) | ||
691 | |||
692 | /* MSIX tbl in memory space */ | ||
693 | #define ALX_MSIX_ENTRY_BASE 0x2000 | ||
694 | |||
695 | /********************* PHY regs definition ***************************/ | ||
696 | |||
697 | /* PHY Specific Status Register */ | ||
698 | #define ALX_MII_GIGA_PSSR 0x11 | ||
699 | #define ALX_GIGA_PSSR_SPD_DPLX_RESOLVED 0x0800 | ||
700 | #define ALX_GIGA_PSSR_DPLX 0x2000 | ||
701 | #define ALX_GIGA_PSSR_SPEED 0xC000 | ||
702 | #define ALX_GIGA_PSSR_10MBS 0x0000 | ||
703 | #define ALX_GIGA_PSSR_100MBS 0x4000 | ||
704 | #define ALX_GIGA_PSSR_1000MBS 0x8000 | ||
705 | |||
706 | /* PHY Interrupt Enable Register */ | ||
707 | #define ALX_MII_IER 0x12 | ||
708 | #define ALX_IER_LINK_UP 0x0400 | ||
709 | #define ALX_IER_LINK_DOWN 0x0800 | ||
710 | |||
711 | /* PHY Interrupt Status Register */ | ||
712 | #define ALX_MII_ISR 0x13 | ||
713 | |||
714 | #define ALX_MII_DBG_ADDR 0x1D | ||
715 | #define ALX_MII_DBG_DATA 0x1E | ||
716 | |||
717 | /***************************** debug port *************************************/ | ||
718 | |||
719 | #define ALX_MIIDBG_ANACTRL 0x00 | ||
720 | #define ALX_ANACTRL_DEF 0x02EF | ||
721 | |||
722 | #define ALX_MIIDBG_SYSMODCTRL 0x04 | ||
723 | /* en half bias */ | ||
724 | #define ALX_SYSMODCTRL_IECHOADJ_DEF 0xBB8B | ||
725 | |||
726 | #define ALX_MIIDBG_SRDSYSMOD 0x05 | ||
727 | #define ALX_SRDSYSMOD_DEEMP_EN 0x0040 | ||
728 | #define ALX_SRDSYSMOD_DEF 0x2C46 | ||
729 | |||
730 | #define ALX_MIIDBG_HIBNEG 0x0B | ||
731 | #define ALX_HIBNEG_PSHIB_EN 0x8000 | ||
732 | #define ALX_HIBNEG_HIB_PSE 0x1000 | ||
733 | #define ALX_HIBNEG_DEF 0xBC40 | ||
734 | #define ALX_HIBNEG_NOHIB (ALX_HIBNEG_DEF & \ | ||
735 | ~(ALX_HIBNEG_PSHIB_EN | ALX_HIBNEG_HIB_PSE)) | ||
736 | |||
737 | #define ALX_MIIDBG_TST10BTCFG 0x12 | ||
738 | #define ALX_TST10BTCFG_DEF 0x4C04 | ||
739 | |||
740 | #define ALX_MIIDBG_AZ_ANADECT 0x15 | ||
741 | #define ALX_AZ_ANADECT_DEF 0x3220 | ||
742 | #define ALX_AZ_ANADECT_LONG 0x3210 | ||
743 | |||
744 | #define ALX_MIIDBG_MSE16DB 0x18 | ||
745 | #define ALX_MSE16DB_UP 0x05EA | ||
746 | #define ALX_MSE16DB_DOWN 0x02EA | ||
747 | |||
748 | #define ALX_MIIDBG_MSE20DB 0x1C | ||
749 | #define ALX_MSE20DB_TH_MASK 0x7F | ||
750 | #define ALX_MSE20DB_TH_SHIFT 2 | ||
751 | #define ALX_MSE20DB_TH_DEF 0x2E | ||
752 | #define ALX_MSE20DB_TH_HI 0x54 | ||
753 | |||
754 | #define ALX_MIIDBG_AGC 0x23 | ||
755 | #define ALX_AGC_2_VGA_MASK 0x3FU | ||
756 | #define ALX_AGC_2_VGA_SHIFT 8 | ||
757 | #define ALX_AGC_LONG1G_LIMT 40 | ||
758 | #define ALX_AGC_LONG100M_LIMT 44 | ||
759 | |||
760 | #define ALX_MIIDBG_LEGCYPS 0x29 | ||
761 | #define ALX_LEGCYPS_EN 0x8000 | ||
762 | #define ALX_LEGCYPS_DEF 0x129D | ||
763 | |||
764 | #define ALX_MIIDBG_TST100BTCFG 0x36 | ||
765 | #define ALX_TST100BTCFG_DEF 0xE12C | ||
766 | |||
767 | #define ALX_MIIDBG_GREENCFG 0x3B | ||
768 | #define ALX_GREENCFG_DEF 0x7078 | ||
769 | |||
770 | #define ALX_MIIDBG_GREENCFG2 0x3D | ||
771 | #define ALX_GREENCFG2_BP_GREEN 0x8000 | ||
772 | #define ALX_GREENCFG2_GATE_DFSE_EN 0x0080 | ||
773 | |||
774 | /******* dev 3 *********/ | ||
775 | #define ALX_MIIEXT_PCS 3 | ||
776 | |||
777 | #define ALX_MIIEXT_CLDCTRL3 0x8003 | ||
778 | #define ALX_CLDCTRL3_BP_CABLE1TH_DET_GT 0x8000 | ||
779 | |||
780 | #define ALX_MIIEXT_CLDCTRL5 0x8005 | ||
781 | #define ALX_CLDCTRL5_BP_VD_HLFBIAS 0x4000 | ||
782 | |||
783 | #define ALX_MIIEXT_CLDCTRL6 0x8006 | ||
784 | #define ALX_CLDCTRL6_CAB_LEN_MASK 0xFF | ||
785 | #define ALX_CLDCTRL6_CAB_LEN_SHIFT 0 | ||
786 | #define ALX_CLDCTRL6_CAB_LEN_SHORT1G 116 | ||
787 | #define ALX_CLDCTRL6_CAB_LEN_SHORT100M 152 | ||
788 | |||
789 | #define ALX_MIIEXT_VDRVBIAS 0x8062 | ||
790 | #define ALX_VDRVBIAS_DEF 0x3 | ||
791 | |||
792 | /********* dev 7 **********/ | ||
793 | #define ALX_MIIEXT_ANEG 7 | ||
794 | |||
795 | #define ALX_MIIEXT_LOCAL_EEEADV 0x3C | ||
796 | #define ALX_LOCAL_EEEADV_1000BT 0x0004 | ||
797 | #define ALX_LOCAL_EEEADV_100BT 0x0002 | ||
798 | |||
799 | #define ALX_MIIEXT_AFE 0x801A | ||
800 | #define ALX_AFE_10BT_100M_TH 0x0040 | ||
801 | |||
802 | #define ALX_MIIEXT_S3DIG10 0x8023 | ||
803 | /* bit0: 1:bypass 10BT rx fifo, 0:original 10BT rx */ | ||
804 | #define ALX_MIIEXT_S3DIG10_SL 0x0001 | ||
805 | #define ALX_MIIEXT_S3DIG10_DEF 0 | ||
806 | |||
807 | #define ALX_MIIEXT_NLP78 0x8027 | ||
808 | #define ALX_MIIEXT_NLP78_120M_DEF 0x8A05 | ||
809 | |||
810 | #endif | ||
diff --git a/drivers/net/ethernet/broadcom/bnx2x/bnx2x_cmn.c b/drivers/net/ethernet/broadcom/bnx2x/bnx2x_cmn.c index be59ec4b2c30..638e55435b04 100644 --- a/drivers/net/ethernet/broadcom/bnx2x/bnx2x_cmn.c +++ b/drivers/net/ethernet/broadcom/bnx2x/bnx2x_cmn.c | |||
@@ -3192,11 +3192,11 @@ static u32 bnx2x_xmit_type(struct bnx2x *bp, struct sk_buff *skb) | |||
3192 | rc |= XMIT_CSUM_TCP; | 3192 | rc |= XMIT_CSUM_TCP; |
3193 | 3193 | ||
3194 | if (skb_is_gso_v6(skb)) { | 3194 | if (skb_is_gso_v6(skb)) { |
3195 | rc |= (XMIT_GSO_V6 | XMIT_CSUM_TCP | XMIT_CSUM_V6); | 3195 | rc |= (XMIT_GSO_V6 | XMIT_CSUM_TCP); |
3196 | if (rc & XMIT_CSUM_ENC) | 3196 | if (rc & XMIT_CSUM_ENC) |
3197 | rc |= XMIT_GSO_ENC_V6; | 3197 | rc |= XMIT_GSO_ENC_V6; |
3198 | } else if (skb_is_gso(skb)) { | 3198 | } else if (skb_is_gso(skb)) { |
3199 | rc |= (XMIT_GSO_V4 | XMIT_CSUM_V4 | XMIT_CSUM_TCP); | 3199 | rc |= (XMIT_GSO_V4 | XMIT_CSUM_TCP); |
3200 | if (rc & XMIT_CSUM_ENC) | 3200 | if (rc & XMIT_CSUM_ENC) |
3201 | rc |= XMIT_GSO_ENC_V4; | 3201 | rc |= XMIT_GSO_ENC_V4; |
3202 | } | 3202 | } |
@@ -3483,19 +3483,18 @@ static void bnx2x_update_pbds_gso_enc(struct sk_buff *skb, | |||
3483 | { | 3483 | { |
3484 | u16 hlen_w = 0; | 3484 | u16 hlen_w = 0; |
3485 | u8 outerip_off, outerip_len = 0; | 3485 | u8 outerip_off, outerip_len = 0; |
3486 | |||
3486 | /* from outer IP to transport */ | 3487 | /* from outer IP to transport */ |
3487 | hlen_w = (skb_inner_transport_header(skb) - | 3488 | hlen_w = (skb_inner_transport_header(skb) - |
3488 | skb_network_header(skb)) >> 1; | 3489 | skb_network_header(skb)) >> 1; |
3489 | 3490 | ||
3490 | /* transport len */ | 3491 | /* transport len */ |
3491 | if (xmit_type & XMIT_CSUM_TCP) | 3492 | hlen_w += inner_tcp_hdrlen(skb) >> 1; |
3492 | hlen_w += inner_tcp_hdrlen(skb) >> 1; | ||
3493 | else | ||
3494 | hlen_w += sizeof(struct udphdr) >> 1; | ||
3495 | 3493 | ||
3496 | pbd2->fw_ip_hdr_to_payload_w = hlen_w; | 3494 | pbd2->fw_ip_hdr_to_payload_w = hlen_w; |
3497 | 3495 | ||
3498 | if (xmit_type & XMIT_CSUM_ENC_V4) { | 3496 | /* outer IP header info */ |
3497 | if (xmit_type & XMIT_CSUM_V4) { | ||
3499 | struct iphdr *iph = ip_hdr(skb); | 3498 | struct iphdr *iph = ip_hdr(skb); |
3500 | pbd2->fw_ip_csum_wo_len_flags_frag = | 3499 | pbd2->fw_ip_csum_wo_len_flags_frag = |
3501 | bswab16(csum_fold((~iph->check) - | 3500 | bswab16(csum_fold((~iph->check) - |
@@ -3818,8 +3817,7 @@ netdev_tx_t bnx2x_start_xmit(struct sk_buff *skb, struct net_device *dev) | |||
3818 | bnx2x_set_pbd_gso_e2(skb, &pbd_e2_parsing_data, | 3817 | bnx2x_set_pbd_gso_e2(skb, &pbd_e2_parsing_data, |
3819 | xmit_type); | 3818 | xmit_type); |
3820 | else | 3819 | else |
3821 | bnx2x_set_pbd_gso(skb, pbd_e1x, tx_start_bd, | 3820 | bnx2x_set_pbd_gso(skb, pbd_e1x, first_bd, xmit_type); |
3822 | xmit_type); | ||
3823 | } | 3821 | } |
3824 | 3822 | ||
3825 | /* Set the PBD's parsing_data field if not zero | 3823 | /* Set the PBD's parsing_data field if not zero |
diff --git a/drivers/net/ethernet/broadcom/tg3.c b/drivers/net/ethernet/broadcom/tg3.c index 1f2dd928888a..a13463e8a2c3 100644 --- a/drivers/net/ethernet/broadcom/tg3.c +++ b/drivers/net/ethernet/broadcom/tg3.c | |||
@@ -744,6 +744,9 @@ static int tg3_ape_lock(struct tg3 *tp, int locknum) | |||
744 | status = tg3_ape_read32(tp, gnt + off); | 744 | status = tg3_ape_read32(tp, gnt + off); |
745 | if (status == bit) | 745 | if (status == bit) |
746 | break; | 746 | break; |
747 | if (pci_channel_offline(tp->pdev)) | ||
748 | break; | ||
749 | |||
747 | udelay(10); | 750 | udelay(10); |
748 | } | 751 | } |
749 | 752 | ||
@@ -1635,6 +1638,9 @@ static void tg3_wait_for_event_ack(struct tg3 *tp) | |||
1635 | for (i = 0; i < delay_cnt; i++) { | 1638 | for (i = 0; i < delay_cnt; i++) { |
1636 | if (!(tr32(GRC_RX_CPU_EVENT) & GRC_RX_CPU_DRIVER_EVENT)) | 1639 | if (!(tr32(GRC_RX_CPU_EVENT) & GRC_RX_CPU_DRIVER_EVENT)) |
1637 | break; | 1640 | break; |
1641 | if (pci_channel_offline(tp->pdev)) | ||
1642 | break; | ||
1643 | |||
1638 | udelay(8); | 1644 | udelay(8); |
1639 | } | 1645 | } |
1640 | } | 1646 | } |
@@ -1800,6 +1806,9 @@ static int tg3_poll_fw(struct tg3 *tp) | |||
1800 | int i; | 1806 | int i; |
1801 | u32 val; | 1807 | u32 val; |
1802 | 1808 | ||
1809 | if (tg3_flag(tp, NO_FWARE_REPORTED)) | ||
1810 | return 0; | ||
1811 | |||
1803 | if (tg3_flag(tp, IS_SSB_CORE)) { | 1812 | if (tg3_flag(tp, IS_SSB_CORE)) { |
1804 | /* We don't use firmware. */ | 1813 | /* We don't use firmware. */ |
1805 | return 0; | 1814 | return 0; |
@@ -1810,6 +1819,9 @@ static int tg3_poll_fw(struct tg3 *tp) | |||
1810 | for (i = 0; i < 200; i++) { | 1819 | for (i = 0; i < 200; i++) { |
1811 | if (tr32(VCPU_STATUS) & VCPU_STATUS_INIT_DONE) | 1820 | if (tr32(VCPU_STATUS) & VCPU_STATUS_INIT_DONE) |
1812 | return 0; | 1821 | return 0; |
1822 | if (pci_channel_offline(tp->pdev)) | ||
1823 | return -ENODEV; | ||
1824 | |||
1813 | udelay(100); | 1825 | udelay(100); |
1814 | } | 1826 | } |
1815 | return -ENODEV; | 1827 | return -ENODEV; |
@@ -1820,6 +1832,15 @@ static int tg3_poll_fw(struct tg3 *tp) | |||
1820 | tg3_read_mem(tp, NIC_SRAM_FIRMWARE_MBOX, &val); | 1832 | tg3_read_mem(tp, NIC_SRAM_FIRMWARE_MBOX, &val); |
1821 | if (val == ~NIC_SRAM_FIRMWARE_MBOX_MAGIC1) | 1833 | if (val == ~NIC_SRAM_FIRMWARE_MBOX_MAGIC1) |
1822 | break; | 1834 | break; |
1835 | if (pci_channel_offline(tp->pdev)) { | ||
1836 | if (!tg3_flag(tp, NO_FWARE_REPORTED)) { | ||
1837 | tg3_flag_set(tp, NO_FWARE_REPORTED); | ||
1838 | netdev_info(tp->dev, "No firmware running\n"); | ||
1839 | } | ||
1840 | |||
1841 | break; | ||
1842 | } | ||
1843 | |||
1823 | udelay(10); | 1844 | udelay(10); |
1824 | } | 1845 | } |
1825 | 1846 | ||
@@ -3517,6 +3538,8 @@ static int tg3_pause_cpu(struct tg3 *tp, u32 cpu_base) | |||
3517 | tw32(cpu_base + CPU_MODE, CPU_MODE_HALT); | 3538 | tw32(cpu_base + CPU_MODE, CPU_MODE_HALT); |
3518 | if (tr32(cpu_base + CPU_MODE) & CPU_MODE_HALT) | 3539 | if (tr32(cpu_base + CPU_MODE) & CPU_MODE_HALT) |
3519 | break; | 3540 | break; |
3541 | if (pci_channel_offline(tp->pdev)) | ||
3542 | return -EBUSY; | ||
3520 | } | 3543 | } |
3521 | 3544 | ||
3522 | return (i == iters) ? -EBUSY : 0; | 3545 | return (i == iters) ? -EBUSY : 0; |
@@ -8586,6 +8609,14 @@ static int tg3_stop_block(struct tg3 *tp, unsigned long ofs, u32 enable_bit, boo | |||
8586 | tw32_f(ofs, val); | 8609 | tw32_f(ofs, val); |
8587 | 8610 | ||
8588 | for (i = 0; i < MAX_WAIT_CNT; i++) { | 8611 | for (i = 0; i < MAX_WAIT_CNT; i++) { |
8612 | if (pci_channel_offline(tp->pdev)) { | ||
8613 | dev_err(&tp->pdev->dev, | ||
8614 | "tg3_stop_block device offline, " | ||
8615 | "ofs=%lx enable_bit=%x\n", | ||
8616 | ofs, enable_bit); | ||
8617 | return -ENODEV; | ||
8618 | } | ||
8619 | |||
8589 | udelay(100); | 8620 | udelay(100); |
8590 | val = tr32(ofs); | 8621 | val = tr32(ofs); |
8591 | if ((val & enable_bit) == 0) | 8622 | if ((val & enable_bit) == 0) |
@@ -8609,6 +8640,13 @@ static int tg3_abort_hw(struct tg3 *tp, bool silent) | |||
8609 | 8640 | ||
8610 | tg3_disable_ints(tp); | 8641 | tg3_disable_ints(tp); |
8611 | 8642 | ||
8643 | if (pci_channel_offline(tp->pdev)) { | ||
8644 | tp->rx_mode &= ~(RX_MODE_ENABLE | TX_MODE_ENABLE); | ||
8645 | tp->mac_mode &= ~MAC_MODE_TDE_ENABLE; | ||
8646 | err = -ENODEV; | ||
8647 | goto err_no_dev; | ||
8648 | } | ||
8649 | |||
8612 | tp->rx_mode &= ~RX_MODE_ENABLE; | 8650 | tp->rx_mode &= ~RX_MODE_ENABLE; |
8613 | tw32_f(MAC_RX_MODE, tp->rx_mode); | 8651 | tw32_f(MAC_RX_MODE, tp->rx_mode); |
8614 | udelay(10); | 8652 | udelay(10); |
@@ -8657,6 +8695,7 @@ static int tg3_abort_hw(struct tg3 *tp, bool silent) | |||
8657 | err |= tg3_stop_block(tp, BUFMGR_MODE, BUFMGR_MODE_ENABLE, silent); | 8695 | err |= tg3_stop_block(tp, BUFMGR_MODE, BUFMGR_MODE_ENABLE, silent); |
8658 | err |= tg3_stop_block(tp, MEMARB_MODE, MEMARB_MODE_ENABLE, silent); | 8696 | err |= tg3_stop_block(tp, MEMARB_MODE, MEMARB_MODE_ENABLE, silent); |
8659 | 8697 | ||
8698 | err_no_dev: | ||
8660 | for (i = 0; i < tp->irq_cnt; i++) { | 8699 | for (i = 0; i < tp->irq_cnt; i++) { |
8661 | struct tg3_napi *tnapi = &tp->napi[i]; | 8700 | struct tg3_napi *tnapi = &tp->napi[i]; |
8662 | if (tnapi->hw_status) | 8701 | if (tnapi->hw_status) |
@@ -9468,6 +9507,14 @@ static void tg3_rss_write_indir_tbl(struct tg3 *tp) | |||
9468 | } | 9507 | } |
9469 | } | 9508 | } |
9470 | 9509 | ||
9510 | static inline u32 tg3_lso_rd_dma_workaround_bit(struct tg3 *tp) | ||
9511 | { | ||
9512 | if (tg3_asic_rev(tp) == ASIC_REV_5719) | ||
9513 | return TG3_LSO_RD_DMA_TX_LENGTH_WA_5719; | ||
9514 | else | ||
9515 | return TG3_LSO_RD_DMA_TX_LENGTH_WA_5720; | ||
9516 | } | ||
9517 | |||
9471 | /* tp->lock is held. */ | 9518 | /* tp->lock is held. */ |
9472 | static int tg3_reset_hw(struct tg3 *tp, bool reset_phy) | 9519 | static int tg3_reset_hw(struct tg3 *tp, bool reset_phy) |
9473 | { | 9520 | { |
@@ -10153,16 +10200,17 @@ static int tg3_reset_hw(struct tg3 *tp, bool reset_phy) | |||
10153 | tw32_f(RDMAC_MODE, rdmac_mode); | 10200 | tw32_f(RDMAC_MODE, rdmac_mode); |
10154 | udelay(40); | 10201 | udelay(40); |
10155 | 10202 | ||
10156 | if (tg3_asic_rev(tp) == ASIC_REV_5719) { | 10203 | if (tg3_asic_rev(tp) == ASIC_REV_5719 || |
10204 | tg3_asic_rev(tp) == ASIC_REV_5720) { | ||
10157 | for (i = 0; i < TG3_NUM_RDMA_CHANNELS; i++) { | 10205 | for (i = 0; i < TG3_NUM_RDMA_CHANNELS; i++) { |
10158 | if (tr32(TG3_RDMA_LENGTH + (i << 2)) > TG3_MAX_MTU(tp)) | 10206 | if (tr32(TG3_RDMA_LENGTH + (i << 2)) > TG3_MAX_MTU(tp)) |
10159 | break; | 10207 | break; |
10160 | } | 10208 | } |
10161 | if (i < TG3_NUM_RDMA_CHANNELS) { | 10209 | if (i < TG3_NUM_RDMA_CHANNELS) { |
10162 | val = tr32(TG3_LSO_RD_DMA_CRPTEN_CTRL); | 10210 | val = tr32(TG3_LSO_RD_DMA_CRPTEN_CTRL); |
10163 | val |= TG3_LSO_RD_DMA_TX_LENGTH_WA; | 10211 | val |= tg3_lso_rd_dma_workaround_bit(tp); |
10164 | tw32(TG3_LSO_RD_DMA_CRPTEN_CTRL, val); | 10212 | tw32(TG3_LSO_RD_DMA_CRPTEN_CTRL, val); |
10165 | tg3_flag_set(tp, 5719_RDMA_BUG); | 10213 | tg3_flag_set(tp, 5719_5720_RDMA_BUG); |
10166 | } | 10214 | } |
10167 | } | 10215 | } |
10168 | 10216 | ||
@@ -10395,6 +10443,13 @@ static int tg3_reset_hw(struct tg3 *tp, bool reset_phy) | |||
10395 | */ | 10443 | */ |
10396 | static int tg3_init_hw(struct tg3 *tp, bool reset_phy) | 10444 | static int tg3_init_hw(struct tg3 *tp, bool reset_phy) |
10397 | { | 10445 | { |
10446 | /* Chip may have been just powered on. If so, the boot code may still | ||
10447 | * be running initialization. Wait for it to finish to avoid races in | ||
10448 | * accessing the hardware. | ||
10449 | */ | ||
10450 | tg3_enable_register_access(tp); | ||
10451 | tg3_poll_fw(tp); | ||
10452 | |||
10398 | tg3_switch_clocks(tp); | 10453 | tg3_switch_clocks(tp); |
10399 | 10454 | ||
10400 | tw32(TG3PCI_MEM_WIN_BASE_ADDR, 0); | 10455 | tw32(TG3PCI_MEM_WIN_BASE_ADDR, 0); |
@@ -10526,15 +10581,15 @@ static void tg3_periodic_fetch_stats(struct tg3 *tp) | |||
10526 | TG3_STAT_ADD32(&sp->tx_ucast_packets, MAC_TX_STATS_UCAST); | 10581 | TG3_STAT_ADD32(&sp->tx_ucast_packets, MAC_TX_STATS_UCAST); |
10527 | TG3_STAT_ADD32(&sp->tx_mcast_packets, MAC_TX_STATS_MCAST); | 10582 | TG3_STAT_ADD32(&sp->tx_mcast_packets, MAC_TX_STATS_MCAST); |
10528 | TG3_STAT_ADD32(&sp->tx_bcast_packets, MAC_TX_STATS_BCAST); | 10583 | TG3_STAT_ADD32(&sp->tx_bcast_packets, MAC_TX_STATS_BCAST); |
10529 | if (unlikely(tg3_flag(tp, 5719_RDMA_BUG) && | 10584 | if (unlikely(tg3_flag(tp, 5719_5720_RDMA_BUG) && |
10530 | (sp->tx_ucast_packets.low + sp->tx_mcast_packets.low + | 10585 | (sp->tx_ucast_packets.low + sp->tx_mcast_packets.low + |
10531 | sp->tx_bcast_packets.low) > TG3_NUM_RDMA_CHANNELS)) { | 10586 | sp->tx_bcast_packets.low) > TG3_NUM_RDMA_CHANNELS)) { |
10532 | u32 val; | 10587 | u32 val; |
10533 | 10588 | ||
10534 | val = tr32(TG3_LSO_RD_DMA_CRPTEN_CTRL); | 10589 | val = tr32(TG3_LSO_RD_DMA_CRPTEN_CTRL); |
10535 | val &= ~TG3_LSO_RD_DMA_TX_LENGTH_WA; | 10590 | val &= ~tg3_lso_rd_dma_workaround_bit(tp); |
10536 | tw32(TG3_LSO_RD_DMA_CRPTEN_CTRL, val); | 10591 | tw32(TG3_LSO_RD_DMA_CRPTEN_CTRL, val); |
10537 | tg3_flag_clear(tp, 5719_RDMA_BUG); | 10592 | tg3_flag_clear(tp, 5719_5720_RDMA_BUG); |
10538 | } | 10593 | } |
10539 | 10594 | ||
10540 | TG3_STAT_ADD32(&sp->rx_octets, MAC_RX_STATS_OCTETS); | 10595 | TG3_STAT_ADD32(&sp->rx_octets, MAC_RX_STATS_OCTETS); |
diff --git a/drivers/net/ethernet/broadcom/tg3.h b/drivers/net/ethernet/broadcom/tg3.h index 9b2d3ac2474a..ff6e30eeae35 100644 --- a/drivers/net/ethernet/broadcom/tg3.h +++ b/drivers/net/ethernet/broadcom/tg3.h | |||
@@ -1422,7 +1422,8 @@ | |||
1422 | #define TG3_LSO_RD_DMA_CRPTEN_CTRL 0x00004910 | 1422 | #define TG3_LSO_RD_DMA_CRPTEN_CTRL 0x00004910 |
1423 | #define TG3_LSO_RD_DMA_CRPTEN_CTRL_BLEN_BD_4K 0x00030000 | 1423 | #define TG3_LSO_RD_DMA_CRPTEN_CTRL_BLEN_BD_4K 0x00030000 |
1424 | #define TG3_LSO_RD_DMA_CRPTEN_CTRL_BLEN_LSO_4K 0x000c0000 | 1424 | #define TG3_LSO_RD_DMA_CRPTEN_CTRL_BLEN_LSO_4K 0x000c0000 |
1425 | #define TG3_LSO_RD_DMA_TX_LENGTH_WA 0x02000000 | 1425 | #define TG3_LSO_RD_DMA_TX_LENGTH_WA_5719 0x02000000 |
1426 | #define TG3_LSO_RD_DMA_TX_LENGTH_WA_5720 0x00200000 | ||
1426 | /* 0x4914 --> 0x4be0 unused */ | 1427 | /* 0x4914 --> 0x4be0 unused */ |
1427 | 1428 | ||
1428 | #define TG3_NUM_RDMA_CHANNELS 4 | 1429 | #define TG3_NUM_RDMA_CHANNELS 4 |
@@ -3059,7 +3060,7 @@ enum TG3_FLAGS { | |||
3059 | TG3_FLAG_APE_HAS_NCSI, | 3060 | TG3_FLAG_APE_HAS_NCSI, |
3060 | TG3_FLAG_TX_TSTAMP_EN, | 3061 | TG3_FLAG_TX_TSTAMP_EN, |
3061 | TG3_FLAG_4K_FIFO_LIMIT, | 3062 | TG3_FLAG_4K_FIFO_LIMIT, |
3062 | TG3_FLAG_5719_RDMA_BUG, | 3063 | TG3_FLAG_5719_5720_RDMA_BUG, |
3063 | TG3_FLAG_RESET_TASK_PENDING, | 3064 | TG3_FLAG_RESET_TASK_PENDING, |
3064 | TG3_FLAG_PTP_CAPABLE, | 3065 | TG3_FLAG_PTP_CAPABLE, |
3065 | TG3_FLAG_5705_PLUS, | 3066 | TG3_FLAG_5705_PLUS, |
diff --git a/drivers/net/ethernet/brocade/bna/bnad_debugfs.c b/drivers/net/ethernet/brocade/bna/bnad_debugfs.c index 6e8bc9d88c41..94d957d203a6 100644 --- a/drivers/net/ethernet/brocade/bna/bnad_debugfs.c +++ b/drivers/net/ethernet/brocade/bna/bnad_debugfs.c | |||
@@ -244,7 +244,7 @@ bnad_debugfs_lseek(struct file *file, loff_t offset, int orig) | |||
244 | file->f_pos += offset; | 244 | file->f_pos += offset; |
245 | break; | 245 | break; |
246 | case 2: | 246 | case 2: |
247 | file->f_pos = debug->buffer_len - offset; | 247 | file->f_pos = debug->buffer_len + offset; |
248 | break; | 248 | break; |
249 | default: | 249 | default: |
250 | return -EINVAL; | 250 | return -EINVAL; |
diff --git a/drivers/net/ethernet/dec/tulip/interrupt.c b/drivers/net/ethernet/dec/tulip/interrupt.c index 28a5e425fecf..92306b320840 100644 --- a/drivers/net/ethernet/dec/tulip/interrupt.c +++ b/drivers/net/ethernet/dec/tulip/interrupt.c | |||
@@ -76,6 +76,12 @@ int tulip_refill_rx(struct net_device *dev) | |||
76 | 76 | ||
77 | mapping = pci_map_single(tp->pdev, skb->data, PKT_BUF_SZ, | 77 | mapping = pci_map_single(tp->pdev, skb->data, PKT_BUF_SZ, |
78 | PCI_DMA_FROMDEVICE); | 78 | PCI_DMA_FROMDEVICE); |
79 | if (dma_mapping_error(&tp->pdev->dev, mapping)) { | ||
80 | dev_kfree_skb(skb); | ||
81 | tp->rx_buffers[entry].skb = NULL; | ||
82 | break; | ||
83 | } | ||
84 | |||
79 | tp->rx_buffers[entry].mapping = mapping; | 85 | tp->rx_buffers[entry].mapping = mapping; |
80 | 86 | ||
81 | tp->rx_ring[entry].buffer1 = cpu_to_le32(mapping); | 87 | tp->rx_ring[entry].buffer1 = cpu_to_le32(mapping); |
diff --git a/drivers/net/ethernet/emulex/benet/be.h b/drivers/net/ethernet/emulex/benet/be.h index f544b297c9ab..0a510684e468 100644 --- a/drivers/net/ethernet/emulex/benet/be.h +++ b/drivers/net/ethernet/emulex/benet/be.h | |||
@@ -262,6 +262,7 @@ struct be_rx_compl_info { | |||
262 | u8 ipv6; | 262 | u8 ipv6; |
263 | u8 vtm; | 263 | u8 vtm; |
264 | u8 pkt_type; | 264 | u8 pkt_type; |
265 | u8 ip_frag; | ||
265 | }; | 266 | }; |
266 | 267 | ||
267 | struct be_rx_obj { | 268 | struct be_rx_obj { |
diff --git a/drivers/net/ethernet/emulex/benet/be_cmds.c b/drivers/net/ethernet/emulex/benet/be_cmds.c index a236ecd27cf3..1db2df61b8af 100644 --- a/drivers/net/ethernet/emulex/benet/be_cmds.c +++ b/drivers/net/ethernet/emulex/benet/be_cmds.c | |||
@@ -562,7 +562,7 @@ int lancer_test_and_set_rdy_state(struct be_adapter *adapter) | |||
562 | 562 | ||
563 | resource_error = lancer_provisioning_error(adapter); | 563 | resource_error = lancer_provisioning_error(adapter); |
564 | if (resource_error) | 564 | if (resource_error) |
565 | return -1; | 565 | return -EAGAIN; |
566 | 566 | ||
567 | status = lancer_wait_ready(adapter); | 567 | status = lancer_wait_ready(adapter); |
568 | if (!status) { | 568 | if (!status) { |
@@ -590,8 +590,8 @@ int lancer_test_and_set_rdy_state(struct be_adapter *adapter) | |||
590 | * when PF provisions resources. | 590 | * when PF provisions resources. |
591 | */ | 591 | */ |
592 | resource_error = lancer_provisioning_error(adapter); | 592 | resource_error = lancer_provisioning_error(adapter); |
593 | if (status == -1 && !resource_error) | 593 | if (resource_error) |
594 | adapter->eeh_error = true; | 594 | status = -EAGAIN; |
595 | 595 | ||
596 | return status; | 596 | return status; |
597 | } | 597 | } |
diff --git a/drivers/net/ethernet/emulex/benet/be_hw.h b/drivers/net/ethernet/emulex/benet/be_hw.h index 3c1099b47f2a..8780183c6d1c 100644 --- a/drivers/net/ethernet/emulex/benet/be_hw.h +++ b/drivers/net/ethernet/emulex/benet/be_hw.h | |||
@@ -356,7 +356,7 @@ struct amap_eth_rx_compl_v0 { | |||
356 | u8 ip_version; /* dword 1 */ | 356 | u8 ip_version; /* dword 1 */ |
357 | u8 macdst[6]; /* dword 1 */ | 357 | u8 macdst[6]; /* dword 1 */ |
358 | u8 vtp; /* dword 1 */ | 358 | u8 vtp; /* dword 1 */ |
359 | u8 rsvd0; /* dword 1 */ | 359 | u8 ip_frag; /* dword 1 */ |
360 | u8 fragndx[10]; /* dword 1 */ | 360 | u8 fragndx[10]; /* dword 1 */ |
361 | u8 ct[2]; /* dword 1 */ | 361 | u8 ct[2]; /* dword 1 */ |
362 | u8 sw; /* dword 1 */ | 362 | u8 sw; /* dword 1 */ |
diff --git a/drivers/net/ethernet/emulex/benet/be_main.c b/drivers/net/ethernet/emulex/benet/be_main.c index ca2967b0f18b..a0b4be51f0d1 100644 --- a/drivers/net/ethernet/emulex/benet/be_main.c +++ b/drivers/net/ethernet/emulex/benet/be_main.c | |||
@@ -1599,6 +1599,8 @@ static void be_parse_rx_compl_v0(struct be_eth_rx_compl *compl, | |||
1599 | compl); | 1599 | compl); |
1600 | } | 1600 | } |
1601 | rxcp->port = AMAP_GET_BITS(struct amap_eth_rx_compl_v0, port, compl); | 1601 | rxcp->port = AMAP_GET_BITS(struct amap_eth_rx_compl_v0, port, compl); |
1602 | rxcp->ip_frag = AMAP_GET_BITS(struct amap_eth_rx_compl_v0, | ||
1603 | ip_frag, compl); | ||
1602 | } | 1604 | } |
1603 | 1605 | ||
1604 | static struct be_rx_compl_info *be_rx_compl_get(struct be_rx_obj *rxo) | 1606 | static struct be_rx_compl_info *be_rx_compl_get(struct be_rx_obj *rxo) |
@@ -1620,6 +1622,9 @@ static struct be_rx_compl_info *be_rx_compl_get(struct be_rx_obj *rxo) | |||
1620 | else | 1622 | else |
1621 | be_parse_rx_compl_v0(compl, rxcp); | 1623 | be_parse_rx_compl_v0(compl, rxcp); |
1622 | 1624 | ||
1625 | if (rxcp->ip_frag) | ||
1626 | rxcp->l4_csum = 0; | ||
1627 | |||
1623 | if (rxcp->vlanf) { | 1628 | if (rxcp->vlanf) { |
1624 | /* vlanf could be wrongly set in some cards. | 1629 | /* vlanf could be wrongly set in some cards. |
1625 | * ignore if vtm is not set */ | 1630 | * ignore if vtm is not set */ |
@@ -2168,7 +2173,7 @@ static irqreturn_t be_msix(int irq, void *dev) | |||
2168 | 2173 | ||
2169 | static inline bool do_gro(struct be_rx_compl_info *rxcp) | 2174 | static inline bool do_gro(struct be_rx_compl_info *rxcp) |
2170 | { | 2175 | { |
2171 | return (rxcp->tcpf && !rxcp->err) ? true : false; | 2176 | return (rxcp->tcpf && !rxcp->err && rxcp->l4_csum) ? true : false; |
2172 | } | 2177 | } |
2173 | 2178 | ||
2174 | static int be_process_rx(struct be_rx_obj *rxo, struct napi_struct *napi, | 2179 | static int be_process_rx(struct be_rx_obj *rxo, struct napi_struct *napi, |
@@ -4093,6 +4098,7 @@ static int be_get_initial_config(struct be_adapter *adapter) | |||
4093 | 4098 | ||
4094 | static int lancer_recover_func(struct be_adapter *adapter) | 4099 | static int lancer_recover_func(struct be_adapter *adapter) |
4095 | { | 4100 | { |
4101 | struct device *dev = &adapter->pdev->dev; | ||
4096 | int status; | 4102 | int status; |
4097 | 4103 | ||
4098 | status = lancer_test_and_set_rdy_state(adapter); | 4104 | status = lancer_test_and_set_rdy_state(adapter); |
@@ -4104,8 +4110,7 @@ static int lancer_recover_func(struct be_adapter *adapter) | |||
4104 | 4110 | ||
4105 | be_clear(adapter); | 4111 | be_clear(adapter); |
4106 | 4112 | ||
4107 | adapter->hw_error = false; | 4113 | be_clear_all_error(adapter); |
4108 | adapter->fw_timeout = false; | ||
4109 | 4114 | ||
4110 | status = be_setup(adapter); | 4115 | status = be_setup(adapter); |
4111 | if (status) | 4116 | if (status) |
@@ -4117,13 +4122,13 @@ static int lancer_recover_func(struct be_adapter *adapter) | |||
4117 | goto err; | 4122 | goto err; |
4118 | } | 4123 | } |
4119 | 4124 | ||
4120 | dev_err(&adapter->pdev->dev, | 4125 | dev_err(dev, "Error recovery successful\n"); |
4121 | "Adapter SLIPORT recovery succeeded\n"); | ||
4122 | return 0; | 4126 | return 0; |
4123 | err: | 4127 | err: |
4124 | if (adapter->eeh_error) | 4128 | if (status == -EAGAIN) |
4125 | dev_err(&adapter->pdev->dev, | 4129 | dev_err(dev, "Waiting for resource provisioning\n"); |
4126 | "Adapter SLIPORT recovery failed\n"); | 4130 | else |
4131 | dev_err(dev, "Error recovery failed\n"); | ||
4127 | 4132 | ||
4128 | return status; | 4133 | return status; |
4129 | } | 4134 | } |
@@ -4132,28 +4137,27 @@ static void be_func_recovery_task(struct work_struct *work) | |||
4132 | { | 4137 | { |
4133 | struct be_adapter *adapter = | 4138 | struct be_adapter *adapter = |
4134 | container_of(work, struct be_adapter, func_recovery_work.work); | 4139 | container_of(work, struct be_adapter, func_recovery_work.work); |
4135 | int status; | 4140 | int status = 0; |
4136 | 4141 | ||
4137 | be_detect_error(adapter); | 4142 | be_detect_error(adapter); |
4138 | 4143 | ||
4139 | if (adapter->hw_error && lancer_chip(adapter)) { | 4144 | if (adapter->hw_error && lancer_chip(adapter)) { |
4140 | 4145 | ||
4141 | if (adapter->eeh_error) | ||
4142 | goto out; | ||
4143 | |||
4144 | rtnl_lock(); | 4146 | rtnl_lock(); |
4145 | netif_device_detach(adapter->netdev); | 4147 | netif_device_detach(adapter->netdev); |
4146 | rtnl_unlock(); | 4148 | rtnl_unlock(); |
4147 | 4149 | ||
4148 | status = lancer_recover_func(adapter); | 4150 | status = lancer_recover_func(adapter); |
4149 | |||
4150 | if (!status) | 4151 | if (!status) |
4151 | netif_device_attach(adapter->netdev); | 4152 | netif_device_attach(adapter->netdev); |
4152 | } | 4153 | } |
4153 | 4154 | ||
4154 | out: | 4155 | /* In Lancer, for all errors other than provisioning error (-EAGAIN), |
4155 | schedule_delayed_work(&adapter->func_recovery_work, | 4156 | * no need to attempt further recovery. |
4156 | msecs_to_jiffies(1000)); | 4157 | */ |
4158 | if (!status || status == -EAGAIN) | ||
4159 | schedule_delayed_work(&adapter->func_recovery_work, | ||
4160 | msecs_to_jiffies(1000)); | ||
4157 | } | 4161 | } |
4158 | 4162 | ||
4159 | static void be_worker(struct work_struct *work) | 4163 | static void be_worker(struct work_struct *work) |
@@ -4258,6 +4262,9 @@ static int be_probe(struct pci_dev *pdev, const struct pci_device_id *pdev_id) | |||
4258 | netdev->features |= NETIF_F_HIGHDMA; | 4262 | netdev->features |= NETIF_F_HIGHDMA; |
4259 | } else { | 4263 | } else { |
4260 | status = dma_set_mask(&pdev->dev, DMA_BIT_MASK(32)); | 4264 | status = dma_set_mask(&pdev->dev, DMA_BIT_MASK(32)); |
4265 | if (!status) | ||
4266 | status = dma_set_coherent_mask(&pdev->dev, | ||
4267 | DMA_BIT_MASK(32)); | ||
4261 | if (status) { | 4268 | if (status) { |
4262 | dev_err(&pdev->dev, "Could not set PCI DMA Mask\n"); | 4269 | dev_err(&pdev->dev, "Could not set PCI DMA Mask\n"); |
4263 | goto free_netdev; | 4270 | goto free_netdev; |
@@ -4436,20 +4443,19 @@ static pci_ers_result_t be_eeh_err_detected(struct pci_dev *pdev, | |||
4436 | 4443 | ||
4437 | dev_err(&adapter->pdev->dev, "EEH error detected\n"); | 4444 | dev_err(&adapter->pdev->dev, "EEH error detected\n"); |
4438 | 4445 | ||
4439 | adapter->eeh_error = true; | 4446 | if (!adapter->eeh_error) { |
4447 | adapter->eeh_error = true; | ||
4440 | 4448 | ||
4441 | cancel_delayed_work_sync(&adapter->func_recovery_work); | 4449 | cancel_delayed_work_sync(&adapter->func_recovery_work); |
4442 | |||
4443 | rtnl_lock(); | ||
4444 | netif_device_detach(netdev); | ||
4445 | rtnl_unlock(); | ||
4446 | 4450 | ||
4447 | if (netif_running(netdev)) { | ||
4448 | rtnl_lock(); | 4451 | rtnl_lock(); |
4449 | be_close(netdev); | 4452 | netif_device_detach(netdev); |
4453 | if (netif_running(netdev)) | ||
4454 | be_close(netdev); | ||
4450 | rtnl_unlock(); | 4455 | rtnl_unlock(); |
4456 | |||
4457 | be_clear(adapter); | ||
4451 | } | 4458 | } |
4452 | be_clear(adapter); | ||
4453 | 4459 | ||
4454 | if (state == pci_channel_io_perm_failure) | 4460 | if (state == pci_channel_io_perm_failure) |
4455 | return PCI_ERS_RESULT_DISCONNECT; | 4461 | return PCI_ERS_RESULT_DISCONNECT; |
@@ -4474,7 +4480,6 @@ static pci_ers_result_t be_eeh_reset(struct pci_dev *pdev) | |||
4474 | int status; | 4480 | int status; |
4475 | 4481 | ||
4476 | dev_info(&adapter->pdev->dev, "EEH reset\n"); | 4482 | dev_info(&adapter->pdev->dev, "EEH reset\n"); |
4477 | be_clear_all_error(adapter); | ||
4478 | 4483 | ||
4479 | status = pci_enable_device(pdev); | 4484 | status = pci_enable_device(pdev); |
4480 | if (status) | 4485 | if (status) |
@@ -4492,6 +4497,7 @@ static pci_ers_result_t be_eeh_reset(struct pci_dev *pdev) | |||
4492 | return PCI_ERS_RESULT_DISCONNECT; | 4497 | return PCI_ERS_RESULT_DISCONNECT; |
4493 | 4498 | ||
4494 | pci_cleanup_aer_uncorrect_error_status(pdev); | 4499 | pci_cleanup_aer_uncorrect_error_status(pdev); |
4500 | be_clear_all_error(adapter); | ||
4495 | return PCI_ERS_RESULT_RECOVERED; | 4501 | return PCI_ERS_RESULT_RECOVERED; |
4496 | } | 4502 | } |
4497 | 4503 | ||
diff --git a/drivers/net/ethernet/freescale/fec_main.c b/drivers/net/ethernet/freescale/fec_main.c index 85a06037b242..d48099f03b7f 100644 --- a/drivers/net/ethernet/freescale/fec_main.c +++ b/drivers/net/ethernet/freescale/fec_main.c | |||
@@ -516,6 +516,7 @@ fec_restart(struct net_device *ndev, int duplex) | |||
516 | /* Set MII speed */ | 516 | /* Set MII speed */ |
517 | writel(fep->phy_speed, fep->hwp + FEC_MII_SPEED); | 517 | writel(fep->phy_speed, fep->hwp + FEC_MII_SPEED); |
518 | 518 | ||
519 | #if !defined(CONFIG_M5272) | ||
519 | /* set RX checksum */ | 520 | /* set RX checksum */ |
520 | val = readl(fep->hwp + FEC_RACC); | 521 | val = readl(fep->hwp + FEC_RACC); |
521 | if (fep->csum_flags & FLAG_RX_CSUM_ENABLED) | 522 | if (fep->csum_flags & FLAG_RX_CSUM_ENABLED) |
@@ -523,6 +524,7 @@ fec_restart(struct net_device *ndev, int duplex) | |||
523 | else | 524 | else |
524 | val &= ~FEC_RACC_OPTIONS; | 525 | val &= ~FEC_RACC_OPTIONS; |
525 | writel(val, fep->hwp + FEC_RACC); | 526 | writel(val, fep->hwp + FEC_RACC); |
527 | #endif | ||
526 | 528 | ||
527 | /* | 529 | /* |
528 | * The phy interface and speed need to get configured | 530 | * The phy interface and speed need to get configured |
@@ -575,6 +577,7 @@ fec_restart(struct net_device *ndev, int duplex) | |||
575 | #endif | 577 | #endif |
576 | } | 578 | } |
577 | 579 | ||
580 | #if !defined(CONFIG_M5272) | ||
578 | /* enable pause frame*/ | 581 | /* enable pause frame*/ |
579 | if ((fep->pause_flag & FEC_PAUSE_FLAG_ENABLE) || | 582 | if ((fep->pause_flag & FEC_PAUSE_FLAG_ENABLE) || |
580 | ((fep->pause_flag & FEC_PAUSE_FLAG_AUTONEG) && | 583 | ((fep->pause_flag & FEC_PAUSE_FLAG_AUTONEG) && |
@@ -592,6 +595,7 @@ fec_restart(struct net_device *ndev, int duplex) | |||
592 | } else { | 595 | } else { |
593 | rcntl &= ~FEC_ENET_FCE; | 596 | rcntl &= ~FEC_ENET_FCE; |
594 | } | 597 | } |
598 | #endif /* !defined(CONFIG_M5272) */ | ||
595 | 599 | ||
596 | writel(rcntl, fep->hwp + FEC_R_CNTRL); | 600 | writel(rcntl, fep->hwp + FEC_R_CNTRL); |
597 | 601 | ||
@@ -1038,6 +1042,18 @@ static void fec_get_mac(struct net_device *ndev) | |||
1038 | iap = &tmpaddr[0]; | 1042 | iap = &tmpaddr[0]; |
1039 | } | 1043 | } |
1040 | 1044 | ||
1045 | /* | ||
1046 | * 5) random mac address | ||
1047 | */ | ||
1048 | if (!is_valid_ether_addr(iap)) { | ||
1049 | /* Report it and use a random ethernet address instead */ | ||
1050 | netdev_err(ndev, "Invalid MAC address: %pM\n", iap); | ||
1051 | eth_hw_addr_random(ndev); | ||
1052 | netdev_info(ndev, "Using random MAC address: %pM\n", | ||
1053 | ndev->dev_addr); | ||
1054 | return; | ||
1055 | } | ||
1056 | |||
1041 | memcpy(ndev->dev_addr, iap, ETH_ALEN); | 1057 | memcpy(ndev->dev_addr, iap, ETH_ALEN); |
1042 | 1058 | ||
1043 | /* Adjust MAC if using macaddr */ | 1059 | /* Adjust MAC if using macaddr */ |
@@ -1193,7 +1209,9 @@ static int fec_enet_mii_probe(struct net_device *ndev) | |||
1193 | /* mask with MAC supported features */ | 1209 | /* mask with MAC supported features */ |
1194 | if (id_entry->driver_data & FEC_QUIRK_HAS_GBIT) { | 1210 | if (id_entry->driver_data & FEC_QUIRK_HAS_GBIT) { |
1195 | phy_dev->supported &= PHY_GBIT_FEATURES; | 1211 | phy_dev->supported &= PHY_GBIT_FEATURES; |
1212 | #if !defined(CONFIG_M5272) | ||
1196 | phy_dev->supported |= SUPPORTED_Pause; | 1213 | phy_dev->supported |= SUPPORTED_Pause; |
1214 | #endif | ||
1197 | } | 1215 | } |
1198 | else | 1216 | else |
1199 | phy_dev->supported &= PHY_BASIC_FEATURES; | 1217 | phy_dev->supported &= PHY_BASIC_FEATURES; |
@@ -1378,6 +1396,8 @@ static int fec_enet_get_ts_info(struct net_device *ndev, | |||
1378 | } | 1396 | } |
1379 | } | 1397 | } |
1380 | 1398 | ||
1399 | #if !defined(CONFIG_M5272) | ||
1400 | |||
1381 | static void fec_enet_get_pauseparam(struct net_device *ndev, | 1401 | static void fec_enet_get_pauseparam(struct net_device *ndev, |
1382 | struct ethtool_pauseparam *pause) | 1402 | struct ethtool_pauseparam *pause) |
1383 | { | 1403 | { |
@@ -1424,9 +1444,13 @@ static int fec_enet_set_pauseparam(struct net_device *ndev, | |||
1424 | return 0; | 1444 | return 0; |
1425 | } | 1445 | } |
1426 | 1446 | ||
1447 | #endif /* !defined(CONFIG_M5272) */ | ||
1448 | |||
1427 | static const struct ethtool_ops fec_enet_ethtool_ops = { | 1449 | static const struct ethtool_ops fec_enet_ethtool_ops = { |
1450 | #if !defined(CONFIG_M5272) | ||
1428 | .get_pauseparam = fec_enet_get_pauseparam, | 1451 | .get_pauseparam = fec_enet_get_pauseparam, |
1429 | .set_pauseparam = fec_enet_set_pauseparam, | 1452 | .set_pauseparam = fec_enet_set_pauseparam, |
1453 | #endif | ||
1430 | .get_settings = fec_enet_get_settings, | 1454 | .get_settings = fec_enet_get_settings, |
1431 | .set_settings = fec_enet_set_settings, | 1455 | .set_settings = fec_enet_set_settings, |
1432 | .get_drvinfo = fec_enet_get_drvinfo, | 1456 | .get_drvinfo = fec_enet_get_drvinfo, |
@@ -1862,10 +1886,12 @@ fec_probe(struct platform_device *pdev) | |||
1862 | /* setup board info structure */ | 1886 | /* setup board info structure */ |
1863 | fep = netdev_priv(ndev); | 1887 | fep = netdev_priv(ndev); |
1864 | 1888 | ||
1889 | #if !defined(CONFIG_M5272) | ||
1865 | /* default enable pause frame auto negotiation */ | 1890 | /* default enable pause frame auto negotiation */ |
1866 | if (pdev->id_entry && | 1891 | if (pdev->id_entry && |
1867 | (pdev->id_entry->driver_data & FEC_QUIRK_HAS_GBIT)) | 1892 | (pdev->id_entry->driver_data & FEC_QUIRK_HAS_GBIT)) |
1868 | fep->pause_flag |= FEC_PAUSE_FLAG_AUTONEG; | 1893 | fep->pause_flag |= FEC_PAUSE_FLAG_AUTONEG; |
1894 | #endif | ||
1869 | 1895 | ||
1870 | fep->hwp = devm_request_and_ioremap(&pdev->dev, r); | 1896 | fep->hwp = devm_request_and_ioremap(&pdev->dev, r); |
1871 | fep->pdev = pdev; | 1897 | fep->pdev = pdev; |
diff --git a/drivers/net/ethernet/marvell/mv643xx_eth.c b/drivers/net/ethernet/marvell/mv643xx_eth.c index 2ad1494efbb3..d1cbfb12c1ca 100644 --- a/drivers/net/ethernet/marvell/mv643xx_eth.c +++ b/drivers/net/ethernet/marvell/mv643xx_eth.c | |||
@@ -1757,7 +1757,7 @@ static int rxq_init(struct mv643xx_eth_private *mp, int index) | |||
1757 | memset(rxq->rx_desc_area, 0, size); | 1757 | memset(rxq->rx_desc_area, 0, size); |
1758 | 1758 | ||
1759 | rxq->rx_desc_area_size = size; | 1759 | rxq->rx_desc_area_size = size; |
1760 | rxq->rx_skb = kmalloc_array(rxq->rx_ring_size, sizeof(*rxq->rx_skb), | 1760 | rxq->rx_skb = kcalloc(rxq->rx_ring_size, sizeof(*rxq->rx_skb), |
1761 | GFP_KERNEL); | 1761 | GFP_KERNEL); |
1762 | if (rxq->rx_skb == NULL) | 1762 | if (rxq->rx_skb == NULL) |
1763 | goto out_free; | 1763 | goto out_free; |
diff --git a/drivers/net/ethernet/marvell/pxa168_eth.c b/drivers/net/ethernet/marvell/pxa168_eth.c index 339bb323cb0c..1c8af8ba08d9 100644 --- a/drivers/net/ethernet/marvell/pxa168_eth.c +++ b/drivers/net/ethernet/marvell/pxa168_eth.c | |||
@@ -1015,7 +1015,7 @@ static int rxq_init(struct net_device *dev) | |||
1015 | int rx_desc_num = pep->rx_ring_size; | 1015 | int rx_desc_num = pep->rx_ring_size; |
1016 | 1016 | ||
1017 | /* Allocate RX skb rings */ | 1017 | /* Allocate RX skb rings */ |
1018 | pep->rx_skb = kmalloc(sizeof(*pep->rx_skb) * pep->rx_ring_size, | 1018 | pep->rx_skb = kzalloc(sizeof(*pep->rx_skb) * pep->rx_ring_size, |
1019 | GFP_KERNEL); | 1019 | GFP_KERNEL); |
1020 | if (!pep->rx_skb) | 1020 | if (!pep->rx_skb) |
1021 | return -ENOMEM; | 1021 | return -ENOMEM; |
@@ -1076,7 +1076,7 @@ static int txq_init(struct net_device *dev) | |||
1076 | int size = 0, i = 0; | 1076 | int size = 0, i = 0; |
1077 | int tx_desc_num = pep->tx_ring_size; | 1077 | int tx_desc_num = pep->tx_ring_size; |
1078 | 1078 | ||
1079 | pep->tx_skb = kmalloc(sizeof(*pep->tx_skb) * pep->tx_ring_size, | 1079 | pep->tx_skb = kzalloc(sizeof(*pep->tx_skb) * pep->tx_ring_size, |
1080 | GFP_KERNEL); | 1080 | GFP_KERNEL); |
1081 | if (!pep->tx_skb) | 1081 | if (!pep->tx_skb) |
1082 | return -ENOMEM; | 1082 | return -ENOMEM; |
diff --git a/drivers/net/ethernet/mellanox/mlx4/cmd.c b/drivers/net/ethernet/mellanox/mlx4/cmd.c index 1df56cc50ee9..0e572a527154 100644 --- a/drivers/net/ethernet/mellanox/mlx4/cmd.c +++ b/drivers/net/ethernet/mellanox/mlx4/cmd.c | |||
@@ -222,8 +222,6 @@ static int mlx4_comm_cmd_poll(struct mlx4_dev *dev, u8 cmd, u16 param, | |||
222 | * FLR process. The only non-zero result in the RESET command | 222 | * FLR process. The only non-zero result in the RESET command |
223 | * is MLX4_DELAY_RESET_SLAVE*/ | 223 | * is MLX4_DELAY_RESET_SLAVE*/ |
224 | if ((MLX4_COMM_CMD_RESET == cmd)) { | 224 | if ((MLX4_COMM_CMD_RESET == cmd)) { |
225 | mlx4_warn(dev, "Got slave FLRed from Communication" | ||
226 | " channel (ret:0x%x)\n", ret_from_pending); | ||
227 | err = MLX4_DELAY_RESET_SLAVE; | 225 | err = MLX4_DELAY_RESET_SLAVE; |
228 | } else { | 226 | } else { |
229 | mlx4_warn(dev, "Communication channel timed out\n"); | 227 | mlx4_warn(dev, "Communication channel timed out\n"); |
diff --git a/drivers/net/ethernet/mellanox/mlx4/en_netdev.c b/drivers/net/ethernet/mellanox/mlx4/en_netdev.c index b35f94700093..89c47ea84b50 100644 --- a/drivers/net/ethernet/mellanox/mlx4/en_netdev.c +++ b/drivers/net/ethernet/mellanox/mlx4/en_netdev.c | |||
@@ -1323,6 +1323,7 @@ static void mlx4_en_auto_moderation(struct mlx4_en_priv *priv) | |||
1323 | priv->last_moder_time[ring] = moder_time; | 1323 | priv->last_moder_time[ring] = moder_time; |
1324 | cq = &priv->rx_cq[ring]; | 1324 | cq = &priv->rx_cq[ring]; |
1325 | cq->moder_time = moder_time; | 1325 | cq->moder_time = moder_time; |
1326 | cq->moder_cnt = priv->rx_frames; | ||
1326 | err = mlx4_en_set_cq_moder(priv, cq); | 1327 | err = mlx4_en_set_cq_moder(priv, cq); |
1327 | if (err) | 1328 | if (err) |
1328 | en_err(priv, "Failed modifying moderation for cq:%d\n", | 1329 | en_err(priv, "Failed modifying moderation for cq:%d\n", |
@@ -2118,6 +2119,7 @@ int mlx4_en_init_netdev(struct mlx4_en_dev *mdev, int port, | |||
2118 | struct mlx4_en_priv *priv; | 2119 | struct mlx4_en_priv *priv; |
2119 | int i; | 2120 | int i; |
2120 | int err; | 2121 | int err; |
2122 | u64 mac_u64; | ||
2121 | 2123 | ||
2122 | dev = alloc_etherdev_mqs(sizeof(struct mlx4_en_priv), | 2124 | dev = alloc_etherdev_mqs(sizeof(struct mlx4_en_priv), |
2123 | MAX_TX_RINGS, MAX_RX_RINGS); | 2125 | MAX_TX_RINGS, MAX_RX_RINGS); |
@@ -2191,10 +2193,17 @@ int mlx4_en_init_netdev(struct mlx4_en_dev *mdev, int port, | |||
2191 | dev->addr_len = ETH_ALEN; | 2193 | dev->addr_len = ETH_ALEN; |
2192 | mlx4_en_u64_to_mac(dev->dev_addr, mdev->dev->caps.def_mac[priv->port]); | 2194 | mlx4_en_u64_to_mac(dev->dev_addr, mdev->dev->caps.def_mac[priv->port]); |
2193 | if (!is_valid_ether_addr(dev->dev_addr)) { | 2195 | if (!is_valid_ether_addr(dev->dev_addr)) { |
2194 | en_err(priv, "Port: %d, invalid mac burned: %pM, quiting\n", | 2196 | if (mlx4_is_slave(priv->mdev->dev)) { |
2195 | priv->port, dev->dev_addr); | 2197 | eth_hw_addr_random(dev); |
2196 | err = -EINVAL; | 2198 | en_warn(priv, "Assigned random MAC address %pM\n", dev->dev_addr); |
2197 | goto out; | 2199 | mac_u64 = mlx4_en_mac_to_u64(dev->dev_addr); |
2200 | mdev->dev->caps.def_mac[priv->port] = mac_u64; | ||
2201 | } else { | ||
2202 | en_err(priv, "Port: %d, invalid mac burned: %pM, quiting\n", | ||
2203 | priv->port, dev->dev_addr); | ||
2204 | err = -EINVAL; | ||
2205 | goto out; | ||
2206 | } | ||
2198 | } | 2207 | } |
2199 | 2208 | ||
2200 | memcpy(priv->prev_mac, dev->dev_addr, sizeof(priv->prev_mac)); | 2209 | memcpy(priv->prev_mac, dev->dev_addr, sizeof(priv->prev_mac)); |
diff --git a/drivers/net/ethernet/mellanox/mlx4/fw.c b/drivers/net/ethernet/mellanox/mlx4/fw.c index 58a8e535d698..2c97901c6a6d 100644 --- a/drivers/net/ethernet/mellanox/mlx4/fw.c +++ b/drivers/net/ethernet/mellanox/mlx4/fw.c | |||
@@ -840,12 +840,16 @@ int mlx4_QUERY_PORT_wrapper(struct mlx4_dev *dev, int slave, | |||
840 | MLX4_CMD_NATIVE); | 840 | MLX4_CMD_NATIVE); |
841 | 841 | ||
842 | if (!err && dev->caps.function != slave) { | 842 | if (!err && dev->caps.function != slave) { |
843 | /* set slave default_mac address */ | ||
844 | MLX4_GET(def_mac, outbox->buf, QUERY_PORT_MAC_OFFSET); | ||
845 | def_mac += slave << 8; | ||
846 | /* if config MAC in DB use it */ | 843 | /* if config MAC in DB use it */ |
847 | if (priv->mfunc.master.vf_oper[slave].vport[vhcr->in_modifier].state.mac) | 844 | if (priv->mfunc.master.vf_oper[slave].vport[vhcr->in_modifier].state.mac) |
848 | def_mac = priv->mfunc.master.vf_oper[slave].vport[vhcr->in_modifier].state.mac; | 845 | def_mac = priv->mfunc.master.vf_oper[slave].vport[vhcr->in_modifier].state.mac; |
846 | else { | ||
847 | /* set slave default_mac address */ | ||
848 | MLX4_GET(def_mac, outbox->buf, QUERY_PORT_MAC_OFFSET); | ||
849 | def_mac += slave << 8; | ||
850 | priv->mfunc.master.vf_admin[slave].vport[vhcr->in_modifier].mac = def_mac; | ||
851 | } | ||
852 | |||
849 | MLX4_PUT(outbox->buf, def_mac, QUERY_PORT_MAC_OFFSET); | 853 | MLX4_PUT(outbox->buf, def_mac, QUERY_PORT_MAC_OFFSET); |
850 | 854 | ||
851 | /* get port type - currently only eth is enabled */ | 855 | /* get port type - currently only eth is enabled */ |
diff --git a/drivers/net/ethernet/mellanox/mlx4/main.c b/drivers/net/ethernet/mellanox/mlx4/main.c index 0d32a82458bf..8a434997a0df 100644 --- a/drivers/net/ethernet/mellanox/mlx4/main.c +++ b/drivers/net/ethernet/mellanox/mlx4/main.c | |||
@@ -632,6 +632,9 @@ static int mlx4_slave_cap(struct mlx4_dev *dev) | |||
632 | dev->caps.cqe_size = 32; | 632 | dev->caps.cqe_size = 32; |
633 | } | 633 | } |
634 | 634 | ||
635 | dev->caps.flags2 &= ~MLX4_DEV_CAP_FLAG2_TS; | ||
636 | mlx4_warn(dev, "Timestamping is not supported in slave mode.\n"); | ||
637 | |||
635 | slave_adjust_steering_mode(dev, &dev_cap, &hca_param); | 638 | slave_adjust_steering_mode(dev, &dev_cap, &hca_param); |
636 | 639 | ||
637 | return 0; | 640 | return 0; |
@@ -1290,7 +1293,6 @@ static int mlx4_init_slave(struct mlx4_dev *dev) | |||
1290 | { | 1293 | { |
1291 | struct mlx4_priv *priv = mlx4_priv(dev); | 1294 | struct mlx4_priv *priv = mlx4_priv(dev); |
1292 | u64 dma = (u64) priv->mfunc.vhcr_dma; | 1295 | u64 dma = (u64) priv->mfunc.vhcr_dma; |
1293 | int num_of_reset_retries = NUM_OF_RESET_RETRIES; | ||
1294 | int ret_from_reset = 0; | 1296 | int ret_from_reset = 0; |
1295 | u32 slave_read; | 1297 | u32 slave_read; |
1296 | u32 cmd_channel_ver; | 1298 | u32 cmd_channel_ver; |
@@ -1304,18 +1306,10 @@ static int mlx4_init_slave(struct mlx4_dev *dev) | |||
1304 | * NUM_OF_RESET_RETRIES times before leaving.*/ | 1306 | * NUM_OF_RESET_RETRIES times before leaving.*/ |
1305 | if (ret_from_reset) { | 1307 | if (ret_from_reset) { |
1306 | if (MLX4_DELAY_RESET_SLAVE == ret_from_reset) { | 1308 | if (MLX4_DELAY_RESET_SLAVE == ret_from_reset) { |
1307 | msleep(SLEEP_TIME_IN_RESET); | 1309 | mlx4_warn(dev, "slave is currently in the " |
1308 | while (ret_from_reset && num_of_reset_retries) { | 1310 | "middle of FLR. Deferring probe.\n"); |
1309 | mlx4_warn(dev, "slave is currently in the" | 1311 | mutex_unlock(&priv->cmd.slave_cmd_mutex); |
1310 | "middle of FLR. retrying..." | 1312 | return -EPROBE_DEFER; |
1311 | "(try num:%d)\n", | ||
1312 | (NUM_OF_RESET_RETRIES - | ||
1313 | num_of_reset_retries + 1)); | ||
1314 | ret_from_reset = | ||
1315 | mlx4_comm_cmd(dev, MLX4_COMM_CMD_RESET, | ||
1316 | 0, MLX4_COMM_TIME); | ||
1317 | num_of_reset_retries = num_of_reset_retries - 1; | ||
1318 | } | ||
1319 | } else | 1313 | } else |
1320 | goto err; | 1314 | goto err; |
1321 | } | 1315 | } |
@@ -1526,7 +1520,8 @@ static int mlx4_init_hca(struct mlx4_dev *dev) | |||
1526 | } else { | 1520 | } else { |
1527 | err = mlx4_init_slave(dev); | 1521 | err = mlx4_init_slave(dev); |
1528 | if (err) { | 1522 | if (err) { |
1529 | mlx4_err(dev, "Failed to initialize slave\n"); | 1523 | if (err != -EPROBE_DEFER) |
1524 | mlx4_err(dev, "Failed to initialize slave\n"); | ||
1530 | return err; | 1525 | return err; |
1531 | } | 1526 | } |
1532 | 1527 | ||
diff --git a/drivers/net/ethernet/octeon/octeon_mgmt.c b/drivers/net/ethernet/octeon/octeon_mgmt.c index 921729f9c85c..91a8a5d28037 100644 --- a/drivers/net/ethernet/octeon/octeon_mgmt.c +++ b/drivers/net/ethernet/octeon/octeon_mgmt.c | |||
@@ -46,17 +46,25 @@ | |||
46 | union mgmt_port_ring_entry { | 46 | union mgmt_port_ring_entry { |
47 | u64 d64; | 47 | u64 d64; |
48 | struct { | 48 | struct { |
49 | u64 reserved_62_63:2; | 49 | #define RING_ENTRY_CODE_DONE 0xf |
50 | #define RING_ENTRY_CODE_MORE 0x10 | ||
51 | #ifdef __BIG_ENDIAN_BITFIELD | ||
52 | u64 reserved_62_63:2; | ||
50 | /* Length of the buffer/packet in bytes */ | 53 | /* Length of the buffer/packet in bytes */ |
51 | u64 len:14; | 54 | u64 len:14; |
52 | /* For TX, signals that the packet should be timestamped */ | 55 | /* For TX, signals that the packet should be timestamped */ |
53 | u64 tstamp:1; | 56 | u64 tstamp:1; |
54 | /* The RX error code */ | 57 | /* The RX error code */ |
55 | u64 code:7; | 58 | u64 code:7; |
56 | #define RING_ENTRY_CODE_DONE 0xf | ||
57 | #define RING_ENTRY_CODE_MORE 0x10 | ||
58 | /* Physical address of the buffer */ | 59 | /* Physical address of the buffer */ |
59 | u64 addr:40; | 60 | u64 addr:40; |
61 | #else | ||
62 | u64 addr:40; | ||
63 | u64 code:7; | ||
64 | u64 tstamp:1; | ||
65 | u64 len:14; | ||
66 | u64 reserved_62_63:2; | ||
67 | #endif | ||
60 | } s; | 68 | } s; |
61 | }; | 69 | }; |
62 | 70 | ||
@@ -1141,10 +1149,13 @@ static int octeon_mgmt_open(struct net_device *netdev) | |||
1141 | /* For compensation state to lock. */ | 1149 | /* For compensation state to lock. */ |
1142 | ndelay(1040 * NS_PER_PHY_CLK); | 1150 | ndelay(1040 * NS_PER_PHY_CLK); |
1143 | 1151 | ||
1144 | /* Some Ethernet switches cannot handle standard | 1152 | /* Default Interframe Gaps are too small. Recommended |
1145 | * Interframe Gap, increase to 16 bytes. | 1153 | * workaround is. |
1154 | * | ||
1155 | * AGL_GMX_TX_IFG[IFG1]=14 | ||
1156 | * AGL_GMX_TX_IFG[IFG2]=10 | ||
1146 | */ | 1157 | */ |
1147 | cvmx_write_csr(CVMX_AGL_GMX_TX_IFG, 0x88); | 1158 | cvmx_write_csr(CVMX_AGL_GMX_TX_IFG, 0xae); |
1148 | } | 1159 | } |
1149 | 1160 | ||
1150 | octeon_mgmt_rx_fill_ring(netdev); | 1161 | octeon_mgmt_rx_fill_ring(netdev); |
diff --git a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_ctx.c b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_ctx.c index 43562c256379..6acf82b9f018 100644 --- a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_ctx.c +++ b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_ctx.c | |||
@@ -642,7 +642,7 @@ void qlcnic_fw_destroy_ctx(struct qlcnic_adapter *adapter) | |||
642 | qlcnic_83xx_config_intrpt(adapter, 0); | 642 | qlcnic_83xx_config_intrpt(adapter, 0); |
643 | } | 643 | } |
644 | /* Allow dma queues to drain after context reset */ | 644 | /* Allow dma queues to drain after context reset */ |
645 | msleep(20); | 645 | mdelay(20); |
646 | } | 646 | } |
647 | } | 647 | } |
648 | 648 | ||
diff --git a/drivers/net/ethernet/qlogic/qlge/qlge_main.c b/drivers/net/ethernet/qlogic/qlge/qlge_main.c index 50235d201592..f87cc216045b 100644 --- a/drivers/net/ethernet/qlogic/qlge/qlge_main.c +++ b/drivers/net/ethernet/qlogic/qlge/qlge_main.c | |||
@@ -4717,6 +4717,7 @@ static int qlge_probe(struct pci_dev *pdev, | |||
4717 | dev_err(&pdev->dev, "net device registration failed.\n"); | 4717 | dev_err(&pdev->dev, "net device registration failed.\n"); |
4718 | ql_release_all(pdev); | 4718 | ql_release_all(pdev); |
4719 | pci_disable_device(pdev); | 4719 | pci_disable_device(pdev); |
4720 | free_netdev(ndev); | ||
4720 | return err; | 4721 | return err; |
4721 | } | 4722 | } |
4722 | /* Start up the timer to trigger EEH if | 4723 | /* Start up the timer to trigger EEH if |
diff --git a/drivers/net/ethernet/renesas/sh_eth.c b/drivers/net/ethernet/renesas/sh_eth.c index 42e9dd05c936..e29fe8dbd226 100644 --- a/drivers/net/ethernet/renesas/sh_eth.c +++ b/drivers/net/ethernet/renesas/sh_eth.c | |||
@@ -380,8 +380,9 @@ static struct sh_eth_cpu_data sh_eth_my_cpu_data = { | |||
380 | .eesipr_value = 0x01ff009f, | 380 | .eesipr_value = 0x01ff009f, |
381 | 381 | ||
382 | .tx_check = EESR_FTC | EESR_CND | EESR_DLC | EESR_CD | EESR_RTO, | 382 | .tx_check = EESR_FTC | EESR_CND | EESR_DLC | EESR_CD | EESR_RTO, |
383 | .eesr_err_check = EESR_TWB | EESR_TABT | EESR_RABT | EESR_RDE | | 383 | .eesr_err_check = EESR_TWB | EESR_TABT | EESR_RABT | EESR_RFE | |
384 | EESR_RFRMER | EESR_TFE | EESR_TDE | EESR_ECI, | 384 | EESR_RDE | EESR_RFRMER | EESR_TFE | EESR_TDE | |
385 | EESR_ECI, | ||
385 | .tx_error_check = EESR_TWB | EESR_TABT | EESR_TDE | EESR_TFE, | 386 | .tx_error_check = EESR_TWB | EESR_TABT | EESR_TDE | EESR_TFE, |
386 | 387 | ||
387 | .apr = 1, | 388 | .apr = 1, |
@@ -427,8 +428,9 @@ static struct sh_eth_cpu_data sh_eth_my_cpu_data = { | |||
427 | .eesipr_value = DMAC_M_RFRMER | DMAC_M_ECI | 0x01ff009f, | 428 | .eesipr_value = DMAC_M_RFRMER | DMAC_M_ECI | 0x01ff009f, |
428 | 429 | ||
429 | .tx_check = EESR_FTC | EESR_CND | EESR_DLC | EESR_CD | EESR_RTO, | 430 | .tx_check = EESR_FTC | EESR_CND | EESR_DLC | EESR_CD | EESR_RTO, |
430 | .eesr_err_check = EESR_TWB | EESR_TABT | EESR_RABT | EESR_RDE | | 431 | .eesr_err_check = EESR_TWB | EESR_TABT | EESR_RABT | EESR_RFE | |
431 | EESR_RFRMER | EESR_TFE | EESR_TDE | EESR_ECI, | 432 | EESR_RDE | EESR_RFRMER | EESR_TFE | EESR_TDE | |
433 | EESR_ECI, | ||
432 | .tx_error_check = EESR_TWB | EESR_TABT | EESR_TDE | EESR_TFE, | 434 | .tx_error_check = EESR_TWB | EESR_TABT | EESR_TDE | EESR_TFE, |
433 | 435 | ||
434 | .apr = 1, | 436 | .apr = 1, |
@@ -478,8 +480,9 @@ static struct sh_eth_cpu_data sh_eth_my_cpu_data = { | |||
478 | .rmcr_value = 0x00000001, | 480 | .rmcr_value = 0x00000001, |
479 | 481 | ||
480 | .tx_check = EESR_FTC | EESR_CND | EESR_DLC | EESR_CD | EESR_RTO, | 482 | .tx_check = EESR_FTC | EESR_CND | EESR_DLC | EESR_CD | EESR_RTO, |
481 | .eesr_err_check = EESR_TWB | EESR_TABT | EESR_RABT | EESR_RDE | | 483 | .eesr_err_check = EESR_TWB | EESR_TABT | EESR_RABT | EESR_RFE | |
482 | EESR_RFRMER | EESR_TFE | EESR_TDE | EESR_ECI, | 484 | EESR_RDE | EESR_RFRMER | EESR_TFE | EESR_TDE | |
485 | EESR_ECI, | ||
483 | .tx_error_check = EESR_TWB | EESR_TABT | EESR_TDE | EESR_TFE, | 486 | .tx_error_check = EESR_TWB | EESR_TABT | EESR_TDE | EESR_TFE, |
484 | 487 | ||
485 | .apr = 1, | 488 | .apr = 1, |
@@ -592,9 +595,9 @@ static struct sh_eth_cpu_data sh_eth_my_cpu_data_giga = { | |||
592 | .eesipr_value = DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff, | 595 | .eesipr_value = DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff, |
593 | 596 | ||
594 | .tx_check = EESR_TC1 | EESR_FTC, | 597 | .tx_check = EESR_TC1 | EESR_FTC, |
595 | .eesr_err_check = EESR_TWB1 | EESR_TWB | EESR_TABT | EESR_RABT | \ | 598 | .eesr_err_check = EESR_TWB1 | EESR_TWB | EESR_TABT | EESR_RABT | |
596 | EESR_RDE | EESR_RFRMER | EESR_TFE | EESR_TDE | \ | 599 | EESR_RFE | EESR_RDE | EESR_RFRMER | EESR_TFE | |
597 | EESR_ECI, | 600 | EESR_TDE | EESR_ECI, |
598 | .tx_error_check = EESR_TWB1 | EESR_TWB | EESR_TABT | EESR_TDE | \ | 601 | .tx_error_check = EESR_TWB1 | EESR_TWB | EESR_TABT | EESR_TDE | \ |
599 | EESR_TFE, | 602 | EESR_TFE, |
600 | .fdr_value = 0x0000072f, | 603 | .fdr_value = 0x0000072f, |
@@ -674,9 +677,9 @@ static struct sh_eth_cpu_data sh_eth_my_cpu_data = { | |||
674 | .eesipr_value = DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff, | 677 | .eesipr_value = DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff, |
675 | 678 | ||
676 | .tx_check = EESR_TC1 | EESR_FTC, | 679 | .tx_check = EESR_TC1 | EESR_FTC, |
677 | .eesr_err_check = EESR_TWB1 | EESR_TWB | EESR_TABT | EESR_RABT | \ | 680 | .eesr_err_check = EESR_TWB1 | EESR_TWB | EESR_TABT | EESR_RABT | |
678 | EESR_RDE | EESR_RFRMER | EESR_TFE | EESR_TDE | \ | 681 | EESR_RFE | EESR_RDE | EESR_RFRMER | EESR_TFE | |
679 | EESR_ECI, | 682 | EESR_TDE | EESR_ECI, |
680 | .tx_error_check = EESR_TWB1 | EESR_TWB | EESR_TABT | EESR_TDE | \ | 683 | .tx_error_check = EESR_TWB1 | EESR_TWB | EESR_TABT | EESR_TDE | \ |
681 | EESR_TFE, | 684 | EESR_TFE, |
682 | 685 | ||
@@ -811,9 +814,9 @@ static struct sh_eth_cpu_data sh_eth_my_cpu_data = { | |||
811 | .eesipr_value = DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff, | 814 | .eesipr_value = DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff, |
812 | 815 | ||
813 | .tx_check = EESR_TC1 | EESR_FTC, | 816 | .tx_check = EESR_TC1 | EESR_FTC, |
814 | .eesr_err_check = EESR_TWB1 | EESR_TWB | EESR_TABT | EESR_RABT | \ | 817 | .eesr_err_check = EESR_TWB1 | EESR_TWB | EESR_TABT | EESR_RABT | |
815 | EESR_RDE | EESR_RFRMER | EESR_TFE | EESR_TDE | \ | 818 | EESR_RFE | EESR_RDE | EESR_RFRMER | EESR_TFE | |
816 | EESR_ECI, | 819 | EESR_TDE | EESR_ECI, |
817 | .tx_error_check = EESR_TWB1 | EESR_TWB | EESR_TABT | EESR_TDE | \ | 820 | .tx_error_check = EESR_TWB1 | EESR_TWB | EESR_TABT | EESR_TDE | \ |
818 | EESR_TFE, | 821 | EESR_TFE, |
819 | 822 | ||
@@ -897,8 +900,8 @@ static int sh_eth_check_reset(struct net_device *ndev) | |||
897 | mdelay(1); | 900 | mdelay(1); |
898 | cnt--; | 901 | cnt--; |
899 | } | 902 | } |
900 | if (cnt < 0) { | 903 | if (cnt <= 0) { |
901 | pr_err("Device reset fail\n"); | 904 | pr_err("Device reset failed\n"); |
902 | ret = -ETIMEDOUT; | 905 | ret = -ETIMEDOUT; |
903 | } | 906 | } |
904 | return ret; | 907 | return ret; |
@@ -1401,16 +1404,23 @@ static int sh_eth_rx(struct net_device *ndev, u32 intr_status) | |||
1401 | desc_status = edmac_to_cpu(mdp, rxdesc->status); | 1404 | desc_status = edmac_to_cpu(mdp, rxdesc->status); |
1402 | pkt_len = rxdesc->frame_length; | 1405 | pkt_len = rxdesc->frame_length; |
1403 | 1406 | ||
1404 | #if defined(CONFIG_ARCH_R8A7740) | ||
1405 | desc_status >>= 16; | ||
1406 | #endif | ||
1407 | |||
1408 | if (--boguscnt < 0) | 1407 | if (--boguscnt < 0) |
1409 | break; | 1408 | break; |
1410 | 1409 | ||
1411 | if (!(desc_status & RDFEND)) | 1410 | if (!(desc_status & RDFEND)) |
1412 | ndev->stats.rx_length_errors++; | 1411 | ndev->stats.rx_length_errors++; |
1413 | 1412 | ||
1413 | #if defined(CONFIG_ARCH_R8A7740) | ||
1414 | /* | ||
1415 | * In case of almost all GETHER/ETHERs, the Receive Frame State | ||
1416 | * (RFS) bits in the Receive Descriptor 0 are from bit 9 to | ||
1417 | * bit 0. However, in case of the R8A7740's GETHER, the RFS | ||
1418 | * bits are from bit 25 to bit 16. So, the driver needs right | ||
1419 | * shifting by 16. | ||
1420 | */ | ||
1421 | desc_status >>= 16; | ||
1422 | #endif | ||
1423 | |||
1414 | if (desc_status & (RD_RFS1 | RD_RFS2 | RD_RFS3 | RD_RFS4 | | 1424 | if (desc_status & (RD_RFS1 | RD_RFS2 | RD_RFS3 | RD_RFS4 | |
1415 | RD_RFS5 | RD_RFS6 | RD_RFS10)) { | 1425 | RD_RFS5 | RD_RFS6 | RD_RFS10)) { |
1416 | ndev->stats.rx_errors++; | 1426 | ndev->stats.rx_errors++; |
@@ -1542,11 +1552,12 @@ static void sh_eth_error(struct net_device *ndev, int intr_status) | |||
1542 | 1552 | ||
1543 | ignore_link: | 1553 | ignore_link: |
1544 | if (intr_status & EESR_TWB) { | 1554 | if (intr_status & EESR_TWB) { |
1545 | /* Write buck end. unused write back interrupt */ | 1555 | /* Unused write back interrupt */ |
1546 | if (intr_status & EESR_TABT) /* Transmit Abort int */ | 1556 | if (intr_status & EESR_TABT) { /* Transmit Abort int */ |
1547 | ndev->stats.tx_aborted_errors++; | 1557 | ndev->stats.tx_aborted_errors++; |
1548 | if (netif_msg_tx_err(mdp)) | 1558 | if (netif_msg_tx_err(mdp)) |
1549 | dev_err(&ndev->dev, "Transmit Abort\n"); | 1559 | dev_err(&ndev->dev, "Transmit Abort\n"); |
1560 | } | ||
1550 | } | 1561 | } |
1551 | 1562 | ||
1552 | if (intr_status & EESR_RABT) { | 1563 | if (intr_status & EESR_RABT) { |
diff --git a/drivers/net/ethernet/renesas/sh_eth.h b/drivers/net/ethernet/renesas/sh_eth.h index 1ddc9f235bcb..62689a5823be 100644 --- a/drivers/net/ethernet/renesas/sh_eth.h +++ b/drivers/net/ethernet/renesas/sh_eth.h | |||
@@ -253,7 +253,7 @@ enum EESR_BIT { | |||
253 | 253 | ||
254 | #define DEFAULT_TX_CHECK (EESR_FTC | EESR_CND | EESR_DLC | EESR_CD | \ | 254 | #define DEFAULT_TX_CHECK (EESR_FTC | EESR_CND | EESR_DLC | EESR_CD | \ |
255 | EESR_RTO) | 255 | EESR_RTO) |
256 | #define DEFAULT_EESR_ERR_CHECK (EESR_TWB | EESR_TABT | EESR_RABT | \ | 256 | #define DEFAULT_EESR_ERR_CHECK (EESR_TWB | EESR_TABT | EESR_RABT | EESR_RFE | \ |
257 | EESR_RDE | EESR_RFRMER | EESR_ADE | \ | 257 | EESR_RDE | EESR_RFRMER | EESR_ADE | \ |
258 | EESR_TFE | EESR_TDE | EESR_ECI) | 258 | EESR_TFE | EESR_TDE | EESR_ECI) |
259 | #define DEFAULT_TX_ERROR_CHECK (EESR_TWB | EESR_TABT | EESR_ADE | EESR_TDE | \ | 259 | #define DEFAULT_TX_ERROR_CHECK (EESR_TWB | EESR_TABT | EESR_ADE | EESR_TDE | \ |
diff --git a/drivers/net/ethernet/sfc/efx.c b/drivers/net/ethernet/sfc/efx.c index 39e4cb39de29..4a14a940c65e 100644 --- a/drivers/net/ethernet/sfc/efx.c +++ b/drivers/net/ethernet/sfc/efx.c | |||
@@ -2139,7 +2139,7 @@ show_phy_type(struct device *dev, struct device_attribute *attr, char *buf) | |||
2139 | struct efx_nic *efx = pci_get_drvdata(to_pci_dev(dev)); | 2139 | struct efx_nic *efx = pci_get_drvdata(to_pci_dev(dev)); |
2140 | return sprintf(buf, "%d\n", efx->phy_type); | 2140 | return sprintf(buf, "%d\n", efx->phy_type); |
2141 | } | 2141 | } |
2142 | static DEVICE_ATTR(phy_type, 0644, show_phy_type, NULL); | 2142 | static DEVICE_ATTR(phy_type, 0444, show_phy_type, NULL); |
2143 | 2143 | ||
2144 | static int efx_register_netdev(struct efx_nic *efx) | 2144 | static int efx_register_netdev(struct efx_nic *efx) |
2145 | { | 2145 | { |
diff --git a/drivers/net/ethernet/stmicro/stmmac/common.h b/drivers/net/ethernet/stmicro/stmmac/common.h index 7788fbe44f0a..95176979b2d2 100644 --- a/drivers/net/ethernet/stmicro/stmmac/common.h +++ b/drivers/net/ethernet/stmicro/stmmac/common.h | |||
@@ -297,8 +297,8 @@ struct dma_features { | |||
297 | #define MAC_RNABLE_RX 0x00000004 /* Receiver Enable */ | 297 | #define MAC_RNABLE_RX 0x00000004 /* Receiver Enable */ |
298 | 298 | ||
299 | /* Default LPI timers */ | 299 | /* Default LPI timers */ |
300 | #define STMMAC_DEFAULT_LIT_LS_TIMER 0x3E8 | 300 | #define STMMAC_DEFAULT_LIT_LS 0x3E8 |
301 | #define STMMAC_DEFAULT_TWT_LS_TIMER 0x0 | 301 | #define STMMAC_DEFAULT_TWT_LS 0x0 |
302 | 302 | ||
303 | #define STMMAC_CHAIN_MODE 0x1 | 303 | #define STMMAC_CHAIN_MODE 0x1 |
304 | #define STMMAC_RING_MODE 0x2 | 304 | #define STMMAC_RING_MODE 0x2 |
diff --git a/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c b/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c index 618446ae1ec1..e9eab29db7be 100644 --- a/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c +++ b/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c | |||
@@ -130,7 +130,7 @@ static const u32 default_msg_level = (NETIF_MSG_DRV | NETIF_MSG_PROBE | | |||
130 | static int eee_timer = STMMAC_DEFAULT_LPI_TIMER; | 130 | static int eee_timer = STMMAC_DEFAULT_LPI_TIMER; |
131 | module_param(eee_timer, int, S_IRUGO | S_IWUSR); | 131 | module_param(eee_timer, int, S_IRUGO | S_IWUSR); |
132 | MODULE_PARM_DESC(eee_timer, "LPI tx expiration time in msec"); | 132 | MODULE_PARM_DESC(eee_timer, "LPI tx expiration time in msec"); |
133 | #define STMMAC_LPI_TIMER(x) (jiffies + msecs_to_jiffies(x)) | 133 | #define STMMAC_LPI_T(x) (jiffies + msecs_to_jiffies(x)) |
134 | 134 | ||
135 | /* By default the driver will use the ring mode to manage tx and rx descriptors | 135 | /* By default the driver will use the ring mode to manage tx and rx descriptors |
136 | * but passing this value so user can force to use the chain instead of the ring | 136 | * but passing this value so user can force to use the chain instead of the ring |
@@ -288,7 +288,7 @@ static void stmmac_eee_ctrl_timer(unsigned long arg) | |||
288 | struct stmmac_priv *priv = (struct stmmac_priv *)arg; | 288 | struct stmmac_priv *priv = (struct stmmac_priv *)arg; |
289 | 289 | ||
290 | stmmac_enable_eee_mode(priv); | 290 | stmmac_enable_eee_mode(priv); |
291 | mod_timer(&priv->eee_ctrl_timer, STMMAC_LPI_TIMER(eee_timer)); | 291 | mod_timer(&priv->eee_ctrl_timer, STMMAC_LPI_T(eee_timer)); |
292 | } | 292 | } |
293 | 293 | ||
294 | /** | 294 | /** |
@@ -304,22 +304,34 @@ bool stmmac_eee_init(struct stmmac_priv *priv) | |||
304 | { | 304 | { |
305 | bool ret = false; | 305 | bool ret = false; |
306 | 306 | ||
307 | /* Using PCS we cannot dial with the phy registers at this stage | ||
308 | * so we do not support extra feature like EEE. | ||
309 | */ | ||
310 | if ((priv->pcs == STMMAC_PCS_RGMII) || (priv->pcs == STMMAC_PCS_TBI) || | ||
311 | (priv->pcs == STMMAC_PCS_RTBI)) | ||
312 | goto out; | ||
313 | |||
307 | /* MAC core supports the EEE feature. */ | 314 | /* MAC core supports the EEE feature. */ |
308 | if (priv->dma_cap.eee) { | 315 | if (priv->dma_cap.eee) { |
309 | /* Check if the PHY supports EEE */ | 316 | /* Check if the PHY supports EEE */ |
310 | if (phy_init_eee(priv->phydev, 1)) | 317 | if (phy_init_eee(priv->phydev, 1)) |
311 | goto out; | 318 | goto out; |
312 | 319 | ||
313 | priv->eee_active = 1; | 320 | if (!priv->eee_active) { |
314 | init_timer(&priv->eee_ctrl_timer); | 321 | priv->eee_active = 1; |
315 | priv->eee_ctrl_timer.function = stmmac_eee_ctrl_timer; | 322 | init_timer(&priv->eee_ctrl_timer); |
316 | priv->eee_ctrl_timer.data = (unsigned long)priv; | 323 | priv->eee_ctrl_timer.function = stmmac_eee_ctrl_timer; |
317 | priv->eee_ctrl_timer.expires = STMMAC_LPI_TIMER(eee_timer); | 324 | priv->eee_ctrl_timer.data = (unsigned long)priv; |
318 | add_timer(&priv->eee_ctrl_timer); | 325 | priv->eee_ctrl_timer.expires = STMMAC_LPI_T(eee_timer); |
319 | 326 | add_timer(&priv->eee_ctrl_timer); | |
320 | priv->hw->mac->set_eee_timer(priv->ioaddr, | 327 | |
321 | STMMAC_DEFAULT_LIT_LS_TIMER, | 328 | priv->hw->mac->set_eee_timer(priv->ioaddr, |
322 | priv->tx_lpi_timer); | 329 | STMMAC_DEFAULT_LIT_LS, |
330 | priv->tx_lpi_timer); | ||
331 | } else | ||
332 | /* Set HW EEE according to the speed */ | ||
333 | priv->hw->mac->set_eee_pls(priv->ioaddr, | ||
334 | priv->phydev->link); | ||
323 | 335 | ||
324 | pr_info("stmmac: Energy-Efficient Ethernet initialized\n"); | 336 | pr_info("stmmac: Energy-Efficient Ethernet initialized\n"); |
325 | 337 | ||
@@ -329,20 +341,6 @@ out: | |||
329 | return ret; | 341 | return ret; |
330 | } | 342 | } |
331 | 343 | ||
332 | /** | ||
333 | * stmmac_eee_adjust: adjust HW EEE according to the speed | ||
334 | * @priv: driver private structure | ||
335 | * Description: | ||
336 | * When the EEE has been already initialised we have to | ||
337 | * modify the PLS bit in the LPI ctrl & status reg according | ||
338 | * to the PHY link status. For this reason. | ||
339 | */ | ||
340 | static void stmmac_eee_adjust(struct stmmac_priv *priv) | ||
341 | { | ||
342 | if (priv->eee_enabled) | ||
343 | priv->hw->mac->set_eee_pls(priv->ioaddr, priv->phydev->link); | ||
344 | } | ||
345 | |||
346 | /* stmmac_get_tx_hwtstamp: get HW TX timestamps | 344 | /* stmmac_get_tx_hwtstamp: get HW TX timestamps |
347 | * @priv: driver private structure | 345 | * @priv: driver private structure |
348 | * @entry : descriptor index to be used. | 346 | * @entry : descriptor index to be used. |
@@ -769,7 +767,10 @@ static void stmmac_adjust_link(struct net_device *dev) | |||
769 | if (new_state && netif_msg_link(priv)) | 767 | if (new_state && netif_msg_link(priv)) |
770 | phy_print_status(phydev); | 768 | phy_print_status(phydev); |
771 | 769 | ||
772 | stmmac_eee_adjust(priv); | 770 | /* At this stage, it could be needed to setup the EEE or adjust some |
771 | * MAC related HW registers. | ||
772 | */ | ||
773 | priv->eee_enabled = stmmac_eee_init(priv); | ||
773 | 774 | ||
774 | spin_unlock_irqrestore(&priv->lock, flags); | 775 | spin_unlock_irqrestore(&priv->lock, flags); |
775 | 776 | ||
@@ -1277,7 +1278,7 @@ static void stmmac_tx_clean(struct stmmac_priv *priv) | |||
1277 | 1278 | ||
1278 | if ((priv->eee_enabled) && (!priv->tx_path_in_lpi_mode)) { | 1279 | if ((priv->eee_enabled) && (!priv->tx_path_in_lpi_mode)) { |
1279 | stmmac_enable_eee_mode(priv); | 1280 | stmmac_enable_eee_mode(priv); |
1280 | mod_timer(&priv->eee_ctrl_timer, STMMAC_LPI_TIMER(eee_timer)); | 1281 | mod_timer(&priv->eee_ctrl_timer, STMMAC_LPI_T(eee_timer)); |
1281 | } | 1282 | } |
1282 | spin_unlock(&priv->tx_lock); | 1283 | spin_unlock(&priv->tx_lock); |
1283 | } | 1284 | } |
@@ -1671,14 +1672,9 @@ static int stmmac_open(struct net_device *dev) | |||
1671 | if (priv->phydev) | 1672 | if (priv->phydev) |
1672 | phy_start(priv->phydev); | 1673 | phy_start(priv->phydev); |
1673 | 1674 | ||
1674 | priv->tx_lpi_timer = STMMAC_DEFAULT_TWT_LS_TIMER; | 1675 | priv->tx_lpi_timer = STMMAC_DEFAULT_TWT_LS; |
1675 | 1676 | ||
1676 | /* Using PCS we cannot dial with the phy registers at this stage | 1677 | priv->eee_enabled = stmmac_eee_init(priv); |
1677 | * so we do not support extra feature like EEE. | ||
1678 | */ | ||
1679 | if (priv->pcs != STMMAC_PCS_RGMII && priv->pcs != STMMAC_PCS_TBI && | ||
1680 | priv->pcs != STMMAC_PCS_RTBI) | ||
1681 | priv->eee_enabled = stmmac_eee_init(priv); | ||
1682 | 1678 | ||
1683 | stmmac_init_tx_coalesce(priv); | 1679 | stmmac_init_tx_coalesce(priv); |
1684 | 1680 | ||
@@ -1899,7 +1895,7 @@ static netdev_tx_t stmmac_xmit(struct sk_buff *skb, struct net_device *dev) | |||
1899 | 1895 | ||
1900 | #ifdef STMMAC_XMIT_DEBUG | 1896 | #ifdef STMMAC_XMIT_DEBUG |
1901 | if (netif_msg_pktdata(priv)) { | 1897 | if (netif_msg_pktdata(priv)) { |
1902 | pr_info("%s: curr %d dirty=%d entry=%d, first=%p, nfrags=%d" | 1898 | pr_info("%s: curr %d dirty=%d entry=%d, first=%p, nfrags=%d", |
1903 | __func__, (priv->cur_tx % txsize), | 1899 | __func__, (priv->cur_tx % txsize), |
1904 | (priv->dirty_tx % txsize), entry, first, nfrags); | 1900 | (priv->dirty_tx % txsize), entry, first, nfrags); |
1905 | if (priv->extend_desc) | 1901 | if (priv->extend_desc) |
diff --git a/drivers/net/ethernet/ti/cpsw.c b/drivers/net/ethernet/ti/cpsw.c index 21a5b291b4b3..d1a769f35f9d 100644 --- a/drivers/net/ethernet/ti/cpsw.c +++ b/drivers/net/ethernet/ti/cpsw.c | |||
@@ -1679,7 +1679,7 @@ static int cpsw_probe(struct platform_device *pdev) | |||
1679 | priv->rx_packet_max = max(rx_packet_max, 128); | 1679 | priv->rx_packet_max = max(rx_packet_max, 128); |
1680 | priv->cpts = devm_kzalloc(&pdev->dev, sizeof(struct cpts), GFP_KERNEL); | 1680 | priv->cpts = devm_kzalloc(&pdev->dev, sizeof(struct cpts), GFP_KERNEL); |
1681 | priv->irq_enabled = true; | 1681 | priv->irq_enabled = true; |
1682 | if (!ndev) { | 1682 | if (!priv->cpts) { |
1683 | pr_err("error allocating cpts\n"); | 1683 | pr_err("error allocating cpts\n"); |
1684 | goto clean_ndev_ret; | 1684 | goto clean_ndev_ret; |
1685 | } | 1685 | } |
@@ -1973,9 +1973,12 @@ static int cpsw_suspend(struct device *dev) | |||
1973 | { | 1973 | { |
1974 | struct platform_device *pdev = to_platform_device(dev); | 1974 | struct platform_device *pdev = to_platform_device(dev); |
1975 | struct net_device *ndev = platform_get_drvdata(pdev); | 1975 | struct net_device *ndev = platform_get_drvdata(pdev); |
1976 | struct cpsw_priv *priv = netdev_priv(ndev); | ||
1976 | 1977 | ||
1977 | if (netif_running(ndev)) | 1978 | if (netif_running(ndev)) |
1978 | cpsw_ndo_stop(ndev); | 1979 | cpsw_ndo_stop(ndev); |
1980 | soft_reset("sliver 0", &priv->slaves[0].sliver->soft_reset); | ||
1981 | soft_reset("sliver 1", &priv->slaves[1].sliver->soft_reset); | ||
1979 | pm_runtime_put_sync(&pdev->dev); | 1982 | pm_runtime_put_sync(&pdev->dev); |
1980 | 1983 | ||
1981 | return 0; | 1984 | return 0; |
diff --git a/drivers/net/ethernet/ti/davinci_cpdma.c b/drivers/net/ethernet/ti/davinci_cpdma.c index 49dfd592ac1e..053c84fd0853 100644 --- a/drivers/net/ethernet/ti/davinci_cpdma.c +++ b/drivers/net/ethernet/ti/davinci_cpdma.c | |||
@@ -705,6 +705,13 @@ int cpdma_chan_submit(struct cpdma_chan *chan, void *token, void *data, | |||
705 | } | 705 | } |
706 | 706 | ||
707 | buffer = dma_map_single(ctlr->dev, data, len, chan->dir); | 707 | buffer = dma_map_single(ctlr->dev, data, len, chan->dir); |
708 | ret = dma_mapping_error(ctlr->dev, buffer); | ||
709 | if (ret) { | ||
710 | cpdma_desc_free(ctlr->pool, desc, 1); | ||
711 | ret = -EINVAL; | ||
712 | goto unlock_ret; | ||
713 | } | ||
714 | |||
708 | mode = CPDMA_DESC_OWNER | CPDMA_DESC_SOP | CPDMA_DESC_EOP; | 715 | mode = CPDMA_DESC_OWNER | CPDMA_DESC_SOP | CPDMA_DESC_EOP; |
709 | cpdma_desc_to_port(chan, mode, directed); | 716 | cpdma_desc_to_port(chan, mode, directed); |
710 | 717 | ||
diff --git a/drivers/net/ethernet/ti/davinci_mdio.c b/drivers/net/ethernet/ti/davinci_mdio.c index 12aec173564c..c47f0dbcebb5 100644 --- a/drivers/net/ethernet/ti/davinci_mdio.c +++ b/drivers/net/ethernet/ti/davinci_mdio.c | |||
@@ -449,10 +449,9 @@ static int davinci_mdio_suspend(struct device *dev) | |||
449 | __raw_writel(ctrl, &data->regs->control); | 449 | __raw_writel(ctrl, &data->regs->control); |
450 | wait_for_idle(data); | 450 | wait_for_idle(data); |
451 | 451 | ||
452 | pm_runtime_put_sync(data->dev); | ||
453 | |||
454 | data->suspended = true; | 452 | data->suspended = true; |
455 | spin_unlock(&data->lock); | 453 | spin_unlock(&data->lock); |
454 | pm_runtime_put_sync(data->dev); | ||
456 | 455 | ||
457 | return 0; | 456 | return 0; |
458 | } | 457 | } |
@@ -460,15 +459,12 @@ static int davinci_mdio_suspend(struct device *dev) | |||
460 | static int davinci_mdio_resume(struct device *dev) | 459 | static int davinci_mdio_resume(struct device *dev) |
461 | { | 460 | { |
462 | struct davinci_mdio_data *data = dev_get_drvdata(dev); | 461 | struct davinci_mdio_data *data = dev_get_drvdata(dev); |
463 | u32 ctrl; | ||
464 | 462 | ||
465 | spin_lock(&data->lock); | ||
466 | pm_runtime_get_sync(data->dev); | 463 | pm_runtime_get_sync(data->dev); |
467 | 464 | ||
465 | spin_lock(&data->lock); | ||
468 | /* restart the scan state machine */ | 466 | /* restart the scan state machine */ |
469 | ctrl = __raw_readl(&data->regs->control); | 467 | __davinci_mdio_reset(data); |
470 | ctrl |= CONTROL_ENABLE; | ||
471 | __raw_writel(ctrl, &data->regs->control); | ||
472 | 468 | ||
473 | data->suspended = false; | 469 | data->suspended = false; |
474 | spin_unlock(&data->lock); | 470 | spin_unlock(&data->lock); |
@@ -477,8 +473,8 @@ static int davinci_mdio_resume(struct device *dev) | |||
477 | } | 473 | } |
478 | 474 | ||
479 | static const struct dev_pm_ops davinci_mdio_pm_ops = { | 475 | static const struct dev_pm_ops davinci_mdio_pm_ops = { |
480 | .suspend = davinci_mdio_suspend, | 476 | .suspend_late = davinci_mdio_suspend, |
481 | .resume = davinci_mdio_resume, | 477 | .resume_early = davinci_mdio_resume, |
482 | }; | 478 | }; |
483 | 479 | ||
484 | static const struct of_device_id davinci_mdio_of_mtable[] = { | 480 | static const struct of_device_id davinci_mdio_of_mtable[] = { |
diff --git a/drivers/net/ethernet/xilinx/xilinx_emaclite.c b/drivers/net/ethernet/xilinx/xilinx_emaclite.c index 919b983114e9..b7268b3dae77 100644 --- a/drivers/net/ethernet/xilinx/xilinx_emaclite.c +++ b/drivers/net/ethernet/xilinx/xilinx_emaclite.c | |||
@@ -946,7 +946,8 @@ static int xemaclite_open(struct net_device *dev) | |||
946 | phy_write(lp->phy_dev, MII_CTRL1000, 0); | 946 | phy_write(lp->phy_dev, MII_CTRL1000, 0); |
947 | 947 | ||
948 | /* Advertise only 10 and 100mbps full/half duplex speeds */ | 948 | /* Advertise only 10 and 100mbps full/half duplex speeds */ |
949 | phy_write(lp->phy_dev, MII_ADVERTISE, ADVERTISE_ALL); | 949 | phy_write(lp->phy_dev, MII_ADVERTISE, ADVERTISE_ALL | |
950 | ADVERTISE_CSMA); | ||
950 | 951 | ||
951 | /* Restart auto negotiation */ | 952 | /* Restart auto negotiation */ |
952 | bmcr = phy_read(lp->phy_dev, MII_BMCR); | 953 | bmcr = phy_read(lp->phy_dev, MII_BMCR); |
diff --git a/drivers/net/hyperv/netvsc_drv.c b/drivers/net/hyperv/netvsc_drv.c index 088c55496191..4dccead586be 100644 --- a/drivers/net/hyperv/netvsc_drv.c +++ b/drivers/net/hyperv/netvsc_drv.c | |||
@@ -31,6 +31,7 @@ | |||
31 | #include <linux/inetdevice.h> | 31 | #include <linux/inetdevice.h> |
32 | #include <linux/etherdevice.h> | 32 | #include <linux/etherdevice.h> |
33 | #include <linux/skbuff.h> | 33 | #include <linux/skbuff.h> |
34 | #include <linux/if_vlan.h> | ||
34 | #include <linux/in.h> | 35 | #include <linux/in.h> |
35 | #include <linux/slab.h> | 36 | #include <linux/slab.h> |
36 | #include <net/arp.h> | 37 | #include <net/arp.h> |
@@ -284,7 +285,9 @@ int netvsc_recv_callback(struct hv_device *device_obj, | |||
284 | 285 | ||
285 | skb->protocol = eth_type_trans(skb, net); | 286 | skb->protocol = eth_type_trans(skb, net); |
286 | skb->ip_summed = CHECKSUM_NONE; | 287 | skb->ip_summed = CHECKSUM_NONE; |
287 | skb->vlan_tci = packet->vlan_tci; | 288 | if (packet->vlan_tci & VLAN_TAG_PRESENT) |
289 | __vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), | ||
290 | packet->vlan_tci); | ||
288 | 291 | ||
289 | net->stats.rx_packets++; | 292 | net->stats.rx_packets++; |
290 | net->stats.rx_bytes += packet->total_data_buflen; | 293 | net->stats.rx_bytes += packet->total_data_buflen; |
diff --git a/drivers/net/macvlan.c b/drivers/net/macvlan.c index 1c502bb0c916..6e91931a1c2c 100644 --- a/drivers/net/macvlan.c +++ b/drivers/net/macvlan.c | |||
@@ -853,18 +853,24 @@ static int macvlan_changelink(struct net_device *dev, | |||
853 | struct nlattr *tb[], struct nlattr *data[]) | 853 | struct nlattr *tb[], struct nlattr *data[]) |
854 | { | 854 | { |
855 | struct macvlan_dev *vlan = netdev_priv(dev); | 855 | struct macvlan_dev *vlan = netdev_priv(dev); |
856 | if (data && data[IFLA_MACVLAN_MODE]) | 856 | |
857 | vlan->mode = nla_get_u32(data[IFLA_MACVLAN_MODE]); | ||
858 | if (data && data[IFLA_MACVLAN_FLAGS]) { | 857 | if (data && data[IFLA_MACVLAN_FLAGS]) { |
859 | __u16 flags = nla_get_u16(data[IFLA_MACVLAN_FLAGS]); | 858 | __u16 flags = nla_get_u16(data[IFLA_MACVLAN_FLAGS]); |
860 | bool promisc = (flags ^ vlan->flags) & MACVLAN_FLAG_NOPROMISC; | 859 | bool promisc = (flags ^ vlan->flags) & MACVLAN_FLAG_NOPROMISC; |
861 | 860 | if (vlan->port->passthru && promisc) { | |
862 | if (promisc && (flags & MACVLAN_FLAG_NOPROMISC)) | 861 | int err; |
863 | dev_set_promiscuity(vlan->lowerdev, -1); | 862 | |
864 | else if (promisc && !(flags & MACVLAN_FLAG_NOPROMISC)) | 863 | if (flags & MACVLAN_FLAG_NOPROMISC) |
865 | dev_set_promiscuity(vlan->lowerdev, 1); | 864 | err = dev_set_promiscuity(vlan->lowerdev, -1); |
865 | else | ||
866 | err = dev_set_promiscuity(vlan->lowerdev, 1); | ||
867 | if (err < 0) | ||
868 | return err; | ||
869 | } | ||
866 | vlan->flags = flags; | 870 | vlan->flags = flags; |
867 | } | 871 | } |
872 | if (data && data[IFLA_MACVLAN_MODE]) | ||
873 | vlan->mode = nla_get_u32(data[IFLA_MACVLAN_MODE]); | ||
868 | return 0; | 874 | return 0; |
869 | } | 875 | } |
870 | 876 | ||
diff --git a/drivers/net/macvtap.c b/drivers/net/macvtap.c index 59e9605de316..b6dd6a75919a 100644 --- a/drivers/net/macvtap.c +++ b/drivers/net/macvtap.c | |||
@@ -524,8 +524,10 @@ static int zerocopy_sg_from_iovec(struct sk_buff *skb, const struct iovec *from, | |||
524 | return -EMSGSIZE; | 524 | return -EMSGSIZE; |
525 | num_pages = get_user_pages_fast(base, size, 0, &page[i]); | 525 | num_pages = get_user_pages_fast(base, size, 0, &page[i]); |
526 | if (num_pages != size) { | 526 | if (num_pages != size) { |
527 | for (i = 0; i < num_pages; i++) | 527 | int j; |
528 | put_page(page[i]); | 528 | |
529 | for (j = 0; j < num_pages; j++) | ||
530 | put_page(page[i + j]); | ||
529 | return -EFAULT; | 531 | return -EFAULT; |
530 | } | 532 | } |
531 | truesize = size * PAGE_SIZE; | 533 | truesize = size * PAGE_SIZE; |
diff --git a/drivers/net/phy/phy.c b/drivers/net/phy/phy.c index c14f14741b3f..38f0b312ff85 100644 --- a/drivers/net/phy/phy.c +++ b/drivers/net/phy/phy.c | |||
@@ -1044,7 +1044,7 @@ int phy_init_eee(struct phy_device *phydev, bool clk_stop_enable) | |||
1044 | adv = mmd_eee_adv_to_ethtool_adv_t(eee_adv); | 1044 | adv = mmd_eee_adv_to_ethtool_adv_t(eee_adv); |
1045 | lp = mmd_eee_adv_to_ethtool_adv_t(eee_lp); | 1045 | lp = mmd_eee_adv_to_ethtool_adv_t(eee_lp); |
1046 | idx = phy_find_setting(phydev->speed, phydev->duplex); | 1046 | idx = phy_find_setting(phydev->speed, phydev->duplex); |
1047 | if ((lp & adv & settings[idx].setting)) | 1047 | if (!(lp & adv & settings[idx].setting)) |
1048 | goto eee_exit; | 1048 | goto eee_exit; |
1049 | 1049 | ||
1050 | if (clk_stop_enable) { | 1050 | if (clk_stop_enable) { |
diff --git a/drivers/net/team/team.c b/drivers/net/team/team.c index 7c43261975bd..b3051052f3ad 100644 --- a/drivers/net/team/team.c +++ b/drivers/net/team/team.c | |||
@@ -1092,8 +1092,8 @@ static int team_port_add(struct team *team, struct net_device *port_dev) | |||
1092 | } | 1092 | } |
1093 | 1093 | ||
1094 | port->index = -1; | 1094 | port->index = -1; |
1095 | team_port_enable(team, port); | ||
1096 | list_add_tail_rcu(&port->list, &team->port_list); | 1095 | list_add_tail_rcu(&port->list, &team->port_list); |
1096 | team_port_enable(team, port); | ||
1097 | __team_compute_features(team); | 1097 | __team_compute_features(team); |
1098 | __team_port_change_port_added(port, !!netif_carrier_ok(port_dev)); | 1098 | __team_port_change_port_added(port, !!netif_carrier_ok(port_dev)); |
1099 | __team_options_change_check(team); | 1099 | __team_options_change_check(team); |
@@ -2374,7 +2374,8 @@ static int team_nl_send_port_list_get(struct team *team, u32 portid, u32 seq, | |||
2374 | bool incomplete; | 2374 | bool incomplete; |
2375 | int i; | 2375 | int i; |
2376 | 2376 | ||
2377 | port = list_first_entry(&team->port_list, struct team_port, list); | 2377 | port = list_first_entry_or_null(&team->port_list, |
2378 | struct team_port, list); | ||
2378 | 2379 | ||
2379 | start_again: | 2380 | start_again: |
2380 | err = __send_and_alloc_skb(&skb, team, portid, send_func); | 2381 | err = __send_and_alloc_skb(&skb, team, portid, send_func); |
@@ -2402,8 +2403,8 @@ start_again: | |||
2402 | err = team_nl_fill_one_port_get(skb, one_port); | 2403 | err = team_nl_fill_one_port_get(skb, one_port); |
2403 | if (err) | 2404 | if (err) |
2404 | goto errout; | 2405 | goto errout; |
2405 | } else { | 2406 | } else if (port) { |
2406 | list_for_each_entry(port, &team->port_list, list) { | 2407 | list_for_each_entry_from(port, &team->port_list, list) { |
2407 | err = team_nl_fill_one_port_get(skb, port); | 2408 | err = team_nl_fill_one_port_get(skb, port); |
2408 | if (err) { | 2409 | if (err) { |
2409 | if (err == -EMSGSIZE) { | 2410 | if (err == -EMSGSIZE) { |
diff --git a/drivers/net/team/team_mode_random.c b/drivers/net/team/team_mode_random.c index 5ca14d463ba7..7f032e211343 100644 --- a/drivers/net/team/team_mode_random.c +++ b/drivers/net/team/team_mode_random.c | |||
@@ -28,6 +28,8 @@ static bool rnd_transmit(struct team *team, struct sk_buff *skb) | |||
28 | 28 | ||
29 | port_index = random_N(team->en_port_count); | 29 | port_index = random_N(team->en_port_count); |
30 | port = team_get_port_by_index_rcu(team, port_index); | 30 | port = team_get_port_by_index_rcu(team, port_index); |
31 | if (unlikely(!port)) | ||
32 | goto drop; | ||
31 | port = team_get_first_port_txable_rcu(team, port); | 33 | port = team_get_first_port_txable_rcu(team, port); |
32 | if (unlikely(!port)) | 34 | if (unlikely(!port)) |
33 | goto drop; | 35 | goto drop; |
diff --git a/drivers/net/team/team_mode_roundrobin.c b/drivers/net/team/team_mode_roundrobin.c index d268e4de781b..472623f8ce3d 100644 --- a/drivers/net/team/team_mode_roundrobin.c +++ b/drivers/net/team/team_mode_roundrobin.c | |||
@@ -32,6 +32,8 @@ static bool rr_transmit(struct team *team, struct sk_buff *skb) | |||
32 | 32 | ||
33 | port_index = rr_priv(team)->sent_packets++ % team->en_port_count; | 33 | port_index = rr_priv(team)->sent_packets++ % team->en_port_count; |
34 | port = team_get_port_by_index_rcu(team, port_index); | 34 | port = team_get_port_by_index_rcu(team, port_index); |
35 | if (unlikely(!port)) | ||
36 | goto drop; | ||
35 | port = team_get_first_port_txable_rcu(team, port); | 37 | port = team_get_first_port_txable_rcu(team, port); |
36 | if (unlikely(!port)) | 38 | if (unlikely(!port)) |
37 | goto drop; | 39 | goto drop; |
diff --git a/drivers/net/tun.c b/drivers/net/tun.c index f042b0373e5d..9c61f8734a40 100644 --- a/drivers/net/tun.c +++ b/drivers/net/tun.c | |||
@@ -352,7 +352,7 @@ static u16 tun_select_queue(struct net_device *dev, struct sk_buff *skb) | |||
352 | u32 numqueues = 0; | 352 | u32 numqueues = 0; |
353 | 353 | ||
354 | rcu_read_lock(); | 354 | rcu_read_lock(); |
355 | numqueues = tun->numqueues; | 355 | numqueues = ACCESS_ONCE(tun->numqueues); |
356 | 356 | ||
357 | txq = skb_get_rxhash(skb); | 357 | txq = skb_get_rxhash(skb); |
358 | if (txq) { | 358 | if (txq) { |
@@ -1010,8 +1010,10 @@ static int zerocopy_sg_from_iovec(struct sk_buff *skb, const struct iovec *from, | |||
1010 | return -EMSGSIZE; | 1010 | return -EMSGSIZE; |
1011 | num_pages = get_user_pages_fast(base, size, 0, &page[i]); | 1011 | num_pages = get_user_pages_fast(base, size, 0, &page[i]); |
1012 | if (num_pages != size) { | 1012 | if (num_pages != size) { |
1013 | for (i = 0; i < num_pages; i++) | 1013 | int j; |
1014 | put_page(page[i]); | 1014 | |
1015 | for (j = 0; j < num_pages; j++) | ||
1016 | put_page(page[i + j]); | ||
1015 | return -EFAULT; | 1017 | return -EFAULT; |
1016 | } | 1018 | } |
1017 | truesize = size * PAGE_SIZE; | 1019 | truesize = size * PAGE_SIZE; |
@@ -1585,6 +1587,10 @@ static int tun_set_iff(struct net *net, struct file *file, struct ifreq *ifr) | |||
1585 | else | 1587 | else |
1586 | return -EINVAL; | 1588 | return -EINVAL; |
1587 | 1589 | ||
1590 | if (!!(ifr->ifr_flags & IFF_MULTI_QUEUE) != | ||
1591 | !!(tun->flags & TUN_TAP_MQ)) | ||
1592 | return -EINVAL; | ||
1593 | |||
1588 | if (tun_not_capable(tun)) | 1594 | if (tun_not_capable(tun)) |
1589 | return -EPERM; | 1595 | return -EPERM; |
1590 | err = security_tun_dev_open(tun->security); | 1596 | err = security_tun_dev_open(tun->security); |
@@ -2155,6 +2161,8 @@ static int tun_chr_open(struct inode *inode, struct file * file) | |||
2155 | set_bit(SOCK_EXTERNALLY_ALLOCATED, &tfile->socket.flags); | 2161 | set_bit(SOCK_EXTERNALLY_ALLOCATED, &tfile->socket.flags); |
2156 | INIT_LIST_HEAD(&tfile->next); | 2162 | INIT_LIST_HEAD(&tfile->next); |
2157 | 2163 | ||
2164 | sock_set_flag(&tfile->sk, SOCK_ZEROCOPY); | ||
2165 | |||
2158 | return 0; | 2166 | return 0; |
2159 | } | 2167 | } |
2160 | 2168 | ||
diff --git a/drivers/net/usb/cdc_ether.c b/drivers/net/usb/cdc_ether.c index 078795fe6e31..04ee044dde51 100644 --- a/drivers/net/usb/cdc_ether.c +++ b/drivers/net/usb/cdc_ether.c | |||
@@ -627,6 +627,12 @@ static const struct usb_device_id products [] = { | |||
627 | .driver_info = 0, | 627 | .driver_info = 0, |
628 | }, | 628 | }, |
629 | 629 | ||
630 | /* Huawei E1820 - handled by qmi_wwan */ | ||
631 | { | ||
632 | USB_DEVICE_INTERFACE_NUMBER(HUAWEI_VENDOR_ID, 0x14ac, 1), | ||
633 | .driver_info = 0, | ||
634 | }, | ||
635 | |||
630 | /* Realtek RTL8152 Based USB 2.0 Ethernet Adapters */ | 636 | /* Realtek RTL8152 Based USB 2.0 Ethernet Adapters */ |
631 | #if defined(CONFIG_USB_RTL8152) || defined(CONFIG_USB_RTL8152_MODULE) | 637 | #if defined(CONFIG_USB_RTL8152) || defined(CONFIG_USB_RTL8152_MODULE) |
632 | { | 638 | { |
diff --git a/drivers/net/usb/qmi_wwan.c b/drivers/net/usb/qmi_wwan.c index 86adfa0a912e..56459215a22b 100644 --- a/drivers/net/usb/qmi_wwan.c +++ b/drivers/net/usb/qmi_wwan.c | |||
@@ -519,6 +519,7 @@ static const struct usb_device_id products[] = { | |||
519 | /* 3. Combined interface devices matching on interface number */ | 519 | /* 3. Combined interface devices matching on interface number */ |
520 | {QMI_FIXED_INTF(0x0408, 0xea42, 4)}, /* Yota / Megafon M100-1 */ | 520 | {QMI_FIXED_INTF(0x0408, 0xea42, 4)}, /* Yota / Megafon M100-1 */ |
521 | {QMI_FIXED_INTF(0x12d1, 0x140c, 1)}, /* Huawei E173 */ | 521 | {QMI_FIXED_INTF(0x12d1, 0x140c, 1)}, /* Huawei E173 */ |
522 | {QMI_FIXED_INTF(0x12d1, 0x14ac, 1)}, /* Huawei E1820 */ | ||
522 | {QMI_FIXED_INTF(0x19d2, 0x0002, 1)}, | 523 | {QMI_FIXED_INTF(0x19d2, 0x0002, 1)}, |
523 | {QMI_FIXED_INTF(0x19d2, 0x0012, 1)}, | 524 | {QMI_FIXED_INTF(0x19d2, 0x0012, 1)}, |
524 | {QMI_FIXED_INTF(0x19d2, 0x0017, 3)}, | 525 | {QMI_FIXED_INTF(0x19d2, 0x0017, 3)}, |
@@ -589,7 +590,13 @@ static const struct usb_device_id products[] = { | |||
589 | {QMI_GOBI1K_DEVICE(0x03f0, 0x1f1d)}, /* HP un2400 Gobi Modem Device */ | 590 | {QMI_GOBI1K_DEVICE(0x03f0, 0x1f1d)}, /* HP un2400 Gobi Modem Device */ |
590 | {QMI_GOBI1K_DEVICE(0x04da, 0x250d)}, /* Panasonic Gobi Modem device */ | 591 | {QMI_GOBI1K_DEVICE(0x04da, 0x250d)}, /* Panasonic Gobi Modem device */ |
591 | {QMI_GOBI1K_DEVICE(0x413c, 0x8172)}, /* Dell Gobi Modem device */ | 592 | {QMI_GOBI1K_DEVICE(0x413c, 0x8172)}, /* Dell Gobi Modem device */ |
592 | {QMI_GOBI1K_DEVICE(0x1410, 0xa001)}, /* Novatel Gobi Modem device */ | 593 | {QMI_GOBI1K_DEVICE(0x1410, 0xa001)}, /* Novatel/Verizon USB-1000 */ |
594 | {QMI_GOBI1K_DEVICE(0x1410, 0xa002)}, /* Novatel Gobi Modem device */ | ||
595 | {QMI_GOBI1K_DEVICE(0x1410, 0xa003)}, /* Novatel Gobi Modem device */ | ||
596 | {QMI_GOBI1K_DEVICE(0x1410, 0xa004)}, /* Novatel Gobi Modem device */ | ||
597 | {QMI_GOBI1K_DEVICE(0x1410, 0xa005)}, /* Novatel Gobi Modem device */ | ||
598 | {QMI_GOBI1K_DEVICE(0x1410, 0xa006)}, /* Novatel Gobi Modem device */ | ||
599 | {QMI_GOBI1K_DEVICE(0x1410, 0xa007)}, /* Novatel Gobi Modem device */ | ||
593 | {QMI_GOBI1K_DEVICE(0x0b05, 0x1776)}, /* Asus Gobi Modem device */ | 600 | {QMI_GOBI1K_DEVICE(0x0b05, 0x1776)}, /* Asus Gobi Modem device */ |
594 | {QMI_GOBI1K_DEVICE(0x19d2, 0xfff3)}, /* ONDA Gobi Modem device */ | 601 | {QMI_GOBI1K_DEVICE(0x19d2, 0xfff3)}, /* ONDA Gobi Modem device */ |
595 | {QMI_GOBI1K_DEVICE(0x05c6, 0x9001)}, /* Generic Gobi Modem device */ | 602 | {QMI_GOBI1K_DEVICE(0x05c6, 0x9001)}, /* Generic Gobi Modem device */ |
diff --git a/drivers/net/vxlan.c b/drivers/net/vxlan.c index 3b1d2ee7156b..57325f356d4f 100644 --- a/drivers/net/vxlan.c +++ b/drivers/net/vxlan.c | |||
@@ -565,18 +565,22 @@ skip: | |||
565 | 565 | ||
566 | /* Watch incoming packets to learn mapping between Ethernet address | 566 | /* Watch incoming packets to learn mapping between Ethernet address |
567 | * and Tunnel endpoint. | 567 | * and Tunnel endpoint. |
568 | * Return true if packet is bogus and should be droppped. | ||
568 | */ | 569 | */ |
569 | static void vxlan_snoop(struct net_device *dev, | 570 | static bool vxlan_snoop(struct net_device *dev, |
570 | __be32 src_ip, const u8 *src_mac) | 571 | __be32 src_ip, const u8 *src_mac) |
571 | { | 572 | { |
572 | struct vxlan_dev *vxlan = netdev_priv(dev); | 573 | struct vxlan_dev *vxlan = netdev_priv(dev); |
573 | struct vxlan_fdb *f; | 574 | struct vxlan_fdb *f; |
574 | int err; | ||
575 | 575 | ||
576 | f = vxlan_find_mac(vxlan, src_mac); | 576 | f = vxlan_find_mac(vxlan, src_mac); |
577 | if (likely(f)) { | 577 | if (likely(f)) { |
578 | if (likely(f->remote.remote_ip == src_ip)) | 578 | if (likely(f->remote.remote_ip == src_ip)) |
579 | return; | 579 | return false; |
580 | |||
581 | /* Don't migrate static entries, drop packets */ | ||
582 | if (f->state & NUD_NOARP) | ||
583 | return true; | ||
580 | 584 | ||
581 | if (net_ratelimit()) | 585 | if (net_ratelimit()) |
582 | netdev_info(dev, | 586 | netdev_info(dev, |
@@ -588,14 +592,19 @@ static void vxlan_snoop(struct net_device *dev, | |||
588 | } else { | 592 | } else { |
589 | /* learned new entry */ | 593 | /* learned new entry */ |
590 | spin_lock(&vxlan->hash_lock); | 594 | spin_lock(&vxlan->hash_lock); |
591 | err = vxlan_fdb_create(vxlan, src_mac, src_ip, | 595 | |
592 | NUD_REACHABLE, | 596 | /* close off race between vxlan_flush and incoming packets */ |
593 | NLM_F_EXCL|NLM_F_CREATE, | 597 | if (netif_running(dev)) |
594 | vxlan->dst_port, | 598 | vxlan_fdb_create(vxlan, src_mac, src_ip, |
595 | vxlan->default_dst.remote_vni, | 599 | NUD_REACHABLE, |
596 | 0, NTF_SELF); | 600 | NLM_F_EXCL|NLM_F_CREATE, |
601 | vxlan->dst_port, | ||
602 | vxlan->default_dst.remote_vni, | ||
603 | 0, NTF_SELF); | ||
597 | spin_unlock(&vxlan->hash_lock); | 604 | spin_unlock(&vxlan->hash_lock); |
598 | } | 605 | } |
606 | |||
607 | return false; | ||
599 | } | 608 | } |
600 | 609 | ||
601 | 610 | ||
@@ -727,8 +736,9 @@ static int vxlan_udp_encap_recv(struct sock *sk, struct sk_buff *skb) | |||
727 | vxlan->dev->dev_addr) == 0) | 736 | vxlan->dev->dev_addr) == 0) |
728 | goto drop; | 737 | goto drop; |
729 | 738 | ||
730 | if (vxlan->flags & VXLAN_F_LEARN) | 739 | if ((vxlan->flags & VXLAN_F_LEARN) && |
731 | vxlan_snoop(skb->dev, oip->saddr, eth_hdr(skb)->h_source); | 740 | vxlan_snoop(skb->dev, oip->saddr, eth_hdr(skb)->h_source)) |
741 | goto drop; | ||
732 | 742 | ||
733 | __skb_tunnel_rx(skb, vxlan->dev); | 743 | __skb_tunnel_rx(skb, vxlan->dev); |
734 | skb_reset_network_header(skb); | 744 | skb_reset_network_header(skb); |
@@ -1151,9 +1161,11 @@ static netdev_tx_t vxlan_xmit(struct sk_buff *skb, struct net_device *dev) | |||
1151 | struct sk_buff *skb1; | 1161 | struct sk_buff *skb1; |
1152 | 1162 | ||
1153 | skb1 = skb_clone(skb, GFP_ATOMIC); | 1163 | skb1 = skb_clone(skb, GFP_ATOMIC); |
1154 | rc1 = vxlan_xmit_one(skb1, dev, rdst, did_rsc); | 1164 | if (skb1) { |
1155 | if (rc == NETDEV_TX_OK) | 1165 | rc1 = vxlan_xmit_one(skb1, dev, rdst, did_rsc); |
1156 | rc = rc1; | 1166 | if (rc == NETDEV_TX_OK) |
1167 | rc = rc1; | ||
1168 | } | ||
1157 | } | 1169 | } |
1158 | 1170 | ||
1159 | rc1 = vxlan_xmit_one(skb, dev, rdst0, did_rsc); | 1171 | rc1 = vxlan_xmit_one(skb, dev, rdst0, did_rsc); |
diff --git a/drivers/net/wan/dlci.c b/drivers/net/wan/dlci.c index 147614ed86aa..6a8a382c5f4c 100644 --- a/drivers/net/wan/dlci.c +++ b/drivers/net/wan/dlci.c | |||
@@ -384,21 +384,37 @@ static int dlci_del(struct dlci_add *dlci) | |||
384 | struct frad_local *flp; | 384 | struct frad_local *flp; |
385 | struct net_device *master, *slave; | 385 | struct net_device *master, *slave; |
386 | int err; | 386 | int err; |
387 | bool found = false; | ||
388 | |||
389 | rtnl_lock(); | ||
387 | 390 | ||
388 | /* validate slave device */ | 391 | /* validate slave device */ |
389 | master = __dev_get_by_name(&init_net, dlci->devname); | 392 | master = __dev_get_by_name(&init_net, dlci->devname); |
390 | if (!master) | 393 | if (!master) { |
391 | return -ENODEV; | 394 | err = -ENODEV; |
395 | goto out; | ||
396 | } | ||
397 | |||
398 | list_for_each_entry(dlp, &dlci_devs, list) { | ||
399 | if (dlp->master == master) { | ||
400 | found = true; | ||
401 | break; | ||
402 | } | ||
403 | } | ||
404 | if (!found) { | ||
405 | err = -ENODEV; | ||
406 | goto out; | ||
407 | } | ||
392 | 408 | ||
393 | if (netif_running(master)) { | 409 | if (netif_running(master)) { |
394 | return -EBUSY; | 410 | err = -EBUSY; |
411 | goto out; | ||
395 | } | 412 | } |
396 | 413 | ||
397 | dlp = netdev_priv(master); | 414 | dlp = netdev_priv(master); |
398 | slave = dlp->slave; | 415 | slave = dlp->slave; |
399 | flp = netdev_priv(slave); | 416 | flp = netdev_priv(slave); |
400 | 417 | ||
401 | rtnl_lock(); | ||
402 | err = (*flp->deassoc)(slave, master); | 418 | err = (*flp->deassoc)(slave, master); |
403 | if (!err) { | 419 | if (!err) { |
404 | list_del(&dlp->list); | 420 | list_del(&dlp->list); |
@@ -407,8 +423,8 @@ static int dlci_del(struct dlci_add *dlci) | |||
407 | 423 | ||
408 | dev_put(slave); | 424 | dev_put(slave); |
409 | } | 425 | } |
426 | out: | ||
410 | rtnl_unlock(); | 427 | rtnl_unlock(); |
411 | |||
412 | return err; | 428 | return err; |
413 | } | 429 | } |
414 | 430 | ||
diff --git a/drivers/net/wireless/ath/ath9k/Kconfig b/drivers/net/wireless/ath/ath9k/Kconfig index f3dc124c60c7..3c2cbc9d6295 100644 --- a/drivers/net/wireless/ath/ath9k/Kconfig +++ b/drivers/net/wireless/ath/ath9k/Kconfig | |||
@@ -92,13 +92,17 @@ config ATH9K_MAC_DEBUG | |||
92 | This option enables collection of statistics for Rx/Tx status | 92 | This option enables collection of statistics for Rx/Tx status |
93 | data and some other MAC related statistics | 93 | data and some other MAC related statistics |
94 | 94 | ||
95 | config ATH9K_RATE_CONTROL | 95 | config ATH9K_LEGACY_RATE_CONTROL |
96 | bool "Atheros ath9k rate control" | 96 | bool "Atheros ath9k rate control" |
97 | depends on ATH9K | 97 | depends on ATH9K |
98 | default y | 98 | default n |
99 | ---help--- | 99 | ---help--- |
100 | Say Y, if you want to use the ath9k specific rate control | 100 | Say Y, if you want to use the ath9k specific rate control |
101 | module instead of minstrel_ht. | 101 | module instead of minstrel_ht. Be warned that there are various |
102 | issues with the ath9k RC and minstrel is a more robust algorithm. | ||
103 | Note that even if this option is selected, "ath9k_rate_control" | ||
104 | has to be passed to mac80211 using the module parameter, | ||
105 | ieee80211_default_rc_algo. | ||
102 | 106 | ||
103 | config ATH9K_HTC | 107 | config ATH9K_HTC |
104 | tristate "Atheros HTC based wireless cards support" | 108 | tristate "Atheros HTC based wireless cards support" |
diff --git a/drivers/net/wireless/ath/ath9k/Makefile b/drivers/net/wireless/ath/ath9k/Makefile index 2ad8f9474ba1..75ee9e7704ce 100644 --- a/drivers/net/wireless/ath/ath9k/Makefile +++ b/drivers/net/wireless/ath/ath9k/Makefile | |||
@@ -8,7 +8,7 @@ ath9k-y += beacon.o \ | |||
8 | antenna.o | 8 | antenna.o |
9 | 9 | ||
10 | ath9k-$(CONFIG_ATH9K_BTCOEX_SUPPORT) += mci.o | 10 | ath9k-$(CONFIG_ATH9K_BTCOEX_SUPPORT) += mci.o |
11 | ath9k-$(CONFIG_ATH9K_RATE_CONTROL) += rc.o | 11 | ath9k-$(CONFIG_ATH9K_LEGACY_RATE_CONTROL) += rc.o |
12 | ath9k-$(CONFIG_ATH9K_PCI) += pci.o | 12 | ath9k-$(CONFIG_ATH9K_PCI) += pci.o |
13 | ath9k-$(CONFIG_ATH9K_AHB) += ahb.o | 13 | ath9k-$(CONFIG_ATH9K_AHB) += ahb.o |
14 | ath9k-$(CONFIG_ATH9K_DEBUGFS) += debug.o | 14 | ath9k-$(CONFIG_ATH9K_DEBUGFS) += debug.o |
diff --git a/drivers/net/wireless/ath/ath9k/ar9003_2p2_initvals.h b/drivers/net/wireless/ath/ath9k/ar9003_2p2_initvals.h index db5ffada2217..7546b9a7dcbf 100644 --- a/drivers/net/wireless/ath/ath9k/ar9003_2p2_initvals.h +++ b/drivers/net/wireless/ath/ath9k/ar9003_2p2_initvals.h | |||
@@ -958,11 +958,11 @@ static const u32 ar9300Common_rx_gain_table_2p2[][2] = { | |||
958 | {0x0000a074, 0x00000000}, | 958 | {0x0000a074, 0x00000000}, |
959 | {0x0000a078, 0x00000000}, | 959 | {0x0000a078, 0x00000000}, |
960 | {0x0000a07c, 0x00000000}, | 960 | {0x0000a07c, 0x00000000}, |
961 | {0x0000a080, 0x1a1a1a1a}, | 961 | {0x0000a080, 0x22222229}, |
962 | {0x0000a084, 0x1a1a1a1a}, | 962 | {0x0000a084, 0x1d1d1d1d}, |
963 | {0x0000a088, 0x1a1a1a1a}, | 963 | {0x0000a088, 0x1d1d1d1d}, |
964 | {0x0000a08c, 0x1a1a1a1a}, | 964 | {0x0000a08c, 0x1d1d1d1d}, |
965 | {0x0000a090, 0x171a1a1a}, | 965 | {0x0000a090, 0x171d1d1d}, |
966 | {0x0000a094, 0x11111717}, | 966 | {0x0000a094, 0x11111717}, |
967 | {0x0000a098, 0x00030311}, | 967 | {0x0000a098, 0x00030311}, |
968 | {0x0000a09c, 0x00000000}, | 968 | {0x0000a09c, 0x00000000}, |
diff --git a/drivers/net/wireless/ath/ath9k/ar9003_eeprom.h b/drivers/net/wireless/ath/ath9k/ar9003_eeprom.h index 54ba42f4108a..874f6570bd1c 100644 --- a/drivers/net/wireless/ath/ath9k/ar9003_eeprom.h +++ b/drivers/net/wireless/ath/ath9k/ar9003_eeprom.h | |||
@@ -68,13 +68,16 @@ | |||
68 | #define AR9300_BASE_ADDR 0x3ff | 68 | #define AR9300_BASE_ADDR 0x3ff |
69 | #define AR9300_BASE_ADDR_512 0x1ff | 69 | #define AR9300_BASE_ADDR_512 0x1ff |
70 | 70 | ||
71 | #define AR9300_OTP_BASE (AR_SREV_9340(ah) ? 0x30000 : 0x14000) | 71 | #define AR9300_OTP_BASE \ |
72 | #define AR9300_OTP_STATUS (AR_SREV_9340(ah) ? 0x30018 : 0x15f18) | 72 | ((AR_SREV_9340(ah) || AR_SREV_9550(ah)) ? 0x30000 : 0x14000) |
73 | #define AR9300_OTP_STATUS \ | ||
74 | ((AR_SREV_9340(ah) || AR_SREV_9550(ah)) ? 0x30018 : 0x15f18) | ||
73 | #define AR9300_OTP_STATUS_TYPE 0x7 | 75 | #define AR9300_OTP_STATUS_TYPE 0x7 |
74 | #define AR9300_OTP_STATUS_VALID 0x4 | 76 | #define AR9300_OTP_STATUS_VALID 0x4 |
75 | #define AR9300_OTP_STATUS_ACCESS_BUSY 0x2 | 77 | #define AR9300_OTP_STATUS_ACCESS_BUSY 0x2 |
76 | #define AR9300_OTP_STATUS_SM_BUSY 0x1 | 78 | #define AR9300_OTP_STATUS_SM_BUSY 0x1 |
77 | #define AR9300_OTP_READ_DATA (AR_SREV_9340(ah) ? 0x3001c : 0x15f1c) | 79 | #define AR9300_OTP_READ_DATA \ |
80 | ((AR_SREV_9340(ah) || AR_SREV_9550(ah)) ? 0x3001c : 0x15f1c) | ||
78 | 81 | ||
79 | enum targetPowerHTRates { | 82 | enum targetPowerHTRates { |
80 | HT_TARGET_RATE_0_8_16, | 83 | HT_TARGET_RATE_0_8_16, |
diff --git a/drivers/net/wireless/ath/ath9k/ar9003_phy.c b/drivers/net/wireless/ath/ath9k/ar9003_phy.c index 2bf6548dd143..e1714d7c9eeb 100644 --- a/drivers/net/wireless/ath/ath9k/ar9003_phy.c +++ b/drivers/net/wireless/ath/ath9k/ar9003_phy.c | |||
@@ -334,7 +334,8 @@ static void ar9003_hw_spur_ofdm(struct ath_hw *ah, | |||
334 | REG_RMW_FIELD(ah, AR_PHY_SPUR_REG, | 334 | REG_RMW_FIELD(ah, AR_PHY_SPUR_REG, |
335 | AR_PHY_SPUR_REG_EN_VIT_SPUR_RSSI, 1); | 335 | AR_PHY_SPUR_REG_EN_VIT_SPUR_RSSI, 1); |
336 | 336 | ||
337 | if (REG_READ_FIELD(ah, AR_PHY_MODE, | 337 | if (!AR_SREV_9340(ah) && |
338 | REG_READ_FIELD(ah, AR_PHY_MODE, | ||
338 | AR_PHY_MODE_DYNAMIC) == 0x1) | 339 | AR_PHY_MODE_DYNAMIC) == 0x1) |
339 | REG_RMW_FIELD(ah, AR_PHY_SPUR_REG, | 340 | REG_RMW_FIELD(ah, AR_PHY_SPUR_REG, |
340 | AR_PHY_SPUR_REG_ENABLE_NF_RSSI_SPUR_MIT, 1); | 341 | AR_PHY_SPUR_REG_ENABLE_NF_RSSI_SPUR_MIT, 1); |
diff --git a/drivers/net/wireless/ath/ath9k/ath9k.h b/drivers/net/wireless/ath/ath9k/ath9k.h index 366002f266f8..42b03dc39d14 100644 --- a/drivers/net/wireless/ath/ath9k/ath9k.h +++ b/drivers/net/wireless/ath/ath9k/ath9k.h | |||
@@ -251,10 +251,9 @@ struct ath_atx_tid { | |||
251 | int tidno; | 251 | int tidno; |
252 | int baw_head; /* first un-acked tx buffer */ | 252 | int baw_head; /* first un-acked tx buffer */ |
253 | int baw_tail; /* next unused tx buffer slot */ | 253 | int baw_tail; /* next unused tx buffer slot */ |
254 | int sched; | 254 | bool sched; |
255 | int paused; | 255 | bool paused; |
256 | u8 state; | 256 | bool active; |
257 | bool stop_cb; | ||
258 | }; | 257 | }; |
259 | 258 | ||
260 | struct ath_node { | 259 | struct ath_node { |
@@ -275,10 +274,6 @@ struct ath_node { | |||
275 | #endif | 274 | #endif |
276 | }; | 275 | }; |
277 | 276 | ||
278 | #define AGGR_CLEANUP BIT(1) | ||
279 | #define AGGR_ADDBA_COMPLETE BIT(2) | ||
280 | #define AGGR_ADDBA_PROGRESS BIT(3) | ||
281 | |||
282 | struct ath_tx_control { | 277 | struct ath_tx_control { |
283 | struct ath_txq *txq; | 278 | struct ath_txq *txq; |
284 | struct ath_node *an; | 279 | struct ath_node *an; |
@@ -352,8 +347,7 @@ void ath_tx_tasklet(struct ath_softc *sc); | |||
352 | void ath_tx_edma_tasklet(struct ath_softc *sc); | 347 | void ath_tx_edma_tasklet(struct ath_softc *sc); |
353 | int ath_tx_aggr_start(struct ath_softc *sc, struct ieee80211_sta *sta, | 348 | int ath_tx_aggr_start(struct ath_softc *sc, struct ieee80211_sta *sta, |
354 | u16 tid, u16 *ssn); | 349 | u16 tid, u16 *ssn); |
355 | bool ath_tx_aggr_stop(struct ath_softc *sc, struct ieee80211_sta *sta, u16 tid, | 350 | void ath_tx_aggr_stop(struct ath_softc *sc, struct ieee80211_sta *sta, u16 tid); |
356 | bool flush); | ||
357 | void ath_tx_aggr_resume(struct ath_softc *sc, struct ieee80211_sta *sta, u16 tid); | 351 | void ath_tx_aggr_resume(struct ath_softc *sc, struct ieee80211_sta *sta, u16 tid); |
358 | 352 | ||
359 | void ath_tx_aggr_wakeup(struct ath_softc *sc, struct ath_node *an); | 353 | void ath_tx_aggr_wakeup(struct ath_softc *sc, struct ath_node *an); |
diff --git a/drivers/net/wireless/ath/ath9k/htc_drv_main.c b/drivers/net/wireless/ath/ath9k/htc_drv_main.c index 0743a47cef8f..62f1b7636c92 100644 --- a/drivers/net/wireless/ath/ath9k/htc_drv_main.c +++ b/drivers/net/wireless/ath/ath9k/htc_drv_main.c | |||
@@ -1174,7 +1174,7 @@ static int ath9k_htc_config(struct ieee80211_hw *hw, u32 changed) | |||
1174 | mutex_lock(&priv->htc_pm_lock); | 1174 | mutex_lock(&priv->htc_pm_lock); |
1175 | 1175 | ||
1176 | priv->ps_idle = !!(conf->flags & IEEE80211_CONF_IDLE); | 1176 | priv->ps_idle = !!(conf->flags & IEEE80211_CONF_IDLE); |
1177 | if (priv->ps_idle) | 1177 | if (!priv->ps_idle) |
1178 | chip_reset = true; | 1178 | chip_reset = true; |
1179 | 1179 | ||
1180 | mutex_unlock(&priv->htc_pm_lock); | 1180 | mutex_unlock(&priv->htc_pm_lock); |
diff --git a/drivers/net/wireless/ath/ath9k/hw.c b/drivers/net/wireless/ath/ath9k/hw.c index 7f25da8444fe..15dfefcf2d0f 100644 --- a/drivers/net/wireless/ath/ath9k/hw.c +++ b/drivers/net/wireless/ath/ath9k/hw.c | |||
@@ -1172,6 +1172,7 @@ u32 ath9k_regd_get_ctl(struct ath_regulatory *reg, struct ath9k_channel *chan) | |||
1172 | static inline void ath9k_hw_set_dma(struct ath_hw *ah) | 1172 | static inline void ath9k_hw_set_dma(struct ath_hw *ah) |
1173 | { | 1173 | { |
1174 | struct ath_common *common = ath9k_hw_common(ah); | 1174 | struct ath_common *common = ath9k_hw_common(ah); |
1175 | int txbuf_size; | ||
1175 | 1176 | ||
1176 | ENABLE_REGWRITE_BUFFER(ah); | 1177 | ENABLE_REGWRITE_BUFFER(ah); |
1177 | 1178 | ||
@@ -1225,13 +1226,17 @@ static inline void ath9k_hw_set_dma(struct ath_hw *ah) | |||
1225 | * So set the usable tx buf size also to half to | 1226 | * So set the usable tx buf size also to half to |
1226 | * avoid data/delimiter underruns | 1227 | * avoid data/delimiter underruns |
1227 | */ | 1228 | */ |
1228 | REG_WRITE(ah, AR_PCU_TXBUF_CTRL, | 1229 | txbuf_size = AR_9285_PCU_TXBUF_CTRL_USABLE_SIZE; |
1229 | AR_9285_PCU_TXBUF_CTRL_USABLE_SIZE); | 1230 | } else if (AR_SREV_9340_13_OR_LATER(ah)) { |
1230 | } else if (!AR_SREV_9271(ah)) { | 1231 | /* Uses fewer entries for AR934x v1.3+ to prevent rx overruns */ |
1231 | REG_WRITE(ah, AR_PCU_TXBUF_CTRL, | 1232 | txbuf_size = AR_9340_PCU_TXBUF_CTRL_USABLE_SIZE; |
1232 | AR_PCU_TXBUF_CTRL_USABLE_SIZE); | 1233 | } else { |
1234 | txbuf_size = AR_PCU_TXBUF_CTRL_USABLE_SIZE; | ||
1233 | } | 1235 | } |
1234 | 1236 | ||
1237 | if (!AR_SREV_9271(ah)) | ||
1238 | REG_WRITE(ah, AR_PCU_TXBUF_CTRL, txbuf_size); | ||
1239 | |||
1235 | REGWRITE_BUFFER_FLUSH(ah); | 1240 | REGWRITE_BUFFER_FLUSH(ah); |
1236 | 1241 | ||
1237 | if (AR_SREV_9300_20_OR_LATER(ah)) | 1242 | if (AR_SREV_9300_20_OR_LATER(ah)) |
@@ -1306,9 +1311,13 @@ static bool ath9k_hw_set_reset(struct ath_hw *ah, int type) | |||
1306 | AR_RTC_RC_COLD_RESET | AR_RTC_RC_WARM_RESET; | 1311 | AR_RTC_RC_COLD_RESET | AR_RTC_RC_WARM_RESET; |
1307 | } else { | 1312 | } else { |
1308 | tmpReg = REG_READ(ah, AR_INTR_SYNC_CAUSE); | 1313 | tmpReg = REG_READ(ah, AR_INTR_SYNC_CAUSE); |
1309 | if (tmpReg & | 1314 | if (AR_SREV_9340(ah)) |
1310 | (AR_INTR_SYNC_LOCAL_TIMEOUT | | 1315 | tmpReg &= AR9340_INTR_SYNC_LOCAL_TIMEOUT; |
1311 | AR_INTR_SYNC_RADM_CPL_TIMEOUT)) { | 1316 | else |
1317 | tmpReg &= AR_INTR_SYNC_LOCAL_TIMEOUT | | ||
1318 | AR_INTR_SYNC_RADM_CPL_TIMEOUT; | ||
1319 | |||
1320 | if (tmpReg) { | ||
1312 | u32 val; | 1321 | u32 val; |
1313 | REG_WRITE(ah, AR_INTR_SYNC_ENABLE, 0); | 1322 | REG_WRITE(ah, AR_INTR_SYNC_ENABLE, 0); |
1314 | 1323 | ||
diff --git a/drivers/net/wireless/ath/ath9k/init.c b/drivers/net/wireless/ath/ath9k/init.c index aba415103f94..2ba494567777 100644 --- a/drivers/net/wireless/ath/ath9k/init.c +++ b/drivers/net/wireless/ath/ath9k/init.c | |||
@@ -787,8 +787,7 @@ void ath9k_set_hw_capab(struct ath_softc *sc, struct ieee80211_hw *hw) | |||
787 | hw->wiphy->iface_combinations = if_comb; | 787 | hw->wiphy->iface_combinations = if_comb; |
788 | hw->wiphy->n_iface_combinations = ARRAY_SIZE(if_comb); | 788 | hw->wiphy->n_iface_combinations = ARRAY_SIZE(if_comb); |
789 | 789 | ||
790 | if (AR_SREV_5416(sc->sc_ah)) | 790 | hw->wiphy->flags &= ~WIPHY_FLAG_PS_ON_BY_DEFAULT; |
791 | hw->wiphy->flags &= ~WIPHY_FLAG_PS_ON_BY_DEFAULT; | ||
792 | 791 | ||
793 | hw->wiphy->flags |= WIPHY_FLAG_IBSS_RSN; | 792 | hw->wiphy->flags |= WIPHY_FLAG_IBSS_RSN; |
794 | hw->wiphy->flags |= WIPHY_FLAG_SUPPORTS_TDLS; | 793 | hw->wiphy->flags |= WIPHY_FLAG_SUPPORTS_TDLS; |
@@ -830,10 +829,6 @@ void ath9k_set_hw_capab(struct ath_softc *sc, struct ieee80211_hw *hw) | |||
830 | sc->ant_rx = hw->wiphy->available_antennas_rx; | 829 | sc->ant_rx = hw->wiphy->available_antennas_rx; |
831 | sc->ant_tx = hw->wiphy->available_antennas_tx; | 830 | sc->ant_tx = hw->wiphy->available_antennas_tx; |
832 | 831 | ||
833 | #ifdef CONFIG_ATH9K_RATE_CONTROL | ||
834 | hw->rate_control_algorithm = "ath9k_rate_control"; | ||
835 | #endif | ||
836 | |||
837 | if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_2GHZ) | 832 | if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_2GHZ) |
838 | hw->wiphy->bands[IEEE80211_BAND_2GHZ] = | 833 | hw->wiphy->bands[IEEE80211_BAND_2GHZ] = |
839 | &sc->sbands[IEEE80211_BAND_2GHZ]; | 834 | &sc->sbands[IEEE80211_BAND_2GHZ]; |
diff --git a/drivers/net/wireless/ath/ath9k/mac.c b/drivers/net/wireless/ath/ath9k/mac.c index 498fee04afa0..566109a40fb3 100644 --- a/drivers/net/wireless/ath/ath9k/mac.c +++ b/drivers/net/wireless/ath/ath9k/mac.c | |||
@@ -410,7 +410,7 @@ bool ath9k_hw_resettxqueue(struct ath_hw *ah, u32 q) | |||
410 | 410 | ||
411 | REG_WRITE(ah, AR_QMISC(q), AR_Q_MISC_DCU_EARLY_TERM_REQ); | 411 | REG_WRITE(ah, AR_QMISC(q), AR_Q_MISC_DCU_EARLY_TERM_REQ); |
412 | 412 | ||
413 | if (AR_SREV_9340(ah)) | 413 | if (AR_SREV_9340(ah) && !AR_SREV_9340_13_OR_LATER(ah)) |
414 | REG_WRITE(ah, AR_DMISC(q), | 414 | REG_WRITE(ah, AR_DMISC(q), |
415 | AR_D_MISC_CW_BKOFF_EN | AR_D_MISC_FRAG_WAIT_EN | 0x1); | 415 | AR_D_MISC_CW_BKOFF_EN | AR_D_MISC_FRAG_WAIT_EN | 0x1); |
416 | else | 416 | else |
diff --git a/drivers/net/wireless/ath/ath9k/main.c b/drivers/net/wireless/ath/ath9k/main.c index 2382d1262e7f..5092ecae7706 100644 --- a/drivers/net/wireless/ath/ath9k/main.c +++ b/drivers/net/wireless/ath/ath9k/main.c | |||
@@ -1709,7 +1709,8 @@ static int ath9k_ampdu_action(struct ieee80211_hw *hw, | |||
1709 | flush = true; | 1709 | flush = true; |
1710 | case IEEE80211_AMPDU_TX_STOP_CONT: | 1710 | case IEEE80211_AMPDU_TX_STOP_CONT: |
1711 | ath9k_ps_wakeup(sc); | 1711 | ath9k_ps_wakeup(sc); |
1712 | if (ath_tx_aggr_stop(sc, sta, tid, flush)) | 1712 | ath_tx_aggr_stop(sc, sta, tid); |
1713 | if (!flush) | ||
1713 | ieee80211_stop_tx_ba_cb_irqsafe(vif, sta->addr, tid); | 1714 | ieee80211_stop_tx_ba_cb_irqsafe(vif, sta->addr, tid); |
1714 | ath9k_ps_restore(sc); | 1715 | ath9k_ps_restore(sc); |
1715 | break; | 1716 | break; |
diff --git a/drivers/net/wireless/ath/ath9k/rc.c b/drivers/net/wireless/ath/ath9k/rc.c index aa4d368d8d3d..7eb1f4b458e4 100644 --- a/drivers/net/wireless/ath/ath9k/rc.c +++ b/drivers/net/wireless/ath/ath9k/rc.c | |||
@@ -1227,10 +1227,7 @@ static bool ath_tx_aggr_check(struct ath_softc *sc, struct ieee80211_sta *sta, | |||
1227 | return false; | 1227 | return false; |
1228 | 1228 | ||
1229 | txtid = ATH_AN_2_TID(an, tidno); | 1229 | txtid = ATH_AN_2_TID(an, tidno); |
1230 | 1230 | return !txtid->active; | |
1231 | if (!(txtid->state & (AGGR_ADDBA_COMPLETE | AGGR_ADDBA_PROGRESS))) | ||
1232 | return true; | ||
1233 | return false; | ||
1234 | } | 1231 | } |
1235 | 1232 | ||
1236 | 1233 | ||
diff --git a/drivers/net/wireless/ath/ath9k/rc.h b/drivers/net/wireless/ath/ath9k/rc.h index 267dbfcfaa96..b9a87383cb43 100644 --- a/drivers/net/wireless/ath/ath9k/rc.h +++ b/drivers/net/wireless/ath/ath9k/rc.h | |||
@@ -231,7 +231,7 @@ static inline void ath_debug_stat_retries(struct ath_rate_priv *rc, int rix, | |||
231 | } | 231 | } |
232 | #endif | 232 | #endif |
233 | 233 | ||
234 | #ifdef CONFIG_ATH9K_RATE_CONTROL | 234 | #ifdef CONFIG_ATH9K_LEGACY_RATE_CONTROL |
235 | int ath_rate_control_register(void); | 235 | int ath_rate_control_register(void); |
236 | void ath_rate_control_unregister(void); | 236 | void ath_rate_control_unregister(void); |
237 | #else | 237 | #else |
diff --git a/drivers/net/wireless/ath/ath9k/reg.h b/drivers/net/wireless/ath/ath9k/reg.h index 5c4ab5026dca..f7c90cc58d56 100644 --- a/drivers/net/wireless/ath/ath9k/reg.h +++ b/drivers/net/wireless/ath/ath9k/reg.h | |||
@@ -798,6 +798,10 @@ | |||
798 | #define AR_SREV_REVISION_9485_10 0 | 798 | #define AR_SREV_REVISION_9485_10 0 |
799 | #define AR_SREV_REVISION_9485_11 1 | 799 | #define AR_SREV_REVISION_9485_11 1 |
800 | #define AR_SREV_VERSION_9340 0x300 | 800 | #define AR_SREV_VERSION_9340 0x300 |
801 | #define AR_SREV_REVISION_9340_10 0 | ||
802 | #define AR_SREV_REVISION_9340_11 1 | ||
803 | #define AR_SREV_REVISION_9340_12 2 | ||
804 | #define AR_SREV_REVISION_9340_13 3 | ||
801 | #define AR_SREV_VERSION_9580 0x1C0 | 805 | #define AR_SREV_VERSION_9580 0x1C0 |
802 | #define AR_SREV_REVISION_9580_10 4 /* AR9580 1.0 */ | 806 | #define AR_SREV_REVISION_9580_10 4 /* AR9580 1.0 */ |
803 | #define AR_SREV_VERSION_9462 0x280 | 807 | #define AR_SREV_VERSION_9462 0x280 |
@@ -897,6 +901,10 @@ | |||
897 | #define AR_SREV_9340(_ah) \ | 901 | #define AR_SREV_9340(_ah) \ |
898 | (((_ah)->hw_version.macVersion == AR_SREV_VERSION_9340)) | 902 | (((_ah)->hw_version.macVersion == AR_SREV_VERSION_9340)) |
899 | 903 | ||
904 | #define AR_SREV_9340_13_OR_LATER(_ah) \ | ||
905 | (AR_SREV_9340((_ah)) && \ | ||
906 | ((_ah)->hw_version.macRev >= AR_SREV_REVISION_9340_13)) | ||
907 | |||
900 | #define AR_SREV_9285E_20(_ah) \ | 908 | #define AR_SREV_9285E_20(_ah) \ |
901 | (AR_SREV_9285_12_OR_LATER(_ah) && \ | 909 | (AR_SREV_9285_12_OR_LATER(_ah) && \ |
902 | ((REG_READ(_ah, AR_AN_SYNTH9) & 0x7) == 0x1)) | 910 | ((REG_READ(_ah, AR_AN_SYNTH9) & 0x7) == 0x1)) |
@@ -1007,6 +1015,8 @@ enum { | |||
1007 | AR_INTR_SYNC_LOCAL_TIMEOUT | | 1015 | AR_INTR_SYNC_LOCAL_TIMEOUT | |
1008 | AR_INTR_SYNC_MAC_SLEEP_ACCESS), | 1016 | AR_INTR_SYNC_MAC_SLEEP_ACCESS), |
1009 | 1017 | ||
1018 | AR9340_INTR_SYNC_LOCAL_TIMEOUT = 0x00000010, | ||
1019 | |||
1010 | AR_INTR_SYNC_SPURIOUS = 0xFFFFFFFF, | 1020 | AR_INTR_SYNC_SPURIOUS = 0xFFFFFFFF, |
1011 | 1021 | ||
1012 | }; | 1022 | }; |
@@ -1881,6 +1891,7 @@ enum { | |||
1881 | #define AR_PCU_TXBUF_CTRL_SIZE_MASK 0x7FF | 1891 | #define AR_PCU_TXBUF_CTRL_SIZE_MASK 0x7FF |
1882 | #define AR_PCU_TXBUF_CTRL_USABLE_SIZE 0x700 | 1892 | #define AR_PCU_TXBUF_CTRL_USABLE_SIZE 0x700 |
1883 | #define AR_9285_PCU_TXBUF_CTRL_USABLE_SIZE 0x380 | 1893 | #define AR_9285_PCU_TXBUF_CTRL_USABLE_SIZE 0x380 |
1894 | #define AR_9340_PCU_TXBUF_CTRL_USABLE_SIZE 0x500 | ||
1884 | 1895 | ||
1885 | #define AR_PCU_MISC_MODE2 0x8344 | 1896 | #define AR_PCU_MISC_MODE2 0x8344 |
1886 | #define AR_PCU_MISC_MODE2_MGMT_CRYPTO_ENABLE 0x00000002 | 1897 | #define AR_PCU_MISC_MODE2_MGMT_CRYPTO_ENABLE 0x00000002 |
diff --git a/drivers/net/wireless/ath/ath9k/xmit.c b/drivers/net/wireless/ath/ath9k/xmit.c index 14bb3354ea64..83ab6be3fe6d 100644 --- a/drivers/net/wireless/ath/ath9k/xmit.c +++ b/drivers/net/wireless/ath/ath9k/xmit.c | |||
@@ -125,24 +125,6 @@ static void ath_tx_queue_tid(struct ath_txq *txq, struct ath_atx_tid *tid) | |||
125 | list_add_tail(&ac->list, &txq->axq_acq); | 125 | list_add_tail(&ac->list, &txq->axq_acq); |
126 | } | 126 | } |
127 | 127 | ||
128 | static void ath_tx_resume_tid(struct ath_softc *sc, struct ath_atx_tid *tid) | ||
129 | { | ||
130 | struct ath_txq *txq = tid->ac->txq; | ||
131 | |||
132 | WARN_ON(!tid->paused); | ||
133 | |||
134 | ath_txq_lock(sc, txq); | ||
135 | tid->paused = false; | ||
136 | |||
137 | if (skb_queue_empty(&tid->buf_q)) | ||
138 | goto unlock; | ||
139 | |||
140 | ath_tx_queue_tid(txq, tid); | ||
141 | ath_txq_schedule(sc, txq); | ||
142 | unlock: | ||
143 | ath_txq_unlock_complete(sc, txq); | ||
144 | } | ||
145 | |||
146 | static struct ath_frame_info *get_frame_info(struct sk_buff *skb) | 128 | static struct ath_frame_info *get_frame_info(struct sk_buff *skb) |
147 | { | 129 | { |
148 | struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb); | 130 | struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb); |
@@ -164,20 +146,7 @@ static void ath_set_rates(struct ieee80211_vif *vif, struct ieee80211_sta *sta, | |||
164 | ARRAY_SIZE(bf->rates)); | 146 | ARRAY_SIZE(bf->rates)); |
165 | } | 147 | } |
166 | 148 | ||
167 | static void ath_tx_clear_tid(struct ath_softc *sc, struct ath_atx_tid *tid) | 149 | static void ath_tx_flush_tid(struct ath_softc *sc, struct ath_atx_tid *tid) |
168 | { | ||
169 | tid->state &= ~AGGR_ADDBA_COMPLETE; | ||
170 | tid->state &= ~AGGR_CLEANUP; | ||
171 | if (!tid->stop_cb) | ||
172 | return; | ||
173 | |||
174 | ieee80211_start_tx_ba_cb_irqsafe(tid->an->vif, tid->an->sta->addr, | ||
175 | tid->tidno); | ||
176 | tid->stop_cb = false; | ||
177 | } | ||
178 | |||
179 | static void ath_tx_flush_tid(struct ath_softc *sc, struct ath_atx_tid *tid, | ||
180 | bool flush_packets) | ||
181 | { | 150 | { |
182 | struct ath_txq *txq = tid->ac->txq; | 151 | struct ath_txq *txq = tid->ac->txq; |
183 | struct sk_buff *skb; | 152 | struct sk_buff *skb; |
@@ -194,15 +163,16 @@ static void ath_tx_flush_tid(struct ath_softc *sc, struct ath_atx_tid *tid, | |||
194 | while ((skb = __skb_dequeue(&tid->buf_q))) { | 163 | while ((skb = __skb_dequeue(&tid->buf_q))) { |
195 | fi = get_frame_info(skb); | 164 | fi = get_frame_info(skb); |
196 | bf = fi->bf; | 165 | bf = fi->bf; |
197 | if (!bf && !flush_packets) | ||
198 | bf = ath_tx_setup_buffer(sc, txq, tid, skb); | ||
199 | 166 | ||
200 | if (!bf) { | 167 | if (!bf) { |
201 | ieee80211_free_txskb(sc->hw, skb); | 168 | bf = ath_tx_setup_buffer(sc, txq, tid, skb); |
202 | continue; | 169 | if (!bf) { |
170 | ieee80211_free_txskb(sc->hw, skb); | ||
171 | continue; | ||
172 | } | ||
203 | } | 173 | } |
204 | 174 | ||
205 | if (fi->retries || flush_packets) { | 175 | if (fi->retries) { |
206 | list_add_tail(&bf->list, &bf_head); | 176 | list_add_tail(&bf->list, &bf_head); |
207 | ath_tx_update_baw(sc, tid, bf->bf_state.seqno); | 177 | ath_tx_update_baw(sc, tid, bf->bf_state.seqno); |
208 | ath_tx_complete_buf(sc, bf, txq, &bf_head, &ts, 0); | 178 | ath_tx_complete_buf(sc, bf, txq, &bf_head, &ts, 0); |
@@ -213,10 +183,7 @@ static void ath_tx_flush_tid(struct ath_softc *sc, struct ath_atx_tid *tid, | |||
213 | } | 183 | } |
214 | } | 184 | } |
215 | 185 | ||
216 | if (tid->baw_head == tid->baw_tail) | 186 | if (sendbar) { |
217 | ath_tx_clear_tid(sc, tid); | ||
218 | |||
219 | if (sendbar && !flush_packets) { | ||
220 | ath_txq_unlock(sc, txq); | 187 | ath_txq_unlock(sc, txq); |
221 | ath_send_bar(tid, tid->seq_start); | 188 | ath_send_bar(tid, tid->seq_start); |
222 | ath_txq_lock(sc, txq); | 189 | ath_txq_lock(sc, txq); |
@@ -499,19 +466,19 @@ static void ath_tx_complete_aggr(struct ath_softc *sc, struct ath_txq *txq, | |||
499 | tx_info = IEEE80211_SKB_CB(skb); | 466 | tx_info = IEEE80211_SKB_CB(skb); |
500 | fi = get_frame_info(skb); | 467 | fi = get_frame_info(skb); |
501 | 468 | ||
502 | if (ATH_BA_ISSET(ba, ATH_BA_INDEX(seq_st, seqno))) { | 469 | if (!BAW_WITHIN(tid->seq_start, tid->baw_size, seqno)) { |
470 | /* | ||
471 | * Outside of the current BlockAck window, | ||
472 | * maybe part of a previous session | ||
473 | */ | ||
474 | txfail = 1; | ||
475 | } else if (ATH_BA_ISSET(ba, ATH_BA_INDEX(seq_st, seqno))) { | ||
503 | /* transmit completion, subframe is | 476 | /* transmit completion, subframe is |
504 | * acked by block ack */ | 477 | * acked by block ack */ |
505 | acked_cnt++; | 478 | acked_cnt++; |
506 | } else if (!isaggr && txok) { | 479 | } else if (!isaggr && txok) { |
507 | /* transmit completion */ | 480 | /* transmit completion */ |
508 | acked_cnt++; | 481 | acked_cnt++; |
509 | } else if (tid->state & AGGR_CLEANUP) { | ||
510 | /* | ||
511 | * cleanup in progress, just fail | ||
512 | * the un-acked sub-frames | ||
513 | */ | ||
514 | txfail = 1; | ||
515 | } else if (flush) { | 482 | } else if (flush) { |
516 | txpending = 1; | 483 | txpending = 1; |
517 | } else if (fi->retries < ATH_MAX_SW_RETRIES) { | 484 | } else if (fi->retries < ATH_MAX_SW_RETRIES) { |
@@ -535,7 +502,7 @@ static void ath_tx_complete_aggr(struct ath_softc *sc, struct ath_txq *txq, | |||
535 | if (bf_next != NULL || !bf_last->bf_stale) | 502 | if (bf_next != NULL || !bf_last->bf_stale) |
536 | list_move_tail(&bf->list, &bf_head); | 503 | list_move_tail(&bf->list, &bf_head); |
537 | 504 | ||
538 | if (!txpending || (tid->state & AGGR_CLEANUP)) { | 505 | if (!txpending) { |
539 | /* | 506 | /* |
540 | * complete the acked-ones/xretried ones; update | 507 | * complete the acked-ones/xretried ones; update |
541 | * block-ack window | 508 | * block-ack window |
@@ -609,9 +576,6 @@ static void ath_tx_complete_aggr(struct ath_softc *sc, struct ath_txq *txq, | |||
609 | ath_txq_lock(sc, txq); | 576 | ath_txq_lock(sc, txq); |
610 | } | 577 | } |
611 | 578 | ||
612 | if (tid->state & AGGR_CLEANUP) | ||
613 | ath_tx_flush_tid(sc, tid, false); | ||
614 | |||
615 | rcu_read_unlock(); | 579 | rcu_read_unlock(); |
616 | 580 | ||
617 | if (needreset) | 581 | if (needreset) |
@@ -1244,9 +1208,6 @@ int ath_tx_aggr_start(struct ath_softc *sc, struct ieee80211_sta *sta, | |||
1244 | an = (struct ath_node *)sta->drv_priv; | 1208 | an = (struct ath_node *)sta->drv_priv; |
1245 | txtid = ATH_AN_2_TID(an, tid); | 1209 | txtid = ATH_AN_2_TID(an, tid); |
1246 | 1210 | ||
1247 | if (txtid->state & (AGGR_CLEANUP | AGGR_ADDBA_COMPLETE)) | ||
1248 | return -EAGAIN; | ||
1249 | |||
1250 | /* update ampdu factor/density, they may have changed. This may happen | 1211 | /* update ampdu factor/density, they may have changed. This may happen |
1251 | * in HT IBSS when a beacon with HT-info is received after the station | 1212 | * in HT IBSS when a beacon with HT-info is received after the station |
1252 | * has already been added. | 1213 | * has already been added. |
@@ -1258,7 +1219,7 @@ int ath_tx_aggr_start(struct ath_softc *sc, struct ieee80211_sta *sta, | |||
1258 | an->mpdudensity = density; | 1219 | an->mpdudensity = density; |
1259 | } | 1220 | } |
1260 | 1221 | ||
1261 | txtid->state |= AGGR_ADDBA_PROGRESS; | 1222 | txtid->active = true; |
1262 | txtid->paused = true; | 1223 | txtid->paused = true; |
1263 | *ssn = txtid->seq_start = txtid->seq_next; | 1224 | *ssn = txtid->seq_start = txtid->seq_next; |
1264 | txtid->bar_index = -1; | 1225 | txtid->bar_index = -1; |
@@ -1269,45 +1230,17 @@ int ath_tx_aggr_start(struct ath_softc *sc, struct ieee80211_sta *sta, | |||
1269 | return 0; | 1230 | return 0; |
1270 | } | 1231 | } |
1271 | 1232 | ||
1272 | bool ath_tx_aggr_stop(struct ath_softc *sc, struct ieee80211_sta *sta, u16 tid, | 1233 | void ath_tx_aggr_stop(struct ath_softc *sc, struct ieee80211_sta *sta, u16 tid) |
1273 | bool flush) | ||
1274 | { | 1234 | { |
1275 | struct ath_node *an = (struct ath_node *)sta->drv_priv; | 1235 | struct ath_node *an = (struct ath_node *)sta->drv_priv; |
1276 | struct ath_atx_tid *txtid = ATH_AN_2_TID(an, tid); | 1236 | struct ath_atx_tid *txtid = ATH_AN_2_TID(an, tid); |
1277 | struct ath_txq *txq = txtid->ac->txq; | 1237 | struct ath_txq *txq = txtid->ac->txq; |
1278 | bool ret = !flush; | ||
1279 | |||
1280 | if (flush) | ||
1281 | txtid->stop_cb = false; | ||
1282 | |||
1283 | if (txtid->state & AGGR_CLEANUP) | ||
1284 | return false; | ||
1285 | |||
1286 | if (!(txtid->state & AGGR_ADDBA_COMPLETE)) { | ||
1287 | txtid->state &= ~AGGR_ADDBA_PROGRESS; | ||
1288 | return ret; | ||
1289 | } | ||
1290 | 1238 | ||
1291 | ath_txq_lock(sc, txq); | 1239 | ath_txq_lock(sc, txq); |
1240 | txtid->active = false; | ||
1292 | txtid->paused = true; | 1241 | txtid->paused = true; |
1293 | 1242 | ath_tx_flush_tid(sc, txtid); | |
1294 | /* | ||
1295 | * If frames are still being transmitted for this TID, they will be | ||
1296 | * cleaned up during tx completion. To prevent race conditions, this | ||
1297 | * TID can only be reused after all in-progress subframes have been | ||
1298 | * completed. | ||
1299 | */ | ||
1300 | if (txtid->baw_head != txtid->baw_tail) { | ||
1301 | txtid->state |= AGGR_CLEANUP; | ||
1302 | ret = false; | ||
1303 | txtid->stop_cb = !flush; | ||
1304 | } else { | ||
1305 | txtid->state &= ~AGGR_ADDBA_COMPLETE; | ||
1306 | } | ||
1307 | |||
1308 | ath_tx_flush_tid(sc, txtid, flush); | ||
1309 | ath_txq_unlock_complete(sc, txq); | 1243 | ath_txq_unlock_complete(sc, txq); |
1310 | return ret; | ||
1311 | } | 1244 | } |
1312 | 1245 | ||
1313 | void ath_tx_aggr_sleep(struct ieee80211_sta *sta, struct ath_softc *sc, | 1246 | void ath_tx_aggr_sleep(struct ieee80211_sta *sta, struct ath_softc *sc, |
@@ -1371,18 +1304,28 @@ void ath_tx_aggr_wakeup(struct ath_softc *sc, struct ath_node *an) | |||
1371 | } | 1304 | } |
1372 | } | 1305 | } |
1373 | 1306 | ||
1374 | void ath_tx_aggr_resume(struct ath_softc *sc, struct ieee80211_sta *sta, u16 tid) | 1307 | void ath_tx_aggr_resume(struct ath_softc *sc, struct ieee80211_sta *sta, |
1308 | u16 tidno) | ||
1375 | { | 1309 | { |
1376 | struct ath_atx_tid *txtid; | 1310 | struct ath_atx_tid *tid; |
1377 | struct ath_node *an; | 1311 | struct ath_node *an; |
1312 | struct ath_txq *txq; | ||
1378 | 1313 | ||
1379 | an = (struct ath_node *)sta->drv_priv; | 1314 | an = (struct ath_node *)sta->drv_priv; |
1315 | tid = ATH_AN_2_TID(an, tidno); | ||
1316 | txq = tid->ac->txq; | ||
1380 | 1317 | ||
1381 | txtid = ATH_AN_2_TID(an, tid); | 1318 | ath_txq_lock(sc, txq); |
1382 | txtid->baw_size = IEEE80211_MIN_AMPDU_BUF << sta->ht_cap.ampdu_factor; | 1319 | |
1383 | txtid->state |= AGGR_ADDBA_COMPLETE; | 1320 | tid->baw_size = IEEE80211_MIN_AMPDU_BUF << sta->ht_cap.ampdu_factor; |
1384 | txtid->state &= ~AGGR_ADDBA_PROGRESS; | 1321 | tid->paused = false; |
1385 | ath_tx_resume_tid(sc, txtid); | 1322 | |
1323 | if (!skb_queue_empty(&tid->buf_q)) { | ||
1324 | ath_tx_queue_tid(txq, tid); | ||
1325 | ath_txq_schedule(sc, txq); | ||
1326 | } | ||
1327 | |||
1328 | ath_txq_unlock_complete(sc, txq); | ||
1386 | } | 1329 | } |
1387 | 1330 | ||
1388 | /********************/ | 1331 | /********************/ |
@@ -1627,6 +1570,8 @@ void ath_txq_schedule(struct ath_softc *sc, struct ath_txq *txq) | |||
1627 | txq->axq_ampdu_depth >= ATH_AGGR_MIN_QDEPTH) | 1570 | txq->axq_ampdu_depth >= ATH_AGGR_MIN_QDEPTH) |
1628 | return; | 1571 | return; |
1629 | 1572 | ||
1573 | rcu_read_lock(); | ||
1574 | |||
1630 | ac = list_first_entry(&txq->axq_acq, struct ath_atx_ac, list); | 1575 | ac = list_first_entry(&txq->axq_acq, struct ath_atx_ac, list); |
1631 | last_ac = list_entry(txq->axq_acq.prev, struct ath_atx_ac, list); | 1576 | last_ac = list_entry(txq->axq_acq.prev, struct ath_atx_ac, list); |
1632 | 1577 | ||
@@ -1665,8 +1610,10 @@ void ath_txq_schedule(struct ath_softc *sc, struct ath_txq *txq) | |||
1665 | 1610 | ||
1666 | if (ac == last_ac || | 1611 | if (ac == last_ac || |
1667 | txq->axq_ampdu_depth >= ATH_AGGR_MIN_QDEPTH) | 1612 | txq->axq_ampdu_depth >= ATH_AGGR_MIN_QDEPTH) |
1668 | return; | 1613 | break; |
1669 | } | 1614 | } |
1615 | |||
1616 | rcu_read_unlock(); | ||
1670 | } | 1617 | } |
1671 | 1618 | ||
1672 | /***********/ | 1619 | /***********/ |
@@ -2431,13 +2378,10 @@ void ath_tx_node_init(struct ath_softc *sc, struct ath_node *an) | |||
2431 | tid->baw_head = tid->baw_tail = 0; | 2378 | tid->baw_head = tid->baw_tail = 0; |
2432 | tid->sched = false; | 2379 | tid->sched = false; |
2433 | tid->paused = false; | 2380 | tid->paused = false; |
2434 | tid->state &= ~AGGR_CLEANUP; | 2381 | tid->active = false; |
2435 | __skb_queue_head_init(&tid->buf_q); | 2382 | __skb_queue_head_init(&tid->buf_q); |
2436 | acno = TID_TO_WME_AC(tidno); | 2383 | acno = TID_TO_WME_AC(tidno); |
2437 | tid->ac = &an->ac[acno]; | 2384 | tid->ac = &an->ac[acno]; |
2438 | tid->state &= ~AGGR_ADDBA_COMPLETE; | ||
2439 | tid->state &= ~AGGR_ADDBA_PROGRESS; | ||
2440 | tid->stop_cb = false; | ||
2441 | } | 2385 | } |
2442 | 2386 | ||
2443 | for (acno = 0, ac = &an->ac[acno]; | 2387 | for (acno = 0, ac = &an->ac[acno]; |
@@ -2474,7 +2418,7 @@ void ath_tx_node_cleanup(struct ath_softc *sc, struct ath_node *an) | |||
2474 | } | 2418 | } |
2475 | 2419 | ||
2476 | ath_tid_drain(sc, txq, tid); | 2420 | ath_tid_drain(sc, txq, tid); |
2477 | ath_tx_clear_tid(sc, tid); | 2421 | tid->active = false; |
2478 | 2422 | ||
2479 | ath_txq_unlock(sc, txq); | 2423 | ath_txq_unlock(sc, txq); |
2480 | } | 2424 | } |
diff --git a/drivers/net/wireless/atmel.c b/drivers/net/wireless/atmel.c index 830bb1d1f957..b827d51c30a3 100644 --- a/drivers/net/wireless/atmel.c +++ b/drivers/net/wireless/atmel.c | |||
@@ -1624,7 +1624,7 @@ struct net_device *init_atmel_card(unsigned short irq, unsigned long port, | |||
1624 | 1624 | ||
1625 | netif_carrier_off(dev); | 1625 | netif_carrier_off(dev); |
1626 | 1626 | ||
1627 | if (!proc_create_data("driver/atmel", 0, NULL, &atmel_proc_fops, priv)); | 1627 | if (!proc_create_data("driver/atmel", 0, NULL, &atmel_proc_fops, priv)) |
1628 | printk(KERN_WARNING "atmel: unable to create /proc entry.\n"); | 1628 | printk(KERN_WARNING "atmel: unable to create /proc entry.\n"); |
1629 | 1629 | ||
1630 | printk(KERN_INFO "%s: Atmel at76c50x. Version %d.%d. MAC %pM\n", | 1630 | printk(KERN_INFO "%s: Atmel at76c50x. Version %d.%d. MAC %pM\n", |
diff --git a/drivers/net/wireless/b43/main.c b/drivers/net/wireless/b43/main.c index 6dd07e2ec595..a95b77ab360e 100644 --- a/drivers/net/wireless/b43/main.c +++ b/drivers/net/wireless/b43/main.c | |||
@@ -2458,7 +2458,7 @@ static void b43_request_firmware(struct work_struct *work) | |||
2458 | for (i = 0; i < B43_NR_FWTYPES; i++) { | 2458 | for (i = 0; i < B43_NR_FWTYPES; i++) { |
2459 | errmsg = ctx->errors[i]; | 2459 | errmsg = ctx->errors[i]; |
2460 | if (strlen(errmsg)) | 2460 | if (strlen(errmsg)) |
2461 | b43err(dev->wl, errmsg); | 2461 | b43err(dev->wl, "%s", errmsg); |
2462 | } | 2462 | } |
2463 | b43_print_fw_helptext(dev->wl, 1); | 2463 | b43_print_fw_helptext(dev->wl, 1); |
2464 | goto out; | 2464 | goto out; |
diff --git a/drivers/net/wireless/brcm80211/brcmfmac/dhd_common.c b/drivers/net/wireless/brcm80211/brcmfmac/dhd_common.c index be0787cab24f..9431af2465f3 100644 --- a/drivers/net/wireless/brcm80211/brcmfmac/dhd_common.c +++ b/drivers/net/wireless/brcm80211/brcmfmac/dhd_common.c | |||
@@ -27,7 +27,6 @@ | |||
27 | #include "tracepoint.h" | 27 | #include "tracepoint.h" |
28 | 28 | ||
29 | #define PKTFILTER_BUF_SIZE 128 | 29 | #define PKTFILTER_BUF_SIZE 128 |
30 | #define BRCMF_ARPOL_MODE 0xb /* agent|snoop|peer_autoreply */ | ||
31 | #define BRCMF_DEFAULT_BCN_TIMEOUT 3 | 30 | #define BRCMF_DEFAULT_BCN_TIMEOUT 3 |
32 | #define BRCMF_DEFAULT_SCAN_CHANNEL_TIME 40 | 31 | #define BRCMF_DEFAULT_SCAN_CHANNEL_TIME 40 |
33 | #define BRCMF_DEFAULT_SCAN_UNASSOC_TIME 40 | 32 | #define BRCMF_DEFAULT_SCAN_UNASSOC_TIME 40 |
@@ -338,23 +337,6 @@ int brcmf_c_preinit_dcmds(struct brcmf_if *ifp) | |||
338 | goto done; | 337 | goto done; |
339 | } | 338 | } |
340 | 339 | ||
341 | /* Try to set and enable ARP offload feature, this may fail */ | ||
342 | err = brcmf_fil_iovar_int_set(ifp, "arp_ol", BRCMF_ARPOL_MODE); | ||
343 | if (err) { | ||
344 | brcmf_dbg(TRACE, "failed to set ARP offload mode to 0x%x, err = %d\n", | ||
345 | BRCMF_ARPOL_MODE, err); | ||
346 | err = 0; | ||
347 | } else { | ||
348 | err = brcmf_fil_iovar_int_set(ifp, "arpoe", 1); | ||
349 | if (err) { | ||
350 | brcmf_dbg(TRACE, "failed to enable ARP offload err = %d\n", | ||
351 | err); | ||
352 | err = 0; | ||
353 | } else | ||
354 | brcmf_dbg(TRACE, "successfully enabled ARP offload to 0x%x\n", | ||
355 | BRCMF_ARPOL_MODE); | ||
356 | } | ||
357 | |||
358 | /* Setup packet filter */ | 340 | /* Setup packet filter */ |
359 | brcmf_c_pktfilter_offload_set(ifp, BRCMF_DEFAULT_PACKET_FILTER); | 341 | brcmf_c_pktfilter_offload_set(ifp, BRCMF_DEFAULT_PACKET_FILTER); |
360 | brcmf_c_pktfilter_offload_enable(ifp, BRCMF_DEFAULT_PACKET_FILTER, | 342 | brcmf_c_pktfilter_offload_enable(ifp, BRCMF_DEFAULT_PACKET_FILTER, |
diff --git a/drivers/net/wireless/brcm80211/brcmfmac/dhd_linux.c b/drivers/net/wireless/brcm80211/brcmfmac/dhd_linux.c index 59c25463e428..2c593570497c 100644 --- a/drivers/net/wireless/brcm80211/brcmfmac/dhd_linux.c +++ b/drivers/net/wireless/brcm80211/brcmfmac/dhd_linux.c | |||
@@ -653,10 +653,13 @@ int brcmf_net_attach(struct brcmf_if *ifp, bool rtnl_locked) | |||
653 | 653 | ||
654 | brcmf_dbg(INFO, "%s: Broadcom Dongle Host Driver\n", ndev->name); | 654 | brcmf_dbg(INFO, "%s: Broadcom Dongle Host Driver\n", ndev->name); |
655 | 655 | ||
656 | ndev->destructor = free_netdev; | ||
656 | return 0; | 657 | return 0; |
657 | 658 | ||
658 | fail: | 659 | fail: |
660 | drvr->iflist[ifp->bssidx] = NULL; | ||
659 | ndev->netdev_ops = NULL; | 661 | ndev->netdev_ops = NULL; |
662 | free_netdev(ndev); | ||
660 | return -EBADE; | 663 | return -EBADE; |
661 | } | 664 | } |
662 | 665 | ||
@@ -720,6 +723,9 @@ static int brcmf_net_p2p_attach(struct brcmf_if *ifp) | |||
720 | return 0; | 723 | return 0; |
721 | 724 | ||
722 | fail: | 725 | fail: |
726 | ifp->drvr->iflist[ifp->bssidx] = NULL; | ||
727 | ndev->netdev_ops = NULL; | ||
728 | free_netdev(ndev); | ||
723 | return -EBADE; | 729 | return -EBADE; |
724 | } | 730 | } |
725 | 731 | ||
@@ -788,6 +794,7 @@ void brcmf_del_if(struct brcmf_pub *drvr, s32 bssidx) | |||
788 | struct brcmf_if *ifp; | 794 | struct brcmf_if *ifp; |
789 | 795 | ||
790 | ifp = drvr->iflist[bssidx]; | 796 | ifp = drvr->iflist[bssidx]; |
797 | drvr->iflist[bssidx] = NULL; | ||
791 | if (!ifp) { | 798 | if (!ifp) { |
792 | brcmf_err("Null interface, idx=%d\n", bssidx); | 799 | brcmf_err("Null interface, idx=%d\n", bssidx); |
793 | return; | 800 | return; |
@@ -808,15 +815,13 @@ void brcmf_del_if(struct brcmf_pub *drvr, s32 bssidx) | |||
808 | cancel_work_sync(&ifp->setmacaddr_work); | 815 | cancel_work_sync(&ifp->setmacaddr_work); |
809 | cancel_work_sync(&ifp->multicast_work); | 816 | cancel_work_sync(&ifp->multicast_work); |
810 | } | 817 | } |
811 | 818 | /* unregister will take care of freeing it */ | |
812 | unregister_netdev(ifp->ndev); | 819 | unregister_netdev(ifp->ndev); |
813 | if (bssidx == 0) | 820 | if (bssidx == 0) |
814 | brcmf_cfg80211_detach(drvr->config); | 821 | brcmf_cfg80211_detach(drvr->config); |
815 | free_netdev(ifp->ndev); | ||
816 | } else { | 822 | } else { |
817 | kfree(ifp); | 823 | kfree(ifp); |
818 | } | 824 | } |
819 | drvr->iflist[bssidx] = NULL; | ||
820 | } | 825 | } |
821 | 826 | ||
822 | int brcmf_attach(uint bus_hdrlen, struct device *dev) | 827 | int brcmf_attach(uint bus_hdrlen, struct device *dev) |
@@ -925,8 +930,10 @@ fail: | |||
925 | brcmf_fws_del_interface(ifp); | 930 | brcmf_fws_del_interface(ifp); |
926 | brcmf_fws_deinit(drvr); | 931 | brcmf_fws_deinit(drvr); |
927 | } | 932 | } |
928 | free_netdev(ifp->ndev); | 933 | if (drvr->iflist[0]) { |
929 | drvr->iflist[0] = NULL; | 934 | free_netdev(ifp->ndev); |
935 | drvr->iflist[0] = NULL; | ||
936 | } | ||
930 | if (p2p_ifp) { | 937 | if (p2p_ifp) { |
931 | free_netdev(p2p_ifp->ndev); | 938 | free_netdev(p2p_ifp->ndev); |
932 | drvr->iflist[1] = NULL; | 939 | drvr->iflist[1] = NULL; |
@@ -934,7 +941,8 @@ fail: | |||
934 | return ret; | 941 | return ret; |
935 | } | 942 | } |
936 | if ((brcmf_p2p_enable) && (p2p_ifp)) | 943 | if ((brcmf_p2p_enable) && (p2p_ifp)) |
937 | brcmf_net_p2p_attach(p2p_ifp); | 944 | if (brcmf_net_p2p_attach(p2p_ifp) < 0) |
945 | brcmf_p2p_enable = 0; | ||
938 | 946 | ||
939 | return 0; | 947 | return 0; |
940 | } | 948 | } |
diff --git a/drivers/net/wireless/brcm80211/brcmfmac/fweh.c b/drivers/net/wireless/brcm80211/brcmfmac/fweh.c index 5a64280e6485..83ee53a7c76e 100644 --- a/drivers/net/wireless/brcm80211/brcmfmac/fweh.c +++ b/drivers/net/wireless/brcm80211/brcmfmac/fweh.c | |||
@@ -202,7 +202,8 @@ static void brcmf_fweh_handle_if_event(struct brcmf_pub *drvr, | |||
202 | return; | 202 | return; |
203 | brcmf_fws_add_interface(ifp); | 203 | brcmf_fws_add_interface(ifp); |
204 | if (!drvr->fweh.evt_handler[BRCMF_E_IF]) | 204 | if (!drvr->fweh.evt_handler[BRCMF_E_IF]) |
205 | err = brcmf_net_attach(ifp, false); | 205 | if (brcmf_net_attach(ifp, false) < 0) |
206 | return; | ||
206 | } | 207 | } |
207 | 208 | ||
208 | if (ifevent->action == BRCMF_E_IF_CHANGE) | 209 | if (ifevent->action == BRCMF_E_IF_CHANGE) |
diff --git a/drivers/net/wireless/brcm80211/brcmfmac/fwil_types.h b/drivers/net/wireless/brcm80211/brcmfmac/fwil_types.h index 0f2c83bc95dc..665ef69e974b 100644 --- a/drivers/net/wireless/brcm80211/brcmfmac/fwil_types.h +++ b/drivers/net/wireless/brcm80211/brcmfmac/fwil_types.h | |||
@@ -23,6 +23,12 @@ | |||
23 | 23 | ||
24 | #define BRCMF_FIL_ACTION_FRAME_SIZE 1800 | 24 | #define BRCMF_FIL_ACTION_FRAME_SIZE 1800 |
25 | 25 | ||
26 | /* ARP Offload feature flags for arp_ol iovar */ | ||
27 | #define BRCMF_ARP_OL_AGENT 0x00000001 | ||
28 | #define BRCMF_ARP_OL_SNOOP 0x00000002 | ||
29 | #define BRCMF_ARP_OL_HOST_AUTO_REPLY 0x00000004 | ||
30 | #define BRCMF_ARP_OL_PEER_AUTO_REPLY 0x00000008 | ||
31 | |||
26 | 32 | ||
27 | enum brcmf_fil_p2p_if_types { | 33 | enum brcmf_fil_p2p_if_types { |
28 | BRCMF_FIL_P2P_IF_CLIENT, | 34 | BRCMF_FIL_P2P_IF_CLIENT, |
diff --git a/drivers/net/wireless/brcm80211/brcmfmac/p2p.c b/drivers/net/wireless/brcm80211/brcmfmac/p2p.c index e7a1a4770996..79555f006d53 100644 --- a/drivers/net/wireless/brcm80211/brcmfmac/p2p.c +++ b/drivers/net/wireless/brcm80211/brcmfmac/p2p.c | |||
@@ -47,6 +47,7 @@ | |||
47 | #define IS_P2P_SOCIAL_CHANNEL(channel) ((channel == SOCIAL_CHAN_1) || \ | 47 | #define IS_P2P_SOCIAL_CHANNEL(channel) ((channel == SOCIAL_CHAN_1) || \ |
48 | (channel == SOCIAL_CHAN_2) || \ | 48 | (channel == SOCIAL_CHAN_2) || \ |
49 | (channel == SOCIAL_CHAN_3)) | 49 | (channel == SOCIAL_CHAN_3)) |
50 | #define BRCMF_P2P_TEMP_CHAN SOCIAL_CHAN_3 | ||
50 | #define SOCIAL_CHAN_CNT 3 | 51 | #define SOCIAL_CHAN_CNT 3 |
51 | #define AF_PEER_SEARCH_CNT 2 | 52 | #define AF_PEER_SEARCH_CNT 2 |
52 | 53 | ||
@@ -1954,21 +1955,21 @@ s32 brcmf_p2p_attach(struct brcmf_cfg80211_info *cfg) | |||
1954 | err = brcmf_fil_iovar_int_set(pri_ifp, "p2p_disc", 1); | 1955 | err = brcmf_fil_iovar_int_set(pri_ifp, "p2p_disc", 1); |
1955 | if (err < 0) { | 1956 | if (err < 0) { |
1956 | brcmf_err("set p2p_disc error\n"); | 1957 | brcmf_err("set p2p_disc error\n"); |
1957 | brcmf_free_vif(p2p_vif); | 1958 | brcmf_free_vif(cfg, p2p_vif); |
1958 | goto exit; | 1959 | goto exit; |
1959 | } | 1960 | } |
1960 | /* obtain bsscfg index for P2P discovery */ | 1961 | /* obtain bsscfg index for P2P discovery */ |
1961 | err = brcmf_fil_iovar_int_get(pri_ifp, "p2p_dev", &bssidx); | 1962 | err = brcmf_fil_iovar_int_get(pri_ifp, "p2p_dev", &bssidx); |
1962 | if (err < 0) { | 1963 | if (err < 0) { |
1963 | brcmf_err("retrieving discover bsscfg index failed\n"); | 1964 | brcmf_err("retrieving discover bsscfg index failed\n"); |
1964 | brcmf_free_vif(p2p_vif); | 1965 | brcmf_free_vif(cfg, p2p_vif); |
1965 | goto exit; | 1966 | goto exit; |
1966 | } | 1967 | } |
1967 | /* Verify that firmware uses same bssidx as driver !! */ | 1968 | /* Verify that firmware uses same bssidx as driver !! */ |
1968 | if (p2p_ifp->bssidx != bssidx) { | 1969 | if (p2p_ifp->bssidx != bssidx) { |
1969 | brcmf_err("Incorrect bssidx=%d, compared to p2p_ifp->bssidx=%d\n", | 1970 | brcmf_err("Incorrect bssidx=%d, compared to p2p_ifp->bssidx=%d\n", |
1970 | bssidx, p2p_ifp->bssidx); | 1971 | bssidx, p2p_ifp->bssidx); |
1971 | brcmf_free_vif(p2p_vif); | 1972 | brcmf_free_vif(cfg, p2p_vif); |
1972 | goto exit; | 1973 | goto exit; |
1973 | } | 1974 | } |
1974 | 1975 | ||
@@ -1996,7 +1997,7 @@ void brcmf_p2p_detach(struct brcmf_p2p_info *p2p) | |||
1996 | brcmf_p2p_cancel_remain_on_channel(vif->ifp); | 1997 | brcmf_p2p_cancel_remain_on_channel(vif->ifp); |
1997 | brcmf_p2p_deinit_discovery(p2p); | 1998 | brcmf_p2p_deinit_discovery(p2p); |
1998 | /* remove discovery interface */ | 1999 | /* remove discovery interface */ |
1999 | brcmf_free_vif(vif); | 2000 | brcmf_free_vif(p2p->cfg, vif); |
2000 | p2p->bss_idx[P2PAPI_BSSCFG_DEVICE].vif = NULL; | 2001 | p2p->bss_idx[P2PAPI_BSSCFG_DEVICE].vif = NULL; |
2001 | } | 2002 | } |
2002 | /* just set it all to zero */ | 2003 | /* just set it all to zero */ |
@@ -2013,17 +2014,30 @@ static void brcmf_p2p_get_current_chanspec(struct brcmf_p2p_info *p2p, | |||
2013 | u16 *chanspec) | 2014 | u16 *chanspec) |
2014 | { | 2015 | { |
2015 | struct brcmf_if *ifp; | 2016 | struct brcmf_if *ifp; |
2016 | struct brcmf_fil_chan_info_le ci; | 2017 | u8 mac_addr[ETH_ALEN]; |
2017 | struct brcmu_chan ch; | 2018 | struct brcmu_chan ch; |
2018 | s32 err; | 2019 | struct brcmf_bss_info_le *bi; |
2020 | u8 *buf; | ||
2019 | 2021 | ||
2020 | ifp = p2p->bss_idx[P2PAPI_BSSCFG_PRIMARY].vif->ifp; | 2022 | ifp = p2p->bss_idx[P2PAPI_BSSCFG_PRIMARY].vif->ifp; |
2021 | 2023 | ||
2022 | ch.chnum = 11; | 2024 | if (brcmf_fil_cmd_data_get(ifp, BRCMF_C_GET_BSSID, mac_addr, |
2023 | 2025 | ETH_ALEN) == 0) { | |
2024 | err = brcmf_fil_cmd_data_get(ifp, BRCMF_C_GET_CHANNEL, &ci, sizeof(ci)); | 2026 | buf = kzalloc(WL_BSS_INFO_MAX, GFP_KERNEL); |
2025 | if (!err) | 2027 | if (buf != NULL) { |
2026 | ch.chnum = le32_to_cpu(ci.hw_channel); | 2028 | *(__le32 *)buf = cpu_to_le32(WL_BSS_INFO_MAX); |
2029 | if (brcmf_fil_cmd_data_get(ifp, BRCMF_C_GET_BSS_INFO, | ||
2030 | buf, WL_BSS_INFO_MAX) == 0) { | ||
2031 | bi = (struct brcmf_bss_info_le *)(buf + 4); | ||
2032 | *chanspec = le16_to_cpu(bi->chanspec); | ||
2033 | kfree(buf); | ||
2034 | return; | ||
2035 | } | ||
2036 | kfree(buf); | ||
2037 | } | ||
2038 | } | ||
2039 | /* Use default channel for P2P */ | ||
2040 | ch.chnum = BRCMF_P2P_TEMP_CHAN; | ||
2027 | ch.bw = BRCMU_CHAN_BW_20; | 2041 | ch.bw = BRCMU_CHAN_BW_20; |
2028 | p2p->cfg->d11inf.encchspec(&ch); | 2042 | p2p->cfg->d11inf.encchspec(&ch); |
2029 | *chanspec = ch.chspec; | 2043 | *chanspec = ch.chspec; |
@@ -2208,7 +2222,7 @@ static struct wireless_dev *brcmf_p2p_create_p2pdev(struct brcmf_p2p_info *p2p, | |||
2208 | return &p2p_vif->wdev; | 2222 | return &p2p_vif->wdev; |
2209 | 2223 | ||
2210 | fail: | 2224 | fail: |
2211 | brcmf_free_vif(p2p_vif); | 2225 | brcmf_free_vif(p2p->cfg, p2p_vif); |
2212 | return ERR_PTR(err); | 2226 | return ERR_PTR(err); |
2213 | } | 2227 | } |
2214 | 2228 | ||
@@ -2217,13 +2231,31 @@ fail: | |||
2217 | * | 2231 | * |
2218 | * @vif: virtual interface object to delete. | 2232 | * @vif: virtual interface object to delete. |
2219 | */ | 2233 | */ |
2220 | static void brcmf_p2p_delete_p2pdev(struct brcmf_cfg80211_vif *vif) | 2234 | static void brcmf_p2p_delete_p2pdev(struct brcmf_cfg80211_info *cfg, |
2235 | struct brcmf_cfg80211_vif *vif) | ||
2221 | { | 2236 | { |
2222 | struct brcmf_p2p_info *p2p = &vif->ifp->drvr->config->p2p; | ||
2223 | |||
2224 | cfg80211_unregister_wdev(&vif->wdev); | 2237 | cfg80211_unregister_wdev(&vif->wdev); |
2225 | p2p->bss_idx[P2PAPI_BSSCFG_DEVICE].vif = NULL; | 2238 | cfg->p2p.bss_idx[P2PAPI_BSSCFG_DEVICE].vif = NULL; |
2226 | brcmf_free_vif(vif); | 2239 | brcmf_free_vif(cfg, vif); |
2240 | } | ||
2241 | |||
2242 | /** | ||
2243 | * brcmf_p2p_free_p2p_if() - free up net device related data. | ||
2244 | * | ||
2245 | * @ndev: net device that needs to be freed. | ||
2246 | */ | ||
2247 | static void brcmf_p2p_free_p2p_if(struct net_device *ndev) | ||
2248 | { | ||
2249 | struct brcmf_cfg80211_info *cfg; | ||
2250 | struct brcmf_cfg80211_vif *vif; | ||
2251 | struct brcmf_if *ifp; | ||
2252 | |||
2253 | ifp = netdev_priv(ndev); | ||
2254 | cfg = ifp->drvr->config; | ||
2255 | vif = ifp->vif; | ||
2256 | |||
2257 | brcmf_free_vif(cfg, vif); | ||
2258 | free_netdev(ifp->ndev); | ||
2227 | } | 2259 | } |
2228 | 2260 | ||
2229 | /** | 2261 | /** |
@@ -2303,6 +2335,9 @@ struct wireless_dev *brcmf_p2p_add_vif(struct wiphy *wiphy, const char *name, | |||
2303 | brcmf_err("Registering netdevice failed\n"); | 2335 | brcmf_err("Registering netdevice failed\n"); |
2304 | goto fail; | 2336 | goto fail; |
2305 | } | 2337 | } |
2338 | /* override destructor */ | ||
2339 | ifp->ndev->destructor = brcmf_p2p_free_p2p_if; | ||
2340 | |||
2306 | cfg->p2p.bss_idx[P2PAPI_BSSCFG_CONNECTION].vif = vif; | 2341 | cfg->p2p.bss_idx[P2PAPI_BSSCFG_CONNECTION].vif = vif; |
2307 | /* Disable firmware roaming for P2P interface */ | 2342 | /* Disable firmware roaming for P2P interface */ |
2308 | brcmf_fil_iovar_int_set(ifp, "roam_off", 1); | 2343 | brcmf_fil_iovar_int_set(ifp, "roam_off", 1); |
@@ -2314,7 +2349,7 @@ struct wireless_dev *brcmf_p2p_add_vif(struct wiphy *wiphy, const char *name, | |||
2314 | return &ifp->vif->wdev; | 2349 | return &ifp->vif->wdev; |
2315 | 2350 | ||
2316 | fail: | 2351 | fail: |
2317 | brcmf_free_vif(vif); | 2352 | brcmf_free_vif(cfg, vif); |
2318 | return ERR_PTR(err); | 2353 | return ERR_PTR(err); |
2319 | } | 2354 | } |
2320 | 2355 | ||
@@ -2350,7 +2385,7 @@ int brcmf_p2p_del_vif(struct wiphy *wiphy, struct wireless_dev *wdev) | |||
2350 | break; | 2385 | break; |
2351 | 2386 | ||
2352 | case NL80211_IFTYPE_P2P_DEVICE: | 2387 | case NL80211_IFTYPE_P2P_DEVICE: |
2353 | brcmf_p2p_delete_p2pdev(vif); | 2388 | brcmf_p2p_delete_p2pdev(cfg, vif); |
2354 | return 0; | 2389 | return 0; |
2355 | default: | 2390 | default: |
2356 | return -ENOTSUPP; | 2391 | return -ENOTSUPP; |
@@ -2378,7 +2413,6 @@ int brcmf_p2p_del_vif(struct wiphy *wiphy, struct wireless_dev *wdev) | |||
2378 | err = 0; | 2413 | err = 0; |
2379 | } | 2414 | } |
2380 | brcmf_cfg80211_arm_vif_event(cfg, NULL); | 2415 | brcmf_cfg80211_arm_vif_event(cfg, NULL); |
2381 | brcmf_free_vif(vif); | ||
2382 | p2p->bss_idx[P2PAPI_BSSCFG_CONNECTION].vif = NULL; | 2416 | p2p->bss_idx[P2PAPI_BSSCFG_CONNECTION].vif = NULL; |
2383 | 2417 | ||
2384 | return err; | 2418 | return err; |
diff --git a/drivers/net/wireless/brcm80211/brcmfmac/wl_cfg80211.c b/drivers/net/wireless/brcm80211/brcmfmac/wl_cfg80211.c index 761f501959a9..301e572e8923 100644 --- a/drivers/net/wireless/brcm80211/brcmfmac/wl_cfg80211.c +++ b/drivers/net/wireless/brcm80211/brcmfmac/wl_cfg80211.c | |||
@@ -459,6 +459,38 @@ send_key_to_dongle(struct net_device *ndev, struct brcmf_wsec_key *key) | |||
459 | return err; | 459 | return err; |
460 | } | 460 | } |
461 | 461 | ||
462 | static s32 | ||
463 | brcmf_configure_arp_offload(struct brcmf_if *ifp, bool enable) | ||
464 | { | ||
465 | s32 err; | ||
466 | u32 mode; | ||
467 | |||
468 | if (enable) | ||
469 | mode = BRCMF_ARP_OL_AGENT | BRCMF_ARP_OL_PEER_AUTO_REPLY; | ||
470 | else | ||
471 | mode = 0; | ||
472 | |||
473 | /* Try to set and enable ARP offload feature, this may fail, then it */ | ||
474 | /* is simply not supported and err 0 will be returned */ | ||
475 | err = brcmf_fil_iovar_int_set(ifp, "arp_ol", mode); | ||
476 | if (err) { | ||
477 | brcmf_dbg(TRACE, "failed to set ARP offload mode to 0x%x, err = %d\n", | ||
478 | mode, err); | ||
479 | err = 0; | ||
480 | } else { | ||
481 | err = brcmf_fil_iovar_int_set(ifp, "arpoe", enable); | ||
482 | if (err) { | ||
483 | brcmf_dbg(TRACE, "failed to configure (%d) ARP offload err = %d\n", | ||
484 | enable, err); | ||
485 | err = 0; | ||
486 | } else | ||
487 | brcmf_dbg(TRACE, "successfully configured (%d) ARP offload to 0x%x\n", | ||
488 | enable, mode); | ||
489 | } | ||
490 | |||
491 | return err; | ||
492 | } | ||
493 | |||
462 | static struct wireless_dev *brcmf_cfg80211_add_iface(struct wiphy *wiphy, | 494 | static struct wireless_dev *brcmf_cfg80211_add_iface(struct wiphy *wiphy, |
463 | const char *name, | 495 | const char *name, |
464 | enum nl80211_iftype type, | 496 | enum nl80211_iftype type, |
@@ -2216,6 +2248,11 @@ brcmf_cfg80211_set_power_mgmt(struct wiphy *wiphy, struct net_device *ndev, | |||
2216 | } | 2248 | } |
2217 | 2249 | ||
2218 | pm = enabled ? PM_FAST : PM_OFF; | 2250 | pm = enabled ? PM_FAST : PM_OFF; |
2251 | /* Do not enable the power save after assoc if it is a p2p interface */ | ||
2252 | if (ifp->vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT) { | ||
2253 | brcmf_dbg(INFO, "Do not enable power save for P2P clients\n"); | ||
2254 | pm = PM_OFF; | ||
2255 | } | ||
2219 | brcmf_dbg(INFO, "power save %s\n", (pm ? "enabled" : "disabled")); | 2256 | brcmf_dbg(INFO, "power save %s\n", (pm ? "enabled" : "disabled")); |
2220 | 2257 | ||
2221 | err = brcmf_fil_cmd_int_set(ifp, BRCMF_C_SET_PM, pm); | 2258 | err = brcmf_fil_cmd_int_set(ifp, BRCMF_C_SET_PM, pm); |
@@ -3640,10 +3677,28 @@ brcmf_config_ap_mgmt_ie(struct brcmf_cfg80211_vif *vif, | |||
3640 | } | 3677 | } |
3641 | 3678 | ||
3642 | static s32 | 3679 | static s32 |
3680 | brcmf_cfg80211_set_channel(struct brcmf_cfg80211_info *cfg, | ||
3681 | struct brcmf_if *ifp, | ||
3682 | struct ieee80211_channel *channel) | ||
3683 | { | ||
3684 | u16 chanspec; | ||
3685 | s32 err; | ||
3686 | |||
3687 | brcmf_dbg(TRACE, "band=%d, center_freq=%d\n", channel->band, | ||
3688 | channel->center_freq); | ||
3689 | |||
3690 | chanspec = channel_to_chanspec(&cfg->d11inf, channel); | ||
3691 | err = brcmf_fil_iovar_int_set(ifp, "chanspec", chanspec); | ||
3692 | |||
3693 | return err; | ||
3694 | } | ||
3695 | |||
3696 | static s32 | ||
3643 | brcmf_cfg80211_start_ap(struct wiphy *wiphy, struct net_device *ndev, | 3697 | brcmf_cfg80211_start_ap(struct wiphy *wiphy, struct net_device *ndev, |
3644 | struct cfg80211_ap_settings *settings) | 3698 | struct cfg80211_ap_settings *settings) |
3645 | { | 3699 | { |
3646 | s32 ie_offset; | 3700 | s32 ie_offset; |
3701 | struct brcmf_cfg80211_info *cfg = wiphy_to_cfg(wiphy); | ||
3647 | struct brcmf_if *ifp = netdev_priv(ndev); | 3702 | struct brcmf_if *ifp = netdev_priv(ndev); |
3648 | struct brcmf_tlv *ssid_ie; | 3703 | struct brcmf_tlv *ssid_ie; |
3649 | struct brcmf_ssid_le ssid_le; | 3704 | struct brcmf_ssid_le ssid_le; |
@@ -3683,6 +3738,7 @@ brcmf_cfg80211_start_ap(struct wiphy *wiphy, struct net_device *ndev, | |||
3683 | } | 3738 | } |
3684 | 3739 | ||
3685 | brcmf_set_mpc(ifp, 0); | 3740 | brcmf_set_mpc(ifp, 0); |
3741 | brcmf_configure_arp_offload(ifp, false); | ||
3686 | 3742 | ||
3687 | /* find the RSN_IE */ | 3743 | /* find the RSN_IE */ |
3688 | rsn_ie = brcmf_parse_tlvs((u8 *)settings->beacon.tail, | 3744 | rsn_ie = brcmf_parse_tlvs((u8 *)settings->beacon.tail, |
@@ -3713,6 +3769,12 @@ brcmf_cfg80211_start_ap(struct wiphy *wiphy, struct net_device *ndev, | |||
3713 | 3769 | ||
3714 | brcmf_config_ap_mgmt_ie(ifp->vif, &settings->beacon); | 3770 | brcmf_config_ap_mgmt_ie(ifp->vif, &settings->beacon); |
3715 | 3771 | ||
3772 | err = brcmf_cfg80211_set_channel(cfg, ifp, settings->chandef.chan); | ||
3773 | if (err < 0) { | ||
3774 | brcmf_err("Set Channel failed, %d\n", err); | ||
3775 | goto exit; | ||
3776 | } | ||
3777 | |||
3716 | if (settings->beacon_interval) { | 3778 | if (settings->beacon_interval) { |
3717 | err = brcmf_fil_cmd_int_set(ifp, BRCMF_C_SET_BCNPRD, | 3779 | err = brcmf_fil_cmd_int_set(ifp, BRCMF_C_SET_BCNPRD, |
3718 | settings->beacon_interval); | 3780 | settings->beacon_interval); |
@@ -3789,8 +3851,10 @@ brcmf_cfg80211_start_ap(struct wiphy *wiphy, struct net_device *ndev, | |||
3789 | set_bit(BRCMF_VIF_STATUS_AP_CREATED, &ifp->vif->sme_state); | 3851 | set_bit(BRCMF_VIF_STATUS_AP_CREATED, &ifp->vif->sme_state); |
3790 | 3852 | ||
3791 | exit: | 3853 | exit: |
3792 | if (err) | 3854 | if (err) { |
3793 | brcmf_set_mpc(ifp, 1); | 3855 | brcmf_set_mpc(ifp, 1); |
3856 | brcmf_configure_arp_offload(ifp, true); | ||
3857 | } | ||
3794 | return err; | 3858 | return err; |
3795 | } | 3859 | } |
3796 | 3860 | ||
@@ -3831,6 +3895,7 @@ static int brcmf_cfg80211_stop_ap(struct wiphy *wiphy, struct net_device *ndev) | |||
3831 | brcmf_err("bss_enable config failed %d\n", err); | 3895 | brcmf_err("bss_enable config failed %d\n", err); |
3832 | } | 3896 | } |
3833 | brcmf_set_mpc(ifp, 1); | 3897 | brcmf_set_mpc(ifp, 1); |
3898 | brcmf_configure_arp_offload(ifp, true); | ||
3834 | set_bit(BRCMF_VIF_STATUS_AP_CREATING, &ifp->vif->sme_state); | 3899 | set_bit(BRCMF_VIF_STATUS_AP_CREATING, &ifp->vif->sme_state); |
3835 | clear_bit(BRCMF_VIF_STATUS_AP_CREATED, &ifp->vif->sme_state); | 3900 | clear_bit(BRCMF_VIF_STATUS_AP_CREATED, &ifp->vif->sme_state); |
3836 | 3901 | ||
@@ -4148,7 +4213,7 @@ static const struct ieee80211_iface_limit brcmf_iface_limits[] = { | |||
4148 | static const struct ieee80211_iface_combination brcmf_iface_combos[] = { | 4213 | static const struct ieee80211_iface_combination brcmf_iface_combos[] = { |
4149 | { | 4214 | { |
4150 | .max_interfaces = BRCMF_IFACE_MAX_CNT, | 4215 | .max_interfaces = BRCMF_IFACE_MAX_CNT, |
4151 | .num_different_channels = 1, /* no multi-channel for now */ | 4216 | .num_different_channels = 2, |
4152 | .n_limits = ARRAY_SIZE(brcmf_iface_limits), | 4217 | .n_limits = ARRAY_SIZE(brcmf_iface_limits), |
4153 | .limits = brcmf_iface_limits | 4218 | .limits = brcmf_iface_limits |
4154 | } | 4219 | } |
@@ -4256,20 +4321,16 @@ struct brcmf_cfg80211_vif *brcmf_alloc_vif(struct brcmf_cfg80211_info *cfg, | |||
4256 | return vif; | 4321 | return vif; |
4257 | } | 4322 | } |
4258 | 4323 | ||
4259 | void brcmf_free_vif(struct brcmf_cfg80211_vif *vif) | 4324 | void brcmf_free_vif(struct brcmf_cfg80211_info *cfg, |
4325 | struct brcmf_cfg80211_vif *vif) | ||
4260 | { | 4326 | { |
4261 | struct brcmf_cfg80211_info *cfg; | ||
4262 | struct wiphy *wiphy; | ||
4263 | |||
4264 | wiphy = vif->wdev.wiphy; | ||
4265 | cfg = wiphy_priv(wiphy); | ||
4266 | list_del(&vif->list); | 4327 | list_del(&vif->list); |
4267 | cfg->vif_cnt--; | 4328 | cfg->vif_cnt--; |
4268 | 4329 | ||
4269 | kfree(vif); | 4330 | kfree(vif); |
4270 | if (!cfg->vif_cnt) { | 4331 | if (!cfg->vif_cnt) { |
4271 | wiphy_unregister(wiphy); | 4332 | wiphy_unregister(cfg->wiphy); |
4272 | wiphy_free(wiphy); | 4333 | wiphy_free(cfg->wiphy); |
4273 | } | 4334 | } |
4274 | } | 4335 | } |
4275 | 4336 | ||
@@ -4646,7 +4707,6 @@ static s32 brcmf_notify_vif_event(struct brcmf_if *ifp, | |||
4646 | return 0; | 4707 | return 0; |
4647 | 4708 | ||
4648 | case BRCMF_E_IF_DEL: | 4709 | case BRCMF_E_IF_DEL: |
4649 | ifp->vif = NULL; | ||
4650 | mutex_unlock(&event->vif_event_lock); | 4710 | mutex_unlock(&event->vif_event_lock); |
4651 | /* event may not be upon user request */ | 4711 | /* event may not be upon user request */ |
4652 | if (brcmf_cfg80211_vif_event_armed(cfg)) | 4712 | if (brcmf_cfg80211_vif_event_armed(cfg)) |
@@ -4852,8 +4912,7 @@ cfg80211_p2p_attach_out: | |||
4852 | wl_deinit_priv(cfg); | 4912 | wl_deinit_priv(cfg); |
4853 | 4913 | ||
4854 | cfg80211_attach_out: | 4914 | cfg80211_attach_out: |
4855 | brcmf_free_vif(vif); | 4915 | brcmf_free_vif(cfg, vif); |
4856 | wiphy_free(wiphy); | ||
4857 | return NULL; | 4916 | return NULL; |
4858 | } | 4917 | } |
4859 | 4918 | ||
@@ -4865,7 +4924,7 @@ void brcmf_cfg80211_detach(struct brcmf_cfg80211_info *cfg) | |||
4865 | wl_deinit_priv(cfg); | 4924 | wl_deinit_priv(cfg); |
4866 | brcmf_btcoex_detach(cfg); | 4925 | brcmf_btcoex_detach(cfg); |
4867 | list_for_each_entry_safe(vif, tmp, &cfg->vif_list, list) { | 4926 | list_for_each_entry_safe(vif, tmp, &cfg->vif_list, list) { |
4868 | brcmf_free_vif(vif); | 4927 | brcmf_free_vif(cfg, vif); |
4869 | } | 4928 | } |
4870 | } | 4929 | } |
4871 | 4930 | ||
@@ -5229,6 +5288,8 @@ static s32 brcmf_config_dongle(struct brcmf_cfg80211_info *cfg) | |||
5229 | if (err) | 5288 | if (err) |
5230 | goto default_conf_out; | 5289 | goto default_conf_out; |
5231 | 5290 | ||
5291 | brcmf_configure_arp_offload(ifp, true); | ||
5292 | |||
5232 | cfg->dongle_up = true; | 5293 | cfg->dongle_up = true; |
5233 | default_conf_out: | 5294 | default_conf_out: |
5234 | 5295 | ||
diff --git a/drivers/net/wireless/brcm80211/brcmfmac/wl_cfg80211.h b/drivers/net/wireless/brcm80211/brcmfmac/wl_cfg80211.h index a71cff84cdcf..d9bdaf9a72d0 100644 --- a/drivers/net/wireless/brcm80211/brcmfmac/wl_cfg80211.h +++ b/drivers/net/wireless/brcm80211/brcmfmac/wl_cfg80211.h | |||
@@ -487,7 +487,8 @@ enum nl80211_iftype brcmf_cfg80211_get_iftype(struct brcmf_if *ifp); | |||
487 | struct brcmf_cfg80211_vif *brcmf_alloc_vif(struct brcmf_cfg80211_info *cfg, | 487 | struct brcmf_cfg80211_vif *brcmf_alloc_vif(struct brcmf_cfg80211_info *cfg, |
488 | enum nl80211_iftype type, | 488 | enum nl80211_iftype type, |
489 | bool pm_block); | 489 | bool pm_block); |
490 | void brcmf_free_vif(struct brcmf_cfg80211_vif *vif); | 490 | void brcmf_free_vif(struct brcmf_cfg80211_info *cfg, |
491 | struct brcmf_cfg80211_vif *vif); | ||
491 | 492 | ||
492 | s32 brcmf_vif_set_mgmt_ie(struct brcmf_cfg80211_vif *vif, s32 pktflag, | 493 | s32 brcmf_vif_set_mgmt_ie(struct brcmf_cfg80211_vif *vif, s32 pktflag, |
493 | const u8 *vndr_ie_buf, u32 vndr_ie_len); | 494 | const u8 *vndr_ie_buf, u32 vndr_ie_len); |
diff --git a/drivers/net/wireless/brcm80211/brcmsmac/main.c b/drivers/net/wireless/brcm80211/brcmsmac/main.c index 28e7aeedd184..9fd6f2fef11b 100644 --- a/drivers/net/wireless/brcm80211/brcmsmac/main.c +++ b/drivers/net/wireless/brcm80211/brcmsmac/main.c | |||
@@ -3074,21 +3074,8 @@ static void brcms_b_antsel_set(struct brcms_hardware *wlc_hw, u32 antsel_avail) | |||
3074 | */ | 3074 | */ |
3075 | static bool brcms_c_ps_allowed(struct brcms_c_info *wlc) | 3075 | static bool brcms_c_ps_allowed(struct brcms_c_info *wlc) |
3076 | { | 3076 | { |
3077 | /* disallow PS when one of the following global conditions meets */ | 3077 | /* not supporting PS so always return false for now */ |
3078 | if (!wlc->pub->associated) | 3078 | return false; |
3079 | return false; | ||
3080 | |||
3081 | /* disallow PS when one of these meets when not scanning */ | ||
3082 | if (wlc->filter_flags & FIF_PROMISC_IN_BSS) | ||
3083 | return false; | ||
3084 | |||
3085 | if (wlc->bsscfg->type == BRCMS_TYPE_AP) | ||
3086 | return false; | ||
3087 | |||
3088 | if (wlc->bsscfg->type == BRCMS_TYPE_ADHOC) | ||
3089 | return false; | ||
3090 | |||
3091 | return true; | ||
3092 | } | 3079 | } |
3093 | 3080 | ||
3094 | static void brcms_c_statsupd(struct brcms_c_info *wlc) | 3081 | static void brcms_c_statsupd(struct brcms_c_info *wlc) |
diff --git a/drivers/net/wireless/iwlegacy/3945-rs.c b/drivers/net/wireless/iwlegacy/3945-rs.c index c9f197d9ca1e..fe31590a51b2 100644 --- a/drivers/net/wireless/iwlegacy/3945-rs.c +++ b/drivers/net/wireless/iwlegacy/3945-rs.c | |||
@@ -816,6 +816,7 @@ out: | |||
816 | rs_sta->last_txrate_idx = idx; | 816 | rs_sta->last_txrate_idx = idx; |
817 | info->control.rates[0].idx = rs_sta->last_txrate_idx; | 817 | info->control.rates[0].idx = rs_sta->last_txrate_idx; |
818 | } | 818 | } |
819 | info->control.rates[0].count = 1; | ||
819 | 820 | ||
820 | D_RATE("leave: %d\n", idx); | 821 | D_RATE("leave: %d\n", idx); |
821 | } | 822 | } |
diff --git a/drivers/net/wireless/iwlegacy/4965-rs.c b/drivers/net/wireless/iwlegacy/4965-rs.c index 1fc0b227e120..ed3c42a63a43 100644 --- a/drivers/net/wireless/iwlegacy/4965-rs.c +++ b/drivers/net/wireless/iwlegacy/4965-rs.c | |||
@@ -2268,7 +2268,7 @@ il4965_rs_get_rate(void *il_r, struct ieee80211_sta *sta, void *il_sta, | |||
2268 | info->control.rates[0].flags = 0; | 2268 | info->control.rates[0].flags = 0; |
2269 | } | 2269 | } |
2270 | info->control.rates[0].idx = rate_idx; | 2270 | info->control.rates[0].idx = rate_idx; |
2271 | 2271 | info->control.rates[0].count = 1; | |
2272 | } | 2272 | } |
2273 | 2273 | ||
2274 | static void * | 2274 | static void * |
diff --git a/drivers/net/wireless/iwlegacy/common.h b/drivers/net/wireless/iwlegacy/common.h index f8246f2d88f9..4caaf52986a4 100644 --- a/drivers/net/wireless/iwlegacy/common.h +++ b/drivers/net/wireless/iwlegacy/common.h | |||
@@ -1832,16 +1832,16 @@ u32 il_usecs_to_beacons(struct il_priv *il, u32 usec, u32 beacon_interval); | |||
1832 | __le32 il_add_beacon_time(struct il_priv *il, u32 base, u32 addon, | 1832 | __le32 il_add_beacon_time(struct il_priv *il, u32 base, u32 addon, |
1833 | u32 beacon_interval); | 1833 | u32 beacon_interval); |
1834 | 1834 | ||
1835 | #ifdef CONFIG_PM | 1835 | #ifdef CONFIG_PM_SLEEP |
1836 | extern const struct dev_pm_ops il_pm_ops; | 1836 | extern const struct dev_pm_ops il_pm_ops; |
1837 | 1837 | ||
1838 | #define IL_LEGACY_PM_OPS (&il_pm_ops) | 1838 | #define IL_LEGACY_PM_OPS (&il_pm_ops) |
1839 | 1839 | ||
1840 | #else /* !CONFIG_PM */ | 1840 | #else /* !CONFIG_PM_SLEEP */ |
1841 | 1841 | ||
1842 | #define IL_LEGACY_PM_OPS NULL | 1842 | #define IL_LEGACY_PM_OPS NULL |
1843 | 1843 | ||
1844 | #endif /* !CONFIG_PM */ | 1844 | #endif /* !CONFIG_PM_SLEEP */ |
1845 | 1845 | ||
1846 | /***************************************************** | 1846 | /***************************************************** |
1847 | * Error Handling Debugging | 1847 | * Error Handling Debugging |
diff --git a/drivers/net/wireless/iwlwifi/dvm/rs.c b/drivers/net/wireless/iwlwifi/dvm/rs.c index 907bd6e50aad..10fbb176cc8e 100644 --- a/drivers/net/wireless/iwlwifi/dvm/rs.c +++ b/drivers/net/wireless/iwlwifi/dvm/rs.c | |||
@@ -2799,7 +2799,7 @@ static void rs_get_rate(void *priv_r, struct ieee80211_sta *sta, void *priv_sta, | |||
2799 | info->control.rates[0].flags = 0; | 2799 | info->control.rates[0].flags = 0; |
2800 | } | 2800 | } |
2801 | info->control.rates[0].idx = rate_idx; | 2801 | info->control.rates[0].idx = rate_idx; |
2802 | 2802 | info->control.rates[0].count = 1; | |
2803 | } | 2803 | } |
2804 | 2804 | ||
2805 | static void *rs_alloc_sta(void *priv_rate, struct ieee80211_sta *sta, | 2805 | static void *rs_alloc_sta(void *priv_rate, struct ieee80211_sta *sta, |
diff --git a/drivers/net/wireless/iwlwifi/dvm/rxon.c b/drivers/net/wireless/iwlwifi/dvm/rxon.c index 707446fa00bd..cd1ad0019185 100644 --- a/drivers/net/wireless/iwlwifi/dvm/rxon.c +++ b/drivers/net/wireless/iwlwifi/dvm/rxon.c | |||
@@ -1378,7 +1378,7 @@ static void iwlagn_chain_noise_reset(struct iwl_priv *priv) | |||
1378 | struct iwl_chain_noise_data *data = &priv->chain_noise_data; | 1378 | struct iwl_chain_noise_data *data = &priv->chain_noise_data; |
1379 | int ret; | 1379 | int ret; |
1380 | 1380 | ||
1381 | if (!(priv->calib_disabled & IWL_CHAIN_NOISE_CALIB_DISABLED)) | 1381 | if (priv->calib_disabled & IWL_CHAIN_NOISE_CALIB_DISABLED) |
1382 | return; | 1382 | return; |
1383 | 1383 | ||
1384 | if ((data->state == IWL_CHAIN_NOISE_ALIVE) && | 1384 | if ((data->state == IWL_CHAIN_NOISE_ALIVE) && |
diff --git a/drivers/net/wireless/iwlwifi/dvm/sta.c b/drivers/net/wireless/iwlwifi/dvm/sta.c index db183b44e038..c3c13ce96eb0 100644 --- a/drivers/net/wireless/iwlwifi/dvm/sta.c +++ b/drivers/net/wireless/iwlwifi/dvm/sta.c | |||
@@ -735,7 +735,7 @@ void iwl_restore_stations(struct iwl_priv *priv, struct iwl_rxon_context *ctx) | |||
735 | memcpy(&lq, priv->stations[i].lq, | 735 | memcpy(&lq, priv->stations[i].lq, |
736 | sizeof(struct iwl_link_quality_cmd)); | 736 | sizeof(struct iwl_link_quality_cmd)); |
737 | 737 | ||
738 | if (!memcmp(&lq, &zero_lq, sizeof(lq))) | 738 | if (memcmp(&lq, &zero_lq, sizeof(lq))) |
739 | send_lq = true; | 739 | send_lq = true; |
740 | } | 740 | } |
741 | spin_unlock_bh(&priv->sta_lock); | 741 | spin_unlock_bh(&priv->sta_lock); |
diff --git a/drivers/net/wireless/iwlwifi/iwl-drv.c b/drivers/net/wireless/iwlwifi/iwl-drv.c index 39aad9893e0b..40fed1f511e2 100644 --- a/drivers/net/wireless/iwlwifi/iwl-drv.c +++ b/drivers/net/wireless/iwlwifi/iwl-drv.c | |||
@@ -1000,10 +1000,12 @@ static void iwl_req_fw_callback(const struct firmware *ucode_raw, void *context) | |||
1000 | */ | 1000 | */ |
1001 | if (load_module) { | 1001 | if (load_module) { |
1002 | err = request_module("%s", op->name); | 1002 | err = request_module("%s", op->name); |
1003 | #ifdef CONFIG_IWLWIFI_OPMODE_MODULAR | ||
1003 | if (err) | 1004 | if (err) |
1004 | IWL_ERR(drv, | 1005 | IWL_ERR(drv, |
1005 | "failed to load module %s (error %d), is dynamic loading enabled?\n", | 1006 | "failed to load module %s (error %d), is dynamic loading enabled?\n", |
1006 | op->name, err); | 1007 | op->name, err); |
1008 | #endif | ||
1007 | } | 1009 | } |
1008 | return; | 1010 | return; |
1009 | 1011 | ||
diff --git a/drivers/net/wireless/iwlwifi/mvm/rs.c b/drivers/net/wireless/iwlwifi/mvm/rs.c index 55334d542e26..b99fe3163866 100644 --- a/drivers/net/wireless/iwlwifi/mvm/rs.c +++ b/drivers/net/wireless/iwlwifi/mvm/rs.c | |||
@@ -2546,6 +2546,7 @@ static void rs_get_rate(void *mvm_r, struct ieee80211_sta *sta, void *mvm_sta, | |||
2546 | info->control.rates[0].flags = 0; | 2546 | info->control.rates[0].flags = 0; |
2547 | } | 2547 | } |
2548 | info->control.rates[0].idx = rate_idx; | 2548 | info->control.rates[0].idx = rate_idx; |
2549 | info->control.rates[0].count = 1; | ||
2549 | } | 2550 | } |
2550 | 2551 | ||
2551 | static void *rs_alloc_sta(void *mvm_rate, struct ieee80211_sta *sta, | 2552 | static void *rs_alloc_sta(void *mvm_rate, struct ieee80211_sta *sta, |
diff --git a/drivers/net/wireless/iwlwifi/mvm/tx.c b/drivers/net/wireless/iwlwifi/mvm/tx.c index f212f16502ff..48c1891e3df6 100644 --- a/drivers/net/wireless/iwlwifi/mvm/tx.c +++ b/drivers/net/wireless/iwlwifi/mvm/tx.c | |||
@@ -180,7 +180,8 @@ static void iwl_mvm_set_tx_cmd_rate(struct iwl_mvm *mvm, | |||
180 | tx_cmd->tx_flags |= cpu_to_le32(TX_CMD_FLG_STA_RATE); | 180 | tx_cmd->tx_flags |= cpu_to_le32(TX_CMD_FLG_STA_RATE); |
181 | return; | 181 | return; |
182 | } else if (ieee80211_is_back_req(fc)) { | 182 | } else if (ieee80211_is_back_req(fc)) { |
183 | tx_cmd->tx_flags |= cpu_to_le32(TX_CMD_FLG_STA_RATE); | 183 | tx_cmd->tx_flags |= |
184 | cpu_to_le32(TX_CMD_FLG_ACK | TX_CMD_FLG_BAR); | ||
184 | } | 185 | } |
185 | 186 | ||
186 | /* HT rate doesn't make sense for a non data frame */ | 187 | /* HT rate doesn't make sense for a non data frame */ |
diff --git a/drivers/net/wireless/mwifiex/debugfs.c b/drivers/net/wireless/mwifiex/debugfs.c index 753b5682d53f..a5f9875cfd6e 100644 --- a/drivers/net/wireless/mwifiex/debugfs.c +++ b/drivers/net/wireless/mwifiex/debugfs.c | |||
@@ -26,10 +26,17 @@ | |||
26 | static struct dentry *mwifiex_dfs_dir; | 26 | static struct dentry *mwifiex_dfs_dir; |
27 | 27 | ||
28 | static char *bss_modes[] = { | 28 | static char *bss_modes[] = { |
29 | "Unknown", | 29 | "UNSPECIFIED", |
30 | "Ad-hoc", | 30 | "ADHOC", |
31 | "Managed", | 31 | "STATION", |
32 | "Auto" | 32 | "AP", |
33 | "AP_VLAN", | ||
34 | "WDS", | ||
35 | "MONITOR", | ||
36 | "MESH_POINT", | ||
37 | "P2P_CLIENT", | ||
38 | "P2P_GO", | ||
39 | "P2P_DEVICE", | ||
33 | }; | 40 | }; |
34 | 41 | ||
35 | /* size/addr for mwifiex_debug_info */ | 42 | /* size/addr for mwifiex_debug_info */ |
@@ -200,7 +207,12 @@ mwifiex_info_read(struct file *file, char __user *ubuf, | |||
200 | p += sprintf(p, "driver_version = %s", fmt); | 207 | p += sprintf(p, "driver_version = %s", fmt); |
201 | p += sprintf(p, "\nverext = %s", priv->version_str); | 208 | p += sprintf(p, "\nverext = %s", priv->version_str); |
202 | p += sprintf(p, "\ninterface_name=\"%s\"\n", netdev->name); | 209 | p += sprintf(p, "\ninterface_name=\"%s\"\n", netdev->name); |
203 | p += sprintf(p, "bss_mode=\"%s\"\n", bss_modes[info.bss_mode]); | 210 | |
211 | if (info.bss_mode >= ARRAY_SIZE(bss_modes)) | ||
212 | p += sprintf(p, "bss_mode=\"%d\"\n", info.bss_mode); | ||
213 | else | ||
214 | p += sprintf(p, "bss_mode=\"%s\"\n", bss_modes[info.bss_mode]); | ||
215 | |||
204 | p += sprintf(p, "media_state=\"%s\"\n", | 216 | p += sprintf(p, "media_state=\"%s\"\n", |
205 | (!priv->media_connected ? "Disconnected" : "Connected")); | 217 | (!priv->media_connected ? "Disconnected" : "Connected")); |
206 | p += sprintf(p, "mac_address=\"%pM\"\n", netdev->dev_addr); | 218 | p += sprintf(p, "mac_address=\"%pM\"\n", netdev->dev_addr); |
diff --git a/drivers/net/wireless/rt2x00/rt2800lib.c b/drivers/net/wireless/rt2x00/rt2800lib.c index b52d70c75e1a..72f32e5caa4d 100644 --- a/drivers/net/wireless/rt2x00/rt2800lib.c +++ b/drivers/net/wireless/rt2x00/rt2800lib.c | |||
@@ -3027,19 +3027,26 @@ static void rt2800_config_txpower(struct rt2x00_dev *rt2x00dev, | |||
3027 | * TODO: we do not use +6 dBm option to do not increase power beyond | 3027 | * TODO: we do not use +6 dBm option to do not increase power beyond |
3028 | * regulatory limit, however this could be utilized for devices with | 3028 | * regulatory limit, however this could be utilized for devices with |
3029 | * CAPABILITY_POWER_LIMIT. | 3029 | * CAPABILITY_POWER_LIMIT. |
3030 | * | ||
3031 | * TODO: add different temperature compensation code for RT3290 & RT5390 | ||
3032 | * to allow to use BBP_R1 for those chips. | ||
3030 | */ | 3033 | */ |
3031 | rt2800_bbp_read(rt2x00dev, 1, &r1); | 3034 | if (!rt2x00_rt(rt2x00dev, RT3290) && |
3032 | if (delta <= -12) { | 3035 | !rt2x00_rt(rt2x00dev, RT5390)) { |
3033 | power_ctrl = 2; | 3036 | rt2800_bbp_read(rt2x00dev, 1, &r1); |
3034 | delta += 12; | 3037 | if (delta <= -12) { |
3035 | } else if (delta <= -6) { | 3038 | power_ctrl = 2; |
3036 | power_ctrl = 1; | 3039 | delta += 12; |
3037 | delta += 6; | 3040 | } else if (delta <= -6) { |
3038 | } else { | 3041 | power_ctrl = 1; |
3039 | power_ctrl = 0; | 3042 | delta += 6; |
3043 | } else { | ||
3044 | power_ctrl = 0; | ||
3045 | } | ||
3046 | rt2x00_set_field8(&r1, BBP1_TX_POWER_CTRL, power_ctrl); | ||
3047 | rt2800_bbp_write(rt2x00dev, 1, r1); | ||
3040 | } | 3048 | } |
3041 | rt2x00_set_field8(&r1, BBP1_TX_POWER_CTRL, power_ctrl); | 3049 | |
3042 | rt2800_bbp_write(rt2x00dev, 1, r1); | ||
3043 | offset = TX_PWR_CFG_0; | 3050 | offset = TX_PWR_CFG_0; |
3044 | 3051 | ||
3045 | for (i = 0; i < EEPROM_TXPOWER_BYRATE_SIZE; i += 2) { | 3052 | for (i = 0; i < EEPROM_TXPOWER_BYRATE_SIZE; i += 2) { |
diff --git a/drivers/net/wireless/rtlwifi/pci.c b/drivers/net/wireless/rtlwifi/pci.c index 999ffc12578b..c97e9d327331 100644 --- a/drivers/net/wireless/rtlwifi/pci.c +++ b/drivers/net/wireless/rtlwifi/pci.c | |||
@@ -764,6 +764,7 @@ static void _rtl_pci_rx_interrupt(struct ieee80211_hw *hw) | |||
764 | "can't alloc skb for rx\n"); | 764 | "can't alloc skb for rx\n"); |
765 | goto done; | 765 | goto done; |
766 | } | 766 | } |
767 | kmemleak_not_leak(new_skb); | ||
767 | 768 | ||
768 | pci_unmap_single(rtlpci->pdev, | 769 | pci_unmap_single(rtlpci->pdev, |
769 | *((dma_addr_t *) skb->cb), | 770 | *((dma_addr_t *) skb->cb), |
diff --git a/drivers/net/wireless/rtlwifi/rtl8192cu/hw.c b/drivers/net/wireless/rtlwifi/rtl8192cu/hw.c index 3d0498e69c8c..189ba124a8c6 100644 --- a/drivers/net/wireless/rtlwifi/rtl8192cu/hw.c +++ b/drivers/net/wireless/rtlwifi/rtl8192cu/hw.c | |||
@@ -1973,26 +1973,35 @@ void rtl92cu_set_hw_reg(struct ieee80211_hw *hw, u8 variable, u8 *val) | |||
1973 | } | 1973 | } |
1974 | } | 1974 | } |
1975 | 1975 | ||
1976 | void rtl92cu_update_hal_rate_table(struct ieee80211_hw *hw, | 1976 | static void rtl92cu_update_hal_rate_table(struct ieee80211_hw *hw, |
1977 | struct ieee80211_sta *sta, | 1977 | struct ieee80211_sta *sta) |
1978 | u8 rssi_level) | ||
1979 | { | 1978 | { |
1980 | struct rtl_priv *rtlpriv = rtl_priv(hw); | 1979 | struct rtl_priv *rtlpriv = rtl_priv(hw); |
1981 | struct rtl_phy *rtlphy = &(rtlpriv->phy); | 1980 | struct rtl_phy *rtlphy = &(rtlpriv->phy); |
1982 | struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); | 1981 | struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); |
1983 | u32 ratr_value = (u32) mac->basic_rates; | 1982 | struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); |
1984 | u8 *mcsrate = mac->mcs; | 1983 | u32 ratr_value; |
1985 | u8 ratr_index = 0; | 1984 | u8 ratr_index = 0; |
1986 | u8 nmode = mac->ht_enable; | 1985 | u8 nmode = mac->ht_enable; |
1987 | u8 mimo_ps = 1; | 1986 | u8 mimo_ps = IEEE80211_SMPS_OFF; |
1988 | u16 shortgi_rate = 0; | 1987 | u16 shortgi_rate; |
1989 | u32 tmp_ratr_value = 0; | 1988 | u32 tmp_ratr_value; |
1990 | u8 curtxbw_40mhz = mac->bw_40; | 1989 | u8 curtxbw_40mhz = mac->bw_40; |
1991 | u8 curshortgi_40mhz = mac->sgi_40; | 1990 | u8 curshortgi_40mhz = (sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_40) ? |
1992 | u8 curshortgi_20mhz = mac->sgi_20; | 1991 | 1 : 0; |
1992 | u8 curshortgi_20mhz = (sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_20) ? | ||
1993 | 1 : 0; | ||
1993 | enum wireless_mode wirelessmode = mac->mode; | 1994 | enum wireless_mode wirelessmode = mac->mode; |
1994 | 1995 | ||
1995 | ratr_value |= ((*(u16 *) (mcsrate))) << 12; | 1996 | if (rtlhal->current_bandtype == BAND_ON_5G) |
1997 | ratr_value = sta->supp_rates[1] << 4; | ||
1998 | else | ||
1999 | ratr_value = sta->supp_rates[0]; | ||
2000 | if (mac->opmode == NL80211_IFTYPE_ADHOC) | ||
2001 | ratr_value = 0xfff; | ||
2002 | |||
2003 | ratr_value |= (sta->ht_cap.mcs.rx_mask[1] << 20 | | ||
2004 | sta->ht_cap.mcs.rx_mask[0] << 12); | ||
1996 | switch (wirelessmode) { | 2005 | switch (wirelessmode) { |
1997 | case WIRELESS_MODE_B: | 2006 | case WIRELESS_MODE_B: |
1998 | if (ratr_value & 0x0000000c) | 2007 | if (ratr_value & 0x0000000c) |
@@ -2006,7 +2015,7 @@ void rtl92cu_update_hal_rate_table(struct ieee80211_hw *hw, | |||
2006 | case WIRELESS_MODE_N_24G: | 2015 | case WIRELESS_MODE_N_24G: |
2007 | case WIRELESS_MODE_N_5G: | 2016 | case WIRELESS_MODE_N_5G: |
2008 | nmode = 1; | 2017 | nmode = 1; |
2009 | if (mimo_ps == 0) { | 2018 | if (mimo_ps == IEEE80211_SMPS_STATIC) { |
2010 | ratr_value &= 0x0007F005; | 2019 | ratr_value &= 0x0007F005; |
2011 | } else { | 2020 | } else { |
2012 | u32 ratr_mask; | 2021 | u32 ratr_mask; |
@@ -2016,8 +2025,7 @@ void rtl92cu_update_hal_rate_table(struct ieee80211_hw *hw, | |||
2016 | ratr_mask = 0x000ff005; | 2025 | ratr_mask = 0x000ff005; |
2017 | else | 2026 | else |
2018 | ratr_mask = 0x0f0ff005; | 2027 | ratr_mask = 0x0f0ff005; |
2019 | if (curtxbw_40mhz) | 2028 | |
2020 | ratr_mask |= 0x00000010; | ||
2021 | ratr_value &= ratr_mask; | 2029 | ratr_value &= ratr_mask; |
2022 | } | 2030 | } |
2023 | break; | 2031 | break; |
@@ -2026,41 +2034,74 @@ void rtl92cu_update_hal_rate_table(struct ieee80211_hw *hw, | |||
2026 | ratr_value &= 0x000ff0ff; | 2034 | ratr_value &= 0x000ff0ff; |
2027 | else | 2035 | else |
2028 | ratr_value &= 0x0f0ff0ff; | 2036 | ratr_value &= 0x0f0ff0ff; |
2037 | |||
2029 | break; | 2038 | break; |
2030 | } | 2039 | } |
2040 | |||
2031 | ratr_value &= 0x0FFFFFFF; | 2041 | ratr_value &= 0x0FFFFFFF; |
2032 | if (nmode && ((curtxbw_40mhz && curshortgi_40mhz) || | 2042 | |
2033 | (!curtxbw_40mhz && curshortgi_20mhz))) { | 2043 | if (nmode && ((curtxbw_40mhz && |
2044 | curshortgi_40mhz) || (!curtxbw_40mhz && | ||
2045 | curshortgi_20mhz))) { | ||
2046 | |||
2034 | ratr_value |= 0x10000000; | 2047 | ratr_value |= 0x10000000; |
2035 | tmp_ratr_value = (ratr_value >> 12); | 2048 | tmp_ratr_value = (ratr_value >> 12); |
2049 | |||
2036 | for (shortgi_rate = 15; shortgi_rate > 0; shortgi_rate--) { | 2050 | for (shortgi_rate = 15; shortgi_rate > 0; shortgi_rate--) { |
2037 | if ((1 << shortgi_rate) & tmp_ratr_value) | 2051 | if ((1 << shortgi_rate) & tmp_ratr_value) |
2038 | break; | 2052 | break; |
2039 | } | 2053 | } |
2054 | |||
2040 | shortgi_rate = (shortgi_rate << 12) | (shortgi_rate << 8) | | 2055 | shortgi_rate = (shortgi_rate << 12) | (shortgi_rate << 8) | |
2041 | (shortgi_rate << 4) | (shortgi_rate); | 2056 | (shortgi_rate << 4) | (shortgi_rate); |
2042 | } | 2057 | } |
2058 | |||
2043 | rtl_write_dword(rtlpriv, REG_ARFR0 + ratr_index * 4, ratr_value); | 2059 | rtl_write_dword(rtlpriv, REG_ARFR0 + ratr_index * 4, ratr_value); |
2060 | |||
2061 | RT_TRACE(rtlpriv, COMP_RATR, DBG_DMESG, "%x\n", | ||
2062 | rtl_read_dword(rtlpriv, REG_ARFR0)); | ||
2044 | } | 2063 | } |
2045 | 2064 | ||
2046 | void rtl92cu_update_hal_rate_mask(struct ieee80211_hw *hw, u8 rssi_level) | 2065 | static void rtl92cu_update_hal_rate_mask(struct ieee80211_hw *hw, |
2066 | struct ieee80211_sta *sta, | ||
2067 | u8 rssi_level) | ||
2047 | { | 2068 | { |
2048 | struct rtl_priv *rtlpriv = rtl_priv(hw); | 2069 | struct rtl_priv *rtlpriv = rtl_priv(hw); |
2049 | struct rtl_phy *rtlphy = &(rtlpriv->phy); | 2070 | struct rtl_phy *rtlphy = &(rtlpriv->phy); |
2050 | struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); | 2071 | struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); |
2051 | u32 ratr_bitmap = (u32) mac->basic_rates; | 2072 | struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); |
2052 | u8 *p_mcsrate = mac->mcs; | 2073 | struct rtl_sta_info *sta_entry = NULL; |
2053 | u8 ratr_index = 0; | 2074 | u32 ratr_bitmap; |
2054 | u8 curtxbw_40mhz = mac->bw_40; | 2075 | u8 ratr_index; |
2055 | u8 curshortgi_40mhz = mac->sgi_40; | 2076 | u8 curtxbw_40mhz = (sta->bandwidth >= IEEE80211_STA_RX_BW_40) ? 1 : 0; |
2056 | u8 curshortgi_20mhz = mac->sgi_20; | 2077 | u8 curshortgi_40mhz = curtxbw_40mhz && |
2057 | enum wireless_mode wirelessmode = mac->mode; | 2078 | (sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_40) ? |
2079 | 1 : 0; | ||
2080 | u8 curshortgi_20mhz = (sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_20) ? | ||
2081 | 1 : 0; | ||
2082 | enum wireless_mode wirelessmode = 0; | ||
2058 | bool shortgi = false; | 2083 | bool shortgi = false; |
2059 | u8 rate_mask[5]; | 2084 | u8 rate_mask[5]; |
2060 | u8 macid = 0; | 2085 | u8 macid = 0; |
2061 | u8 mimops = 1; | 2086 | u8 mimo_ps = IEEE80211_SMPS_OFF; |
2062 | 2087 | ||
2063 | ratr_bitmap |= (p_mcsrate[1] << 20) | (p_mcsrate[0] << 12); | 2088 | sta_entry = (struct rtl_sta_info *) sta->drv_priv; |
2089 | wirelessmode = sta_entry->wireless_mode; | ||
2090 | if (mac->opmode == NL80211_IFTYPE_STATION || | ||
2091 | mac->opmode == NL80211_IFTYPE_MESH_POINT) | ||
2092 | curtxbw_40mhz = mac->bw_40; | ||
2093 | else if (mac->opmode == NL80211_IFTYPE_AP || | ||
2094 | mac->opmode == NL80211_IFTYPE_ADHOC) | ||
2095 | macid = sta->aid + 1; | ||
2096 | |||
2097 | if (rtlhal->current_bandtype == BAND_ON_5G) | ||
2098 | ratr_bitmap = sta->supp_rates[1] << 4; | ||
2099 | else | ||
2100 | ratr_bitmap = sta->supp_rates[0]; | ||
2101 | if (mac->opmode == NL80211_IFTYPE_ADHOC) | ||
2102 | ratr_bitmap = 0xfff; | ||
2103 | ratr_bitmap |= (sta->ht_cap.mcs.rx_mask[1] << 20 | | ||
2104 | sta->ht_cap.mcs.rx_mask[0] << 12); | ||
2064 | switch (wirelessmode) { | 2105 | switch (wirelessmode) { |
2065 | case WIRELESS_MODE_B: | 2106 | case WIRELESS_MODE_B: |
2066 | ratr_index = RATR_INX_WIRELESS_B; | 2107 | ratr_index = RATR_INX_WIRELESS_B; |
@@ -2071,6 +2112,7 @@ void rtl92cu_update_hal_rate_mask(struct ieee80211_hw *hw, u8 rssi_level) | |||
2071 | break; | 2112 | break; |
2072 | case WIRELESS_MODE_G: | 2113 | case WIRELESS_MODE_G: |
2073 | ratr_index = RATR_INX_WIRELESS_GB; | 2114 | ratr_index = RATR_INX_WIRELESS_GB; |
2115 | |||
2074 | if (rssi_level == 1) | 2116 | if (rssi_level == 1) |
2075 | ratr_bitmap &= 0x00000f00; | 2117 | ratr_bitmap &= 0x00000f00; |
2076 | else if (rssi_level == 2) | 2118 | else if (rssi_level == 2) |
@@ -2085,7 +2127,8 @@ void rtl92cu_update_hal_rate_mask(struct ieee80211_hw *hw, u8 rssi_level) | |||
2085 | case WIRELESS_MODE_N_24G: | 2127 | case WIRELESS_MODE_N_24G: |
2086 | case WIRELESS_MODE_N_5G: | 2128 | case WIRELESS_MODE_N_5G: |
2087 | ratr_index = RATR_INX_WIRELESS_NGB; | 2129 | ratr_index = RATR_INX_WIRELESS_NGB; |
2088 | if (mimops == 0) { | 2130 | |
2131 | if (mimo_ps == IEEE80211_SMPS_STATIC) { | ||
2089 | if (rssi_level == 1) | 2132 | if (rssi_level == 1) |
2090 | ratr_bitmap &= 0x00070000; | 2133 | ratr_bitmap &= 0x00070000; |
2091 | else if (rssi_level == 2) | 2134 | else if (rssi_level == 2) |
@@ -2128,8 +2171,10 @@ void rtl92cu_update_hal_rate_mask(struct ieee80211_hw *hw, u8 rssi_level) | |||
2128 | } | 2171 | } |
2129 | } | 2172 | } |
2130 | } | 2173 | } |
2174 | |||
2131 | if ((curtxbw_40mhz && curshortgi_40mhz) || | 2175 | if ((curtxbw_40mhz && curshortgi_40mhz) || |
2132 | (!curtxbw_40mhz && curshortgi_20mhz)) { | 2176 | (!curtxbw_40mhz && curshortgi_20mhz)) { |
2177 | |||
2133 | if (macid == 0) | 2178 | if (macid == 0) |
2134 | shortgi = true; | 2179 | shortgi = true; |
2135 | else if (macid == 1) | 2180 | else if (macid == 1) |
@@ -2138,21 +2183,42 @@ void rtl92cu_update_hal_rate_mask(struct ieee80211_hw *hw, u8 rssi_level) | |||
2138 | break; | 2183 | break; |
2139 | default: | 2184 | default: |
2140 | ratr_index = RATR_INX_WIRELESS_NGB; | 2185 | ratr_index = RATR_INX_WIRELESS_NGB; |
2186 | |||
2141 | if (rtlphy->rf_type == RF_1T2R) | 2187 | if (rtlphy->rf_type == RF_1T2R) |
2142 | ratr_bitmap &= 0x000ff0ff; | 2188 | ratr_bitmap &= 0x000ff0ff; |
2143 | else | 2189 | else |
2144 | ratr_bitmap &= 0x0f0ff0ff; | 2190 | ratr_bitmap &= 0x0f0ff0ff; |
2145 | break; | 2191 | break; |
2146 | } | 2192 | } |
2147 | RT_TRACE(rtlpriv, COMP_RATR, DBG_DMESG, "ratr_bitmap :%x\n", | 2193 | sta_entry->ratr_index = ratr_index; |
2148 | ratr_bitmap); | 2194 | |
2149 | *(u32 *)&rate_mask = ((ratr_bitmap & 0x0fffffff) | | 2195 | RT_TRACE(rtlpriv, COMP_RATR, DBG_DMESG, |
2150 | ratr_index << 28); | 2196 | "ratr_bitmap :%x\n", ratr_bitmap); |
2197 | *(u32 *)&rate_mask = (ratr_bitmap & 0x0fffffff) | | ||
2198 | (ratr_index << 28); | ||
2151 | rate_mask[4] = macid | (shortgi ? 0x20 : 0x00) | 0x80; | 2199 | rate_mask[4] = macid | (shortgi ? 0x20 : 0x00) | 0x80; |
2152 | RT_TRACE(rtlpriv, COMP_RATR, DBG_DMESG, | 2200 | RT_TRACE(rtlpriv, COMP_RATR, DBG_DMESG, |
2153 | "Rate_index:%x, ratr_val:%x, %5phC\n", | 2201 | "Rate_index:%x, ratr_val:%x, %5phC\n", |
2154 | ratr_index, ratr_bitmap, rate_mask); | 2202 | ratr_index, ratr_bitmap, rate_mask); |
2155 | rtl92c_fill_h2c_cmd(hw, H2C_RA_MASK, 5, rate_mask); | 2203 | memcpy(rtlpriv->rate_mask, rate_mask, 5); |
2204 | /* rtl92c_fill_h2c_cmd() does USB I/O and will result in a | ||
2205 | * "scheduled while atomic" if called directly */ | ||
2206 | schedule_work(&rtlpriv->works.fill_h2c_cmd); | ||
2207 | |||
2208 | if (macid != 0) | ||
2209 | sta_entry->ratr_index = ratr_index; | ||
2210 | } | ||
2211 | |||
2212 | void rtl92cu_update_hal_rate_tbl(struct ieee80211_hw *hw, | ||
2213 | struct ieee80211_sta *sta, | ||
2214 | u8 rssi_level) | ||
2215 | { | ||
2216 | struct rtl_priv *rtlpriv = rtl_priv(hw); | ||
2217 | |||
2218 | if (rtlpriv->dm.useramask) | ||
2219 | rtl92cu_update_hal_rate_mask(hw, sta, rssi_level); | ||
2220 | else | ||
2221 | rtl92cu_update_hal_rate_table(hw, sta); | ||
2156 | } | 2222 | } |
2157 | 2223 | ||
2158 | void rtl92cu_update_channel_access_setting(struct ieee80211_hw *hw) | 2224 | void rtl92cu_update_channel_access_setting(struct ieee80211_hw *hw) |
diff --git a/drivers/net/wireless/rtlwifi/rtl8192cu/hw.h b/drivers/net/wireless/rtlwifi/rtl8192cu/hw.h index f41a3aa4a26f..8e3ec1e25644 100644 --- a/drivers/net/wireless/rtlwifi/rtl8192cu/hw.h +++ b/drivers/net/wireless/rtlwifi/rtl8192cu/hw.h | |||
@@ -98,10 +98,6 @@ void rtl92cu_update_interrupt_mask(struct ieee80211_hw *hw, | |||
98 | u32 add_msr, u32 rm_msr); | 98 | u32 add_msr, u32 rm_msr); |
99 | void rtl92cu_get_hw_reg(struct ieee80211_hw *hw, u8 variable, u8 *val); | 99 | void rtl92cu_get_hw_reg(struct ieee80211_hw *hw, u8 variable, u8 *val); |
100 | void rtl92cu_set_hw_reg(struct ieee80211_hw *hw, u8 variable, u8 *val); | 100 | void rtl92cu_set_hw_reg(struct ieee80211_hw *hw, u8 variable, u8 *val); |
101 | void rtl92cu_update_hal_rate_table(struct ieee80211_hw *hw, | ||
102 | struct ieee80211_sta *sta, | ||
103 | u8 rssi_level); | ||
104 | void rtl92cu_update_hal_rate_mask(struct ieee80211_hw *hw, u8 rssi_level); | ||
105 | 101 | ||
106 | void rtl92cu_update_channel_access_setting(struct ieee80211_hw *hw); | 102 | void rtl92cu_update_channel_access_setting(struct ieee80211_hw *hw); |
107 | bool rtl92cu_gpio_radio_on_off_checking(struct ieee80211_hw *hw, u8 * valid); | 103 | bool rtl92cu_gpio_radio_on_off_checking(struct ieee80211_hw *hw, u8 * valid); |
diff --git a/drivers/net/wireless/rtlwifi/rtl8192cu/mac.c b/drivers/net/wireless/rtlwifi/rtl8192cu/mac.c index 85b6bdb163c0..da4f587199ee 100644 --- a/drivers/net/wireless/rtlwifi/rtl8192cu/mac.c +++ b/drivers/net/wireless/rtlwifi/rtl8192cu/mac.c | |||
@@ -289,14 +289,30 @@ void rtl92c_set_key(struct ieee80211_hw *hw, u32 key_index, | |||
289 | macaddr = cam_const_broad; | 289 | macaddr = cam_const_broad; |
290 | entry_id = key_index; | 290 | entry_id = key_index; |
291 | } else { | 291 | } else { |
292 | if (mac->opmode == NL80211_IFTYPE_AP || | ||
293 | mac->opmode == NL80211_IFTYPE_MESH_POINT) { | ||
294 | entry_id = rtl_cam_get_free_entry(hw, | ||
295 | p_macaddr); | ||
296 | if (entry_id >= TOTAL_CAM_ENTRY) { | ||
297 | RT_TRACE(rtlpriv, COMP_SEC, | ||
298 | DBG_EMERG, | ||
299 | "Can not find free hw security cam entry\n"); | ||
300 | return; | ||
301 | } | ||
302 | } else { | ||
303 | entry_id = CAM_PAIRWISE_KEY_POSITION; | ||
304 | } | ||
305 | |||
292 | key_index = PAIRWISE_KEYIDX; | 306 | key_index = PAIRWISE_KEYIDX; |
293 | entry_id = CAM_PAIRWISE_KEY_POSITION; | ||
294 | is_pairwise = true; | 307 | is_pairwise = true; |
295 | } | 308 | } |
296 | } | 309 | } |
297 | if (rtlpriv->sec.key_len[key_index] == 0) { | 310 | if (rtlpriv->sec.key_len[key_index] == 0) { |
298 | RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, | 311 | RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, |
299 | "delete one entry\n"); | 312 | "delete one entry\n"); |
313 | if (mac->opmode == NL80211_IFTYPE_AP || | ||
314 | mac->opmode == NL80211_IFTYPE_MESH_POINT) | ||
315 | rtl_cam_del_entry(hw, p_macaddr); | ||
300 | rtl_cam_delete_one_entry(hw, p_macaddr, entry_id); | 316 | rtl_cam_delete_one_entry(hw, p_macaddr, entry_id); |
301 | } else { | 317 | } else { |
302 | RT_TRACE(rtlpriv, COMP_SEC, DBG_LOUD, | 318 | RT_TRACE(rtlpriv, COMP_SEC, DBG_LOUD, |
diff --git a/drivers/net/wireless/rtlwifi/rtl8192cu/sw.c b/drivers/net/wireless/rtlwifi/rtl8192cu/sw.c index 938b1e670b93..826f085c29dd 100644 --- a/drivers/net/wireless/rtlwifi/rtl8192cu/sw.c +++ b/drivers/net/wireless/rtlwifi/rtl8192cu/sw.c | |||
@@ -106,8 +106,7 @@ static struct rtl_hal_ops rtl8192cu_hal_ops = { | |||
106 | .update_interrupt_mask = rtl92cu_update_interrupt_mask, | 106 | .update_interrupt_mask = rtl92cu_update_interrupt_mask, |
107 | .get_hw_reg = rtl92cu_get_hw_reg, | 107 | .get_hw_reg = rtl92cu_get_hw_reg, |
108 | .set_hw_reg = rtl92cu_set_hw_reg, | 108 | .set_hw_reg = rtl92cu_set_hw_reg, |
109 | .update_rate_tbl = rtl92cu_update_hal_rate_table, | 109 | .update_rate_tbl = rtl92cu_update_hal_rate_tbl, |
110 | .update_rate_mask = rtl92cu_update_hal_rate_mask, | ||
111 | .fill_tx_desc = rtl92cu_tx_fill_desc, | 110 | .fill_tx_desc = rtl92cu_tx_fill_desc, |
112 | .fill_fake_txdesc = rtl92cu_fill_fake_txdesc, | 111 | .fill_fake_txdesc = rtl92cu_fill_fake_txdesc, |
113 | .fill_tx_cmddesc = rtl92cu_tx_fill_cmddesc, | 112 | .fill_tx_cmddesc = rtl92cu_tx_fill_cmddesc, |
@@ -137,6 +136,7 @@ static struct rtl_hal_ops rtl8192cu_hal_ops = { | |||
137 | .phy_lc_calibrate = _rtl92cu_phy_lc_calibrate, | 136 | .phy_lc_calibrate = _rtl92cu_phy_lc_calibrate, |
138 | .phy_set_bw_mode_callback = rtl92cu_phy_set_bw_mode_callback, | 137 | .phy_set_bw_mode_callback = rtl92cu_phy_set_bw_mode_callback, |
139 | .dm_dynamic_txpower = rtl92cu_dm_dynamic_txpower, | 138 | .dm_dynamic_txpower = rtl92cu_dm_dynamic_txpower, |
139 | .fill_h2c_cmd = rtl92c_fill_h2c_cmd, | ||
140 | }; | 140 | }; |
141 | 141 | ||
142 | static struct rtl_mod_params rtl92cu_mod_params = { | 142 | static struct rtl_mod_params rtl92cu_mod_params = { |
diff --git a/drivers/net/wireless/rtlwifi/rtl8192cu/sw.h b/drivers/net/wireless/rtlwifi/rtl8192cu/sw.h index a1310abd0d54..262e1e4c6e5b 100644 --- a/drivers/net/wireless/rtlwifi/rtl8192cu/sw.h +++ b/drivers/net/wireless/rtlwifi/rtl8192cu/sw.h | |||
@@ -49,5 +49,8 @@ bool rtl92cu_phy_set_rf_power_state(struct ieee80211_hw *hw, | |||
49 | u32 rtl92cu_phy_query_rf_reg(struct ieee80211_hw *hw, | 49 | u32 rtl92cu_phy_query_rf_reg(struct ieee80211_hw *hw, |
50 | enum radio_path rfpath, u32 regaddr, u32 bitmask); | 50 | enum radio_path rfpath, u32 regaddr, u32 bitmask); |
51 | void rtl92cu_phy_set_bw_mode_callback(struct ieee80211_hw *hw); | 51 | void rtl92cu_phy_set_bw_mode_callback(struct ieee80211_hw *hw); |
52 | void rtl92cu_update_hal_rate_tbl(struct ieee80211_hw *hw, | ||
53 | struct ieee80211_sta *sta, | ||
54 | u8 rssi_level); | ||
52 | 55 | ||
53 | #endif | 56 | #endif |
diff --git a/drivers/net/wireless/rtlwifi/usb.c b/drivers/net/wireless/rtlwifi/usb.c index 76732b0cd221..a3532e077871 100644 --- a/drivers/net/wireless/rtlwifi/usb.c +++ b/drivers/net/wireless/rtlwifi/usb.c | |||
@@ -824,6 +824,7 @@ static void rtl_usb_stop(struct ieee80211_hw *hw) | |||
824 | 824 | ||
825 | /* should after adapter start and interrupt enable. */ | 825 | /* should after adapter start and interrupt enable. */ |
826 | set_hal_stop(rtlhal); | 826 | set_hal_stop(rtlhal); |
827 | cancel_work_sync(&rtlpriv->works.fill_h2c_cmd); | ||
827 | /* Enable software */ | 828 | /* Enable software */ |
828 | SET_USB_STOP(rtlusb); | 829 | SET_USB_STOP(rtlusb); |
829 | rtl_usb_deinit(hw); | 830 | rtl_usb_deinit(hw); |
@@ -1026,6 +1027,16 @@ static bool rtl_usb_tx_chk_waitq_insert(struct ieee80211_hw *hw, | |||
1026 | return false; | 1027 | return false; |
1027 | } | 1028 | } |
1028 | 1029 | ||
1030 | static void rtl_fill_h2c_cmd_work_callback(struct work_struct *work) | ||
1031 | { | ||
1032 | struct rtl_works *rtlworks = | ||
1033 | container_of(work, struct rtl_works, fill_h2c_cmd); | ||
1034 | struct ieee80211_hw *hw = rtlworks->hw; | ||
1035 | struct rtl_priv *rtlpriv = rtl_priv(hw); | ||
1036 | |||
1037 | rtlpriv->cfg->ops->fill_h2c_cmd(hw, H2C_RA_MASK, 5, rtlpriv->rate_mask); | ||
1038 | } | ||
1039 | |||
1029 | static struct rtl_intf_ops rtl_usb_ops = { | 1040 | static struct rtl_intf_ops rtl_usb_ops = { |
1030 | .adapter_start = rtl_usb_start, | 1041 | .adapter_start = rtl_usb_start, |
1031 | .adapter_stop = rtl_usb_stop, | 1042 | .adapter_stop = rtl_usb_stop, |
@@ -1057,6 +1068,8 @@ int rtl_usb_probe(struct usb_interface *intf, | |||
1057 | 1068 | ||
1058 | /* this spin lock must be initialized early */ | 1069 | /* this spin lock must be initialized early */ |
1059 | spin_lock_init(&rtlpriv->locks.usb_lock); | 1070 | spin_lock_init(&rtlpriv->locks.usb_lock); |
1071 | INIT_WORK(&rtlpriv->works.fill_h2c_cmd, | ||
1072 | rtl_fill_h2c_cmd_work_callback); | ||
1060 | 1073 | ||
1061 | rtlpriv->usb_data_index = 0; | 1074 | rtlpriv->usb_data_index = 0; |
1062 | init_completion(&rtlpriv->firmware_loading_complete); | 1075 | init_completion(&rtlpriv->firmware_loading_complete); |
diff --git a/drivers/net/wireless/rtlwifi/wifi.h b/drivers/net/wireless/rtlwifi/wifi.h index 44328baa6389..cc03e7c87cbe 100644 --- a/drivers/net/wireless/rtlwifi/wifi.h +++ b/drivers/net/wireless/rtlwifi/wifi.h | |||
@@ -1736,6 +1736,8 @@ struct rtl_hal_ops { | |||
1736 | void (*bt_wifi_media_status_notify) (struct ieee80211_hw *hw, | 1736 | void (*bt_wifi_media_status_notify) (struct ieee80211_hw *hw, |
1737 | bool mstate); | 1737 | bool mstate); |
1738 | void (*bt_coex_off_before_lps) (struct ieee80211_hw *hw); | 1738 | void (*bt_coex_off_before_lps) (struct ieee80211_hw *hw); |
1739 | void (*fill_h2c_cmd) (struct ieee80211_hw *hw, u8 element_id, | ||
1740 | u32 cmd_len, u8 *p_cmdbuffer); | ||
1739 | }; | 1741 | }; |
1740 | 1742 | ||
1741 | struct rtl_intf_ops { | 1743 | struct rtl_intf_ops { |
@@ -1869,6 +1871,7 @@ struct rtl_works { | |||
1869 | struct delayed_work fwevt_wq; | 1871 | struct delayed_work fwevt_wq; |
1870 | 1872 | ||
1871 | struct work_struct lps_change_work; | 1873 | struct work_struct lps_change_work; |
1874 | struct work_struct fill_h2c_cmd; | ||
1872 | }; | 1875 | }; |
1873 | 1876 | ||
1874 | struct rtl_debug { | 1877 | struct rtl_debug { |
@@ -2048,6 +2051,7 @@ struct rtl_priv { | |||
2048 | }; | 2051 | }; |
2049 | }; | 2052 | }; |
2050 | bool enter_ps; /* true when entering PS */ | 2053 | bool enter_ps; /* true when entering PS */ |
2054 | u8 rate_mask[5]; | ||
2051 | 2055 | ||
2052 | /*This must be the last item so | 2056 | /*This must be the last item so |
2053 | that it points to the data allocated | 2057 | that it points to the data allocated |
diff --git a/drivers/net/wireless/ti/wl12xx/scan.c b/drivers/net/wireless/ti/wl12xx/scan.c index affdb3ec6225..4a0bbb13806b 100644 --- a/drivers/net/wireless/ti/wl12xx/scan.c +++ b/drivers/net/wireless/ti/wl12xx/scan.c | |||
@@ -310,7 +310,7 @@ static void wl12xx_adjust_channels(struct wl1271_cmd_sched_scan_config *cmd, | |||
310 | memcpy(cmd->channels_2, cmd_channels->channels_2, | 310 | memcpy(cmd->channels_2, cmd_channels->channels_2, |
311 | sizeof(cmd->channels_2)); | 311 | sizeof(cmd->channels_2)); |
312 | memcpy(cmd->channels_5, cmd_channels->channels_5, | 312 | memcpy(cmd->channels_5, cmd_channels->channels_5, |
313 | sizeof(cmd->channels_2)); | 313 | sizeof(cmd->channels_5)); |
314 | /* channels_4 are not supported, so no need to copy them */ | 314 | /* channels_4 are not supported, so no need to copy them */ |
315 | } | 315 | } |
316 | 316 | ||
diff --git a/drivers/net/wireless/ti/wl12xx/wl12xx.h b/drivers/net/wireless/ti/wl12xx/wl12xx.h index 222d03540200..9e5484a73667 100644 --- a/drivers/net/wireless/ti/wl12xx/wl12xx.h +++ b/drivers/net/wireless/ti/wl12xx/wl12xx.h | |||
@@ -36,12 +36,12 @@ | |||
36 | #define WL127X_IFTYPE_SR_VER 3 | 36 | #define WL127X_IFTYPE_SR_VER 3 |
37 | #define WL127X_MAJOR_SR_VER 10 | 37 | #define WL127X_MAJOR_SR_VER 10 |
38 | #define WL127X_SUBTYPE_SR_VER WLCORE_FW_VER_IGNORE | 38 | #define WL127X_SUBTYPE_SR_VER WLCORE_FW_VER_IGNORE |
39 | #define WL127X_MINOR_SR_VER 115 | 39 | #define WL127X_MINOR_SR_VER 133 |
40 | /* minimum multi-role FW version for wl127x */ | 40 | /* minimum multi-role FW version for wl127x */ |
41 | #define WL127X_IFTYPE_MR_VER 5 | 41 | #define WL127X_IFTYPE_MR_VER 5 |
42 | #define WL127X_MAJOR_MR_VER 7 | 42 | #define WL127X_MAJOR_MR_VER 7 |
43 | #define WL127X_SUBTYPE_MR_VER WLCORE_FW_VER_IGNORE | 43 | #define WL127X_SUBTYPE_MR_VER WLCORE_FW_VER_IGNORE |
44 | #define WL127X_MINOR_MR_VER 115 | 44 | #define WL127X_MINOR_MR_VER 42 |
45 | 45 | ||
46 | /* FW chip version for wl128x */ | 46 | /* FW chip version for wl128x */ |
47 | #define WL128X_CHIP_VER 7 | 47 | #define WL128X_CHIP_VER 7 |
@@ -49,7 +49,7 @@ | |||
49 | #define WL128X_IFTYPE_SR_VER 3 | 49 | #define WL128X_IFTYPE_SR_VER 3 |
50 | #define WL128X_MAJOR_SR_VER 10 | 50 | #define WL128X_MAJOR_SR_VER 10 |
51 | #define WL128X_SUBTYPE_SR_VER WLCORE_FW_VER_IGNORE | 51 | #define WL128X_SUBTYPE_SR_VER WLCORE_FW_VER_IGNORE |
52 | #define WL128X_MINOR_SR_VER 115 | 52 | #define WL128X_MINOR_SR_VER 133 |
53 | /* minimum multi-role FW version for wl128x */ | 53 | /* minimum multi-role FW version for wl128x */ |
54 | #define WL128X_IFTYPE_MR_VER 5 | 54 | #define WL128X_IFTYPE_MR_VER 5 |
55 | #define WL128X_MAJOR_MR_VER 7 | 55 | #define WL128X_MAJOR_MR_VER 7 |
diff --git a/drivers/net/wireless/ti/wl18xx/scan.c b/drivers/net/wireless/ti/wl18xx/scan.c index 09d944505ac0..2b642f8c9266 100644 --- a/drivers/net/wireless/ti/wl18xx/scan.c +++ b/drivers/net/wireless/ti/wl18xx/scan.c | |||
@@ -34,7 +34,7 @@ static void wl18xx_adjust_channels(struct wl18xx_cmd_scan_params *cmd, | |||
34 | memcpy(cmd->channels_2, cmd_channels->channels_2, | 34 | memcpy(cmd->channels_2, cmd_channels->channels_2, |
35 | sizeof(cmd->channels_2)); | 35 | sizeof(cmd->channels_2)); |
36 | memcpy(cmd->channels_5, cmd_channels->channels_5, | 36 | memcpy(cmd->channels_5, cmd_channels->channels_5, |
37 | sizeof(cmd->channels_2)); | 37 | sizeof(cmd->channels_5)); |
38 | /* channels_4 are not supported, so no need to copy them */ | 38 | /* channels_4 are not supported, so no need to copy them */ |
39 | } | 39 | } |
40 | 40 | ||
diff --git a/drivers/net/xen-netback/netback.c b/drivers/net/xen-netback/netback.c index 37984e6d4e99..8c20935d72c9 100644 --- a/drivers/net/xen-netback/netback.c +++ b/drivers/net/xen-netback/netback.c | |||
@@ -662,7 +662,7 @@ static void xen_netbk_rx_action(struct xen_netbk *netbk) | |||
662 | { | 662 | { |
663 | struct xenvif *vif = NULL, *tmp; | 663 | struct xenvif *vif = NULL, *tmp; |
664 | s8 status; | 664 | s8 status; |
665 | u16 irq, flags; | 665 | u16 flags; |
666 | struct xen_netif_rx_response *resp; | 666 | struct xen_netif_rx_response *resp; |
667 | struct sk_buff_head rxq; | 667 | struct sk_buff_head rxq; |
668 | struct sk_buff *skb; | 668 | struct sk_buff *skb; |
@@ -771,13 +771,13 @@ static void xen_netbk_rx_action(struct xen_netbk *netbk) | |||
771 | sco->meta_slots_used); | 771 | sco->meta_slots_used); |
772 | 772 | ||
773 | RING_PUSH_RESPONSES_AND_CHECK_NOTIFY(&vif->rx, ret); | 773 | RING_PUSH_RESPONSES_AND_CHECK_NOTIFY(&vif->rx, ret); |
774 | irq = vif->irq; | ||
775 | if (ret && list_empty(&vif->notify_list)) | ||
776 | list_add_tail(&vif->notify_list, ¬ify); | ||
777 | 774 | ||
778 | xenvif_notify_tx_completion(vif); | 775 | xenvif_notify_tx_completion(vif); |
779 | 776 | ||
780 | xenvif_put(vif); | 777 | if (ret && list_empty(&vif->notify_list)) |
778 | list_add_tail(&vif->notify_list, ¬ify); | ||
779 | else | ||
780 | xenvif_put(vif); | ||
781 | npo.meta_cons += sco->meta_slots_used; | 781 | npo.meta_cons += sco->meta_slots_used; |
782 | dev_kfree_skb(skb); | 782 | dev_kfree_skb(skb); |
783 | } | 783 | } |
@@ -785,6 +785,7 @@ static void xen_netbk_rx_action(struct xen_netbk *netbk) | |||
785 | list_for_each_entry_safe(vif, tmp, ¬ify, notify_list) { | 785 | list_for_each_entry_safe(vif, tmp, ¬ify, notify_list) { |
786 | notify_remote_via_irq(vif->irq); | 786 | notify_remote_via_irq(vif->irq); |
787 | list_del_init(&vif->notify_list); | 787 | list_del_init(&vif->notify_list); |
788 | xenvif_put(vif); | ||
788 | } | 789 | } |
789 | 790 | ||
790 | /* More work to do? */ | 791 | /* More work to do? */ |