ruephy.c revision 129876
175115Sfenner/*- 275115Sfenner * Copyright (c) 2001-2003, Shunsuke Akiyama <akiyama@FreeBSD.org>. 375115Sfenner * All rights reserved. 475115Sfenner * 575115Sfenner * Redistribution and use in source and binary forms, with or without 675115Sfenner * modification, are permitted provided that the following conditions 7127668Sbms * are met: 875115Sfenner * 1. Redistributions of source code must retain the above copyright 975115Sfenner * notice, this list of conditions and the following disclaimer. 1075115Sfenner * 2. Redistributions in binary form must reproduce the above copyright 1175115Sfenner * notice, this list of conditions and the following disclaimer in the 1275115Sfenner * documentation and/or other materials provided with the distribution. 1375115Sfenner * 1475115Sfenner * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 1575115Sfenner * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 1675115Sfenner * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 1775115Sfenner * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 1875115Sfenner * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 1975115Sfenner * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2075115Sfenner * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 2175115Sfenner * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2275115Sfenner * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2375115Sfenner * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 2475115Sfenner * SUCH DAMAGE. 2575115Sfenner * 2675115Sfenner */ 2775115Sfenner 2875115Sfenner#include <sys/cdefs.h> 2975115Sfenner__FBSDID("$FreeBSD: head/sys/dev/mii/ruephy.c 129876 2004-05-30 17:57:46Z phk $"); 3075115Sfenner 3175115Sfenner/* 3275115Sfenner * driver for RealTek RTL8150 internal PHY 3375115Sfenner */ 3475115Sfenner 3575115Sfenner#include <sys/param.h> 3675115Sfenner#include <sys/systm.h> 3775115Sfenner#include <sys/kernel.h> 38214478Srpaulo#include <sys/malloc.h> 3975115Sfenner#include <sys/module.h> 4075115Sfenner#include <sys/socket.h> 4175115Sfenner#include <sys/bus.h> 4275115Sfenner 4375115Sfenner#include <net/if.h> 4475115Sfenner#include <net/if_arp.h> 4575115Sfenner#include <net/if_media.h> 4675115Sfenner 4775115Sfenner#include <dev/mii/mii.h> 4875115Sfenner#include <dev/mii/miivar.h> 4975115Sfenner#include "miidevs.h" 5075115Sfenner 5175115Sfenner#include <machine/bus.h> 5275115Sfenner#include <dev/mii/ruephyreg.h> 5375115Sfenner 5475115Sfenner#include "miibus_if.h" 5575115Sfenner 5675115Sfennerstatic int ruephy_probe(device_t); 5775115Sfennerstatic int ruephy_attach(device_t); 5875115Sfenner 5975115Sfennerstatic device_method_t ruephy_methods[] = { 6075115Sfenner /* device interface */ 6175115Sfenner DEVMETHOD(device_probe, ruephy_probe), 6275115Sfenner DEVMETHOD(device_attach, ruephy_attach), 6375115Sfenner DEVMETHOD(device_detach, mii_phy_detach), 6475115Sfenner DEVMETHOD(device_shutdown, bus_generic_shutdown), 6575115Sfenner { 0, 0 } 6675115Sfenner}; 67190207Srpaulo 68190207Srpaulostatic devclass_t ruephy_devclass; 6975115Sfenner 7075115Sfennerstatic driver_t ruephy_driver = { 7175115Sfenner "ruephy", 7275115Sfenner ruephy_methods, 7375115Sfenner sizeof(struct mii_softc) 7475115Sfenner}; 7575115Sfenner 7675115SfennerDRIVER_MODULE(ruephy, miibus, ruephy_driver, ruephy_devclass, 0, 0); 7775115Sfenner 7875115Sfennerstatic int ruephy_service(struct mii_softc *, struct mii_data *, int); 7975115Sfennerstatic void ruephy_reset(struct mii_softc *); 8075115Sfennerstatic void ruephy_status(struct mii_softc *); 8175115Sfenner 8275115Sfennerstatic int 8375115Sfennerruephy_probe(device_t dev) 8475115Sfenner{ 8575115Sfenner struct mii_attach_args *ma; 8675115Sfenner device_t parent; 8775115Sfenner 8875115Sfenner ma = device_get_ivars(dev); 8975115Sfenner parent = device_get_parent(device_get_parent(dev)); 9075115Sfenner 9175115Sfenner /* 9275115Sfenner * RealTek RTL8150 PHY doesn't have vendor/device ID registers: 9375115Sfenner * the rue driver fakes up a return value of all zeros. 9475115Sfenner */ 9575115Sfenner if (MII_OUI(ma->mii_id1, ma->mii_id2) != 0 || 9675115Sfenner MII_MODEL(ma->mii_id2) != 0) 9775115Sfenner return (ENXIO); 9875115Sfenner 9975115Sfenner /* 10075115Sfenner * Make sure the parent is an 'rue'. 10175115Sfenner */ 10275115Sfenner if (strcmp(device_get_name(parent), "rue") != 0) 10375115Sfenner return (ENXIO); 10475115Sfenner 10575115Sfenner device_set_desc(dev, "RealTek RTL8150 internal media interface"); 10675115Sfenner 10775115Sfenner return (0); 10875115Sfenner} 10975115Sfenner 11075115Sfennerstatic int 11175115Sfennerruephy_attach(device_t dev) 11275115Sfenner{ 11375115Sfenner struct mii_softc *sc; 11475115Sfenner struct mii_attach_args *ma; 11575115Sfenner struct mii_data *mii; 11675115Sfenner 11775115Sfenner sc = device_get_softc(dev); 11875115Sfenner ma = device_get_ivars(dev); 11975115Sfenner sc->mii_dev = device_get_parent(dev); 12075115Sfenner mii = device_get_softc(sc->mii_dev); 12175115Sfenner 12275115Sfenner /* 12375115Sfenner * The RealTek PHY can never be isolated, so never allow non-zero 12475115Sfenner * instances! 12575115Sfenner */ 12675115Sfenner if (mii->mii_instance != 0) { 12775115Sfenner device_printf(dev, "ignoring this PHY, non-zero instance\n"); 128 return (ENXIO); 129 } 130 131 LIST_INSERT_HEAD(&mii->mii_phys, sc, mii_list); 132 133 sc->mii_inst = mii->mii_instance; 134 sc->mii_phy = ma->mii_phyno; 135 sc->mii_service = ruephy_service; 136 sc->mii_pdata = mii; 137 mii->mii_instance++; 138 139 sc->mii_flags |= MIIF_NOISOLATE; 140 141#define ADD(m, c) ifmedia_add(&mii->mii_media, (m), (c), NULL) 142 143 ruephy_reset(sc); 144 145 sc->mii_capabilities = 146 PHY_READ(sc, MII_BMSR) & ma->mii_capmask; 147 device_printf(dev, " "); 148 mii_phy_add_media(sc); 149 printf("\n"); 150#undef ADD 151 152 MIIBUS_MEDIAINIT(sc->mii_dev); 153 return (0); 154} 155 156static int 157ruephy_service(struct mii_softc *sc, struct mii_data *mii, int cmd) 158{ 159 struct ifmedia_entry *ife = mii->mii_media.ifm_cur; 160 int reg; 161 162 /* 163 * We can't isolate the RealTek RTL8150 PHY, 164 * so it has to be the only one! 165 */ 166 if (IFM_INST(ife->ifm_media) != sc->mii_inst) 167 panic("ruephy_service: can't isolate RealTek RTL8150 PHY"); 168 169 switch (cmd) { 170 case MII_POLLSTAT: 171 break; 172 173 case MII_MEDIACHG: 174 /* 175 * If the interface is not up, don't do anything. 176 */ 177 if ((mii->mii_ifp->if_flags & IFF_UP) == 0) 178 break; 179 180 switch (IFM_SUBTYPE(ife->ifm_media)) { 181 case IFM_AUTO: 182 /* 183 * If we're already in auto mode, just return. 184 */ 185 if (PHY_READ(sc, MII_BMCR) & BMCR_AUTOEN) 186 return (0); 187 (void) mii_phy_auto(sc); 188 break; 189 case IFM_100_T4: 190 /* 191 * XXX Not supported as a manual setting right now. 192 */ 193 return (EINVAL); 194 default: 195 /* 196 * BMCR data is stored in the ifmedia entry. 197 */ 198 PHY_WRITE(sc, MII_ANAR, 199 mii_anar(ife->ifm_media)); 200 PHY_WRITE(sc, MII_BMCR, ife->ifm_data); 201 } 202 break; 203 204 case MII_TICK: 205 /* 206 * Is the interface even up? 207 */ 208 if ((mii->mii_ifp->if_flags & IFF_UP) == 0) 209 return (0); 210 211 /* 212 * Only used for autonegotiation. 213 */ 214 if (IFM_SUBTYPE(ife->ifm_media) != IFM_AUTO) 215 break; 216 217 /* 218 * Check to see if we have link. If we do, we don't 219 * need to restart the autonegotiation process. Read 220 * the MSR twice in case it's latched. 221 */ 222 reg = PHY_READ(sc, RUEPHY_MII_MSR) | 223 PHY_READ(sc, RUEPHY_MII_MSR); 224 if (reg & RUEPHY_MSR_LINK) 225 break; 226 227 /* 228 * Only retry autonegotiation every 5 seconds. 229 */ 230 if (++sc->mii_ticks <= 5) 231 break; 232 233 sc->mii_ticks = 0; 234 ruephy_reset(sc); 235 if (mii_phy_auto(sc) == EJUSTRETURN) 236 return (0); 237 break; 238 } 239 240 /* Update the media status. */ 241 ruephy_status(sc); 242 243 /* Callback if something changed. */ 244 mii_phy_update(sc, cmd); 245 246 return (0); 247} 248 249static void 250ruephy_reset(struct mii_softc *sc) 251{ 252 253 mii_phy_reset(sc); 254 255 /* 256 * XXX RealTek RTL8150 PHY doesn't set the BMCR properly after 257 * XXX reset, which breaks autonegotiation. 258 */ 259 PHY_WRITE(sc, MII_BMCR, (BMCR_S100 | BMCR_AUTOEN | BMCR_FDX)); 260} 261 262static void 263ruephy_status(struct mii_softc *phy) 264{ 265 struct mii_data *mii = phy->mii_pdata; 266 int bmsr, bmcr, msr; 267 268 mii->mii_media_status = IFM_AVALID; 269 mii->mii_media_active = IFM_ETHER; 270 271 msr = PHY_READ(phy, RUEPHY_MII_MSR) | PHY_READ(phy, RUEPHY_MII_MSR); 272 if (msr & RUEPHY_MSR_LINK) 273 mii->mii_media_status |= IFM_ACTIVE; 274 275 bmcr = PHY_READ(phy, MII_BMCR); 276 if (bmcr & BMCR_ISO) { 277 mii->mii_media_active |= IFM_NONE; 278 mii->mii_media_status = 0; 279 return; 280 } 281 282 bmsr = PHY_READ(phy, MII_BMSR) | PHY_READ(phy, MII_BMSR); 283 284 if (bmcr & BMCR_AUTOEN) { 285 if ((bmsr & BMSR_ACOMP) == 0) { 286 /* Erg, still trying, I guess... */ 287 mii->mii_media_active |= IFM_NONE; 288 return; 289 } 290 291 if (msr & RUEPHY_MSR_SPEED100) 292 mii->mii_media_active |= IFM_100_TX; 293 else 294 mii->mii_media_active |= IFM_10_T; 295 296 if (msr & RUEPHY_MSR_DUPLEX) 297 mii->mii_media_active |= IFM_FDX; 298 } else 299 mii->mii_media_active = mii_media_from_bmcr(bmcr); 300} 301