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
;
103 static int ag71xx_phy_connect_multi(struct ag71xx
*ag
)
105 struct device
*dev
= &ag
->pdev
->dev
;
106 struct ag71xx_platform_data
*pdata
= ag71xx_get_pdata(ag
);
107 struct phy_device
*phydev
= NULL
;
111 for (phy_addr
= 0; phy_addr
< PHY_MAX_ADDR
; phy_addr
++) {
112 if (!(pdata
->phy_mask
& (1 << phy_addr
)))
115 #if LINUX_VERSION_CODE < KERNEL_VERSION(4,5,0)
116 if (ag
->mii_bus
->phy_map
[phy_addr
] == NULL
)
119 DBG("%s: PHY found at %s, uid=%08x\n",
121 dev_name(&ag
->mii_bus
->phy_map
[phy_addr
]->dev
),
122 ag
->mii_bus
->phy_map
[phy_addr
]->phy_id
);
125 phydev
= ag
->mii_bus
->phy_map
[phy_addr
];
127 if (ag
->mii_bus
->mdio_map
[phy_addr
] == NULL
)
130 phydev
= mdiobus_get_phy(ag
->mii_bus
, phy_addr
);
132 DBG("%s: PHY found at %s, uid=%08x\n",
134 dev_name(&ag
->mii_bus
->mdio_map
[phy_addr
]->dev
),
135 (phydev
) ? phydev
->phy_id
: 0);
140 dev_err(dev
, "no PHY found with phy_mask=%08x\n",
145 #if LINUX_VERSION_CODE < KERNEL_VERSION(4,5,0)
146 ag
->phy_dev
= phy_connect(ag
->dev
, dev_name(&phydev
->dev
),
148 ag
->phy_dev
= phy_connect(ag
->dev
, phydev_name(phydev
),
150 &ag71xx_phy_link_adjust
,
153 if (IS_ERR(ag
->phy_dev
)) {
154 dev_err(dev
, "could not connect to PHY at %s\n",
155 #if LINUX_VERSION_CODE < KERNEL_VERSION(4,5,0)
156 dev_name(&phydev
->dev
));
158 phydev_name(phydev
));
160 return PTR_ERR(ag
->phy_dev
);
163 /* mask with MAC supported features */
165 phydev
->supported
&= PHY_GBIT_FEATURES
;
167 phydev
->supported
&= PHY_BASIC_FEATURES
;
169 phydev
->advertising
= phydev
->supported
;
171 dev_info(dev
, "connected to PHY at %s [uid=%08x, driver=%s]\n",
172 #if LINUX_VERSION_CODE < KERNEL_VERSION(4,5,0)
173 dev_name(&phydev
->dev
),
177 phydev
->phy_id
, phydev
->drv
->name
);
186 static int dev_is_class(struct device
*dev
, void *class)
188 if (dev
->class != NULL
&& !strcmp(dev
->class->name
, class))
194 static struct device
*dev_find_class(struct device
*parent
, char *class)
196 if (dev_is_class(parent
, class)) {
201 return device_find_child(parent
, class, dev_is_class
);
204 static struct mii_bus
*dev_to_mii_bus(struct device
*dev
)
208 d
= dev_find_class(dev
, "mdio_bus");
221 int ag71xx_phy_connect(struct ag71xx
*ag
)
223 struct ag71xx_platform_data
*pdata
= ag71xx_get_pdata(ag
);
225 if (pdata
->mii_bus_dev
== NULL
||
226 pdata
->mii_bus_dev
->bus
== NULL
)
227 return ag71xx_phy_connect_fixed(ag
);
229 ag
->mii_bus
= dev_to_mii_bus(pdata
->mii_bus_dev
);
230 if (ag
->mii_bus
== NULL
) {
231 dev_err(&ag
->pdev
->dev
, "unable to find MII bus on device '%s'\n",
232 dev_name(pdata
->mii_bus_dev
));
236 /* Reset the mdio bus explicitly */
237 if (ag
->mii_bus
->reset
) {
238 mutex_lock(&ag
->mii_bus
->mdio_lock
);
239 ag
->mii_bus
->reset(ag
->mii_bus
);
240 mutex_unlock(&ag
->mii_bus
->mdio_lock
);
243 if (pdata
->switch_data
)
244 return ag71xx_ar7240_init(ag
);
247 return ag71xx_phy_connect_multi(ag
);
249 return ag71xx_phy_connect_fixed(ag
);
252 void ag71xx_phy_disconnect(struct ag71xx
*ag
)
254 struct ag71xx_platform_data
*pdata
= ag71xx_get_pdata(ag
);
256 if (pdata
->switch_data
)
257 ag71xx_ar7240_cleanup(ag
);
258 else if (ag
->phy_dev
)
259 phy_disconnect(ag
->phy_dev
);