1683fce882f6d9a172f0efe0e87a9f886e7a024f
2 * Atheros AR71xx built-in ethernet mac driver
4 * Copyright (C) 2008-2010 Gabor Juhos <juhosg@openwrt.org>
5 * Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>
7 * Based on Atheros' AG7100 driver
9 * This program is free software; you can redistribute it and/or modify it
10 * under the terms of the GNU General Public License version 2 as published
11 * by the Free Software Foundation.
16 static void ag71xx_phy_link_adjust(struct net_device
*dev
)
18 struct ag71xx
*ag
= netdev_priv(dev
);
19 struct phy_device
*phydev
= ag
->phy_dev
;
21 int status_change
= 0;
23 spin_lock_irqsave(&ag
->lock
, flags
);
26 if (ag
->duplex
!= phydev
->duplex
27 || ag
->speed
!= phydev
->speed
) {
32 if (phydev
->link
!= ag
->link
)
35 ag
->link
= phydev
->link
;
36 ag
->duplex
= phydev
->duplex
;
37 ag
->speed
= phydev
->speed
;
40 ag71xx_link_adjust(ag
);
42 spin_unlock_irqrestore(&ag
->lock
, flags
);
45 void ag71xx_phy_start(struct ag71xx
*ag
)
47 struct ag71xx_platform_data
*pdata
= ag71xx_get_pdata(ag
);
50 phy_start(ag
->phy_dev
);
51 } else if (pdata
->mii_bus_dev
&& pdata
->switch_data
) {
52 ag71xx_ar7240_start(ag
);
55 ag71xx_link_adjust(ag
);
59 void ag71xx_phy_stop(struct ag71xx
*ag
)
61 struct ag71xx_platform_data
*pdata
= ag71xx_get_pdata(ag
);
65 phy_stop(ag
->phy_dev
);
66 else if (pdata
->mii_bus_dev
&& pdata
->switch_data
)
67 ag71xx_ar7240_stop(ag
);
69 spin_lock_irqsave(&ag
->lock
, flags
);
72 ag71xx_link_adjust(ag
);
74 spin_unlock_irqrestore(&ag
->lock
, flags
);
77 static int ag71xx_phy_connect_fixed(struct ag71xx
*ag
)
79 struct device
*dev
= &ag
->pdev
->dev
;
80 struct ag71xx_platform_data
*pdata
= ag71xx_get_pdata(ag
);
83 /* use fixed settings */
84 switch (pdata
->speed
) {
90 dev_err(dev
, "invalid speed specified\n");
95 dev_dbg(dev
, "using fixed link parameters\n");
97 ag
->duplex
= pdata
->duplex
;
98 ag
->speed
= pdata
->speed
;
101 dev_info(dev
, "connected to fixed PHY at %s [uid=%08x, driver=%s]\n",
102 phydev_name(ag
->phy_dev
),
103 ag
->phy_dev
->phy_id
, ag
->phy_dev
->drv
->name
);
105 pr_err("Failed to connect to fixed PHY\n");
110 static int ag71xx_phy_connect_multi(struct ag71xx
*ag
)
112 struct device
*dev
= &ag
->pdev
->dev
;
113 struct ag71xx_platform_data
*pdata
= ag71xx_get_pdata(ag
);
114 struct phy_device
*phydev
= NULL
;
118 for (phy_addr
= 0; phy_addr
< PHY_MAX_ADDR
; phy_addr
++) {
119 if (!(pdata
->phy_mask
& (1 << phy_addr
)))
122 #if LINUX_VERSION_CODE < KERNEL_VERSION(4,5,0)
123 if (ag
->mii_bus
->phy_map
[phy_addr
] == NULL
)
126 DBG("%s: PHY found at %s, uid=%08x\n",
128 dev_name(&ag
->mii_bus
->phy_map
[phy_addr
]->dev
),
129 &ag
->mii_bus
->phy_map
[phy_addr
]->phy_id
),
130 &ag
->mii_bus
->phy_map
[phy_addr
]->phy_id
: 0);
133 phydev
= ag
->mii_bus
->phy_map
[phy_addr
];
135 if (ag
->mii_bus
->mdio_map
[phy_addr
] == NULL
)
138 DBG("%s: PHY found at %s, uid=%08x\n",
140 dev_name(&ag
->mii_bus
->mdio_map
[phy_addr
]->dev
),
141 mdiobus_get_phy(ag
->mii_bus
, phy_addr
) ?
142 mdiobus_get_phy(ag
->mii_bus
, phy_addr
)->phy_id
: 0);
145 phydev
= mdiobus_get_phy(ag
->mii_bus
, phy_addr
);
150 dev_err(dev
, "no PHY found with phy_mask=%08x\n",
155 #if LINUX_VERSION_CODE < KERNEL_VERSION(4,5,0)
156 ag
->phy_dev
= phy_connect(ag
->dev
, dev_name(&phydev
->dev
),
158 ag
->phy_dev
= phy_connect(ag
->dev
, phydev_name(phydev
),
160 &ag71xx_phy_link_adjust
,
163 if (IS_ERR(ag
->phy_dev
)) {
164 dev_err(dev
, "could not connect to PHY at %s\n",
165 #if LINUX_VERSION_CODE < KERNEL_VERSION(4,5,0)
166 dev_name(&phydev
->dev
));
168 phydev_name(phydev
));
170 return PTR_ERR(ag
->phy_dev
);
173 /* mask with MAC supported features */
175 phydev
->supported
&= PHY_GBIT_FEATURES
;
177 phydev
->supported
&= PHY_BASIC_FEATURES
;
179 phydev
->advertising
= phydev
->supported
;
181 dev_info(dev
, "connected to PHY at %s [uid=%08x, driver=%s]\n",
182 #if LINUX_VERSION_CODE < KERNEL_VERSION(4,5,0)
183 dev_name(&phydev
->dev
),
187 phydev
->phy_id
, phydev
->drv
->name
);
196 static int dev_is_class(struct device
*dev
, void *class)
198 if (dev
->class != NULL
&& !strcmp(dev
->class->name
, class))
204 static struct device
*dev_find_class(struct device
*parent
, char *class)
206 if (dev_is_class(parent
, class)) {
211 return device_find_child(parent
, class, dev_is_class
);
214 static struct mii_bus
*dev_to_mii_bus(struct device
*dev
)
218 d
= dev_find_class(dev
, "mdio_bus");
231 int ag71xx_phy_connect(struct ag71xx
*ag
)
233 struct ag71xx_platform_data
*pdata
= ag71xx_get_pdata(ag
);
235 if (pdata
->mii_bus_dev
== NULL
||
236 pdata
->mii_bus_dev
->bus
== NULL
)
237 return ag71xx_phy_connect_fixed(ag
);
239 ag
->mii_bus
= dev_to_mii_bus(pdata
->mii_bus_dev
);
240 if (ag
->mii_bus
== NULL
) {
241 dev_err(&ag
->pdev
->dev
, "unable to find MII bus on device '%s'\n",
242 dev_name(pdata
->mii_bus_dev
));
246 /* Reset the mdio bus explicitly */
247 if (ag
->mii_bus
->reset
) {
248 mutex_lock(&ag
->mii_bus
->mdio_lock
);
249 ag
->mii_bus
->reset(ag
->mii_bus
);
250 mutex_unlock(&ag
->mii_bus
->mdio_lock
);
253 if (pdata
->switch_data
)
254 return ag71xx_ar7240_init(ag
);
257 return ag71xx_phy_connect_multi(ag
);
259 return ag71xx_phy_connect_fixed(ag
);
262 void ag71xx_phy_disconnect(struct ag71xx
*ag
)
264 struct ag71xx_platform_data
*pdata
= ag71xx_get_pdata(ag
);
266 if (pdata
->switch_data
)
267 ag71xx_ar7240_cleanup(ag
);
268 else if (ag
->phy_dev
)
269 phy_disconnect(ag
->phy_dev
);