-
Notifications
You must be signed in to change notification settings - Fork 49
/
MV88X3120_phy_Linux.c
213 lines (181 loc) · 6.26 KB
/
MV88X3120_phy_Linux.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
#include "tn40.h"
int MV88X3120_set_speed(struct bdx_priv *priv, s32 speed);
#define MV88X3120_EEE_10G (0x0008) /*Support EEE for 10GBASE-T */
#define MV88X3120_EEE_1G (0x0004) /*Support EEE for 1GBASE-T */
#define MV88X3120_EEE_100M (0x0002) /*Support EEE for 100MBASE-T */
#define MV88X3120_ALL_SPEEDS (__ETHTOOL_LINK_MODE_MASK_NBITS)
static void MV88X3120_set_link_mode(unsigned long *bits, u32 speed)
{
bitmap_zero(bits, __ETHTOOL_LINK_MODE_MASK_NBITS);
__set_bit(ETHTOOL_LINK_MODE_Pause_BIT, bits);
__set_bit(ETHTOOL_LINK_MODE_TP_BIT, bits);;
if (speed == MV88X3120_ALL_SPEEDS) {
__set_bit(ETHTOOL_LINK_MODE_10000baseT_Full_BIT, bits);
__set_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT, bits);
__set_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT, bits);
__set_bit(ETHTOOL_LINK_MODE_Autoneg_BIT, bits);
} else {
__set_bit(speed, bits);
}
}
int MV88X3120_get_link_ksettings(struct net_device *netdev,
struct ethtool_link_ksettings *cmd)
{
struct bdx_priv *priv = netdev_priv(netdev);
cmd->base.speed = priv->link_speed;
cmd->base.port = PORT_TP;
cmd->base.autoneg = AUTONEG_ENABLE;
cmd->base.duplex = DUPLEX_FULL;
#if defined(ETH_TP_MDI_AUTO)
cmd->base.eth_tp_mdix = ETH_TP_MDI_AUTO;
cmd->base.eth_tp_mdix_ctrl = ETH_TP_MDI_AUTO;
#else
cmd->base.eth_tp_mdix = ETH_TP_MDI | ETH_TP_MDI_X;
cmd->base.eth_tp_mdix_ctrl = ETH_TP_MDI | ETH_TP_MDI_X;
#endif
MV88X3120_set_link_mode(cmd->link_modes.supported,
MV88X3120_ALL_SPEEDS);
if (priv->autoneg == AUTONEG_ENABLE) {
memcpy(priv->link_advertising, cmd->link_modes.supported,
sizeof(priv->link_advertising));
}
memcpy(cmd->link_modes.advertising, priv->link_advertising,
sizeof(cmd->link_modes.advertising));
return 0;
}
int MV88X3120_set_link_ksettings(struct net_device *netdev,
const struct ethtool_link_ksettings *cmd)
{
struct bdx_priv *priv = netdev_priv(netdev);
int rVal = 0;
priv->autoneg = cmd->base.autoneg;
if (priv->autoneg == AUTONEG_ENABLE) {
MV88X3120_set_link_mode(priv->link_advertising,
MV88X3120_ALL_SPEEDS);
} else {
switch (cmd->base.speed) {
case 10000: /*10G */
MV88X3120_set_link_mode(priv->link_advertising,
ETHTOOL_LINK_MODE_10000baseT_Full_BIT);
break;
case 1000: /*1G */
MV88X3120_set_link_mode(priv->link_advertising,
ETHTOOL_LINK_MODE_1000baseT_Full_BIT);
break;
case 100: /*100m */
MV88X3120_set_link_mode(priv->link_advertising,
ETHTOOL_LINK_MODE_100baseT_Full_BIT);
break;
default:
pr_err("does not support speed %u\n", cmd->base.speed);
rVal = -EINVAL;
break;
}
}
if (rVal == 0) {
rVal = MV88X3120_set_speed(priv, cmd->base.speed);
}
return 0;
}
/* EEE - IEEEaz */
#ifdef _EEE_
#ifdef ETHTOOL_GEEE
int MV88X3120_get_eee(struct net_device *netdev, struct ethtool_eee *edata)
{
struct bdx_priv *priv = netdev_priv(netdev);
u32 val;
/* EEE Capability */
edata->supported = (SUPPORTED_10000baseT_Full); /* | SUPPORTED_1000baseT_Full | SUPPORTED_100baseT_Full); */
/* EEE Advertised */
val = bdx_mdio_read(priv, 7, priv->phy_mdio_port, 60);
edata->advertised = 0;
if (val & MV88X3120_EEE_10G)
edata->advertised |= SUPPORTED_10000baseT_Full;
/*if(val & MV88X3120_EEE_1G) edata->advertised |= SUPPORTED_1000baseT_Full;
if(val & MV88X3120_EEE_100M) edata->advertised |= SUPPORTED_100baseT_Full; */
/* EEE Link Partner Advertised */
val = bdx_mdio_read(priv, 7, priv->phy_mdio_port, 61);
edata->lp_advertised = 0;
if (val & MV88X3120_EEE_10G)
edata->lp_advertised |= SUPPORTED_10000baseT_Full;
/* EEE Status */
val = bdx_mdio_read(priv, 1, priv->phy_mdio_port, 49192);
if (val & 0x40)
edata->eee_active = true; /*still need to check that link is up. */
edata->eee_enabled = true;
return 0;
}
#endif
#ifdef ETHTOOL_SEEE
int MV88X3120_set_eee(struct bdx_priv *priv)
{
u16 val, port = priv->phy_mdio_port;
/*EEE LPI Buffer Enable */
BDX_MDIO_WRITE(priv, 1, 49230, 0x0900);
BDX_MDIO_WRITE(priv, 1, 49221, 0x1);
BDX_MDIO_WRITE(priv, 7, 60, 0x8);
/*val = bdx_mdio_read(priv, 3, priv->phy_mdio_port, 20);
val = bdx_mdio_read(priv, 4, priv->phy_mdio_port, 20);
val = bdx_mdio_read(priv, 7, priv->phy_mdio_port, 61); */
/* restart autoneg */
val = (1 << 12) | (1 << 9) | (1 << 13);
BDX_MDIO_WRITE(priv, 0x07, 0x0, val);
val = bdx_mdio_read(priv, 7, priv->phy_mdio_port, 1);
val = bdx_mdio_read(priv, 7, priv->phy_mdio_port, 1);
val = bdx_mdio_read(priv, 7, priv->phy_mdio_port, 60);
pr_err("DBG_EEE 7.60=0x%x \n", val);
val = bdx_mdio_read(priv, 7, priv->phy_mdio_port, 61);
pr_err("DBG_EEE 7.61=0x%x \n", val);
val = bdx_mdio_read(priv, 1, priv->phy_mdio_port, 49230);
pr_err("DBG_EEE 1.49230=0x%x\n", val);
priv->eee_enabled = true;
return 0;
}
#endif
void MV88X3120_enable_eee(struct bdx_priv *priv)
{
pr_debug("EEE enabled=%d\n", priv->eee_enabled);
if (priv->eee_enabled) {
pr_debug("EEE MTU=%d\n", priv->ndev->mtu);
bdx_mdio_write(priv, 9, priv->phy_mdio_port, 0x809C, 0xFF1);
bdx_mdio_write(priv, 9, priv->phy_mdio_port, 0x809D, 0x0);
bdx_mdio_write(priv, 9, priv->phy_mdio_port, 0x809E, 0x4B);
bdx_mdio_write(priv, 9, priv->phy_mdio_port, 0x809F, 0x0);
bdx_mdio_write(priv, 9, priv->phy_mdio_port, 0x8C02,
(priv->ndev->mtu * 2));
bdx_mdio_write(priv, 9, priv->phy_mdio_port, 0x8C03, 0x0);
bdx_mdio_write(priv, 9, priv->phy_mdio_port, 0x8E02,
(priv->ndev->mtu * 2));
bdx_mdio_write(priv, 9, priv->phy_mdio_port, 0x8E03, 0x0);
bdx_mdio_write(priv, 9, priv->phy_mdio_port, 0x8000, 0x3);
bdx_mdio_write(priv, 9, priv->phy_mdio_port, 0x8001, 0x7E50);
} else {
#if defined(_EEE_) && defined(ETHTOOL_SEEE)
MV88X3120_set_eee(priv /*, edata */ );
#endif
}
}
int MV88X3120_reset_eee(struct bdx_priv *priv)
{
bdx_mdio_write(priv, 1, priv->phy_mdio_port, 49230, 0);
bdx_mdio_write(priv, 1, priv->phy_mdio_port, 49221, 0);
bdx_mdio_write(priv, 7, priv->phy_mdio_port, 60, 0);
priv->eee_enabled = false;
return 0;
}
#endif
__init void MV88X3120_register_settings(struct bdx_priv *priv)
{
priv->phy_ops.get_link_ksettings = MV88X3120_get_link_ksettings;
priv->phy_ops.set_link_ksettings = MV88X3120_set_link_ksettings;
priv->autoneg = AUTONEG_ENABLE;
#ifdef _EEE_
#ifdef ETHTOOL_GEEE
priv->phy_ops.get_eee = MV88X3120_get_eee;
#endif
#ifdef ETHTOOL_SEEE
priv->phy_ops.set_eee = MV88X3120_set_eee;
#endif
priv->phy_ops.reset_eee = MV88X3120_reset_eee;
#endif
}