rdcphy.c revision 1.2
1 /* $NetBSD: rdcphy.c,v 1.2 2019/01/22 03:42:27 msaitoh Exp $ */ 2 3 /*- 4 * Copyright (c) 2010, Pyun YongHyeon <yongari (at) FreeBSD.org> 5 * All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice unmodified, this list of conditions, and the following 12 * disclaimer. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in the 15 * documentation and/or other materials provided with the distribution. 16 * 17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 18 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 20 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 23 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 25 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 26 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 27 * SUCH DAMAGE. 28 */ 29 30 /* FreeBSD: src/sys/dev/mii/rdcphy.c,v 1.1 2010/12/30 23:50:25 yongari Exp */ 31 32 /* 33 * Driver for the RDC Semiconductor R6040 10/100 PHY. 34 */ 35 #include <sys/cdefs.h> 36 __KERNEL_RCSID(0, "$NetBSD: rdcphy.c,v 1.2 2019/01/22 03:42:27 msaitoh Exp $"); 37 38 #include <sys/param.h> 39 #include <sys/systm.h> 40 #include <sys/kernel.h> 41 #include <sys/device.h> 42 #include <sys/socket.h> 43 #include <sys/errno.h> 44 45 #include <sys/bus.h> 46 47 #include <net/if.h> 48 #include <net/if_media.h> 49 50 #include <dev/mii/mii.h> 51 #include <dev/mii/miivar.h> 52 #include <dev/mii/miidevs.h> 53 54 #include <dev/mii/rdcphyreg.h> 55 56 struct rdcphy_softc { 57 struct mii_softc sc_mii; 58 int sc_mii_link_tick; 59 #define RDCPHY_MANNEG_TICK 3 60 }; 61 62 static int rdcphymatch(device_t, cfdata_t, void *); 63 static void rdcphyattach(device_t, device_t, void *); 64 65 CFATTACH_DECL_NEW(rdcphy, sizeof(struct rdcphy_softc), 66 rdcphymatch, rdcphyattach, mii_phy_detach, mii_phy_activate); 67 68 69 static int rdcphy_service(struct mii_softc *, struct mii_data *, int); 70 static void rdcphy_status(struct mii_softc *); 71 72 static const struct mii_phy_funcs rdcphy_funcs = { 73 rdcphy_service, rdcphy_status, mii_phy_reset, 74 }; 75 76 static const struct mii_phydesc rdcphys[] = { 77 { MII_OUI_RDC, MII_MODEL_RDC_R6040, 78 MII_STR_RDC_R6040 }, 79 { 0, 0, 80 NULL }, 81 }; 82 83 static int 84 rdcphymatch(device_t parent, cfdata_t match, void *aux) 85 { 86 struct mii_attach_args *ma = aux; 87 88 if (mii_phy_match(ma, rdcphys) != NULL) 89 return (10); 90 91 return (0); 92 } 93 94 static void 95 rdcphyattach(device_t parent, device_t self, void *aux) 96 { 97 struct rdcphy_softc *rsc = device_private(self); 98 struct mii_softc *sc = &rsc->sc_mii; 99 struct mii_attach_args *ma = aux; 100 struct mii_data *mii = ma->mii_data; 101 102 const struct mii_phydesc *mpd; 103 104 mpd = mii_phy_match(ma, rdcphys); 105 aprint_naive(": Media interface\n"); 106 aprint_normal(": %s, rev. %d\n", mpd->mpd_name, MII_REV(ma->mii_id2)); 107 108 sc->mii_dev = self; 109 sc->mii_inst = mii->mii_instance; 110 sc->mii_phy = ma->mii_phyno; 111 sc->mii_funcs = &rdcphy_funcs; 112 sc->mii_pdata = mii; 113 sc->mii_flags = ma->mii_flags; 114 sc->mii_anegticks = MII_ANEGTICKS; 115 116 PHY_RESET(sc); 117 118 PHY_READ(sc, MII_BMSR, &sc->mii_capabilities); 119 sc->mii_capabilities &= ma->mii_capmask; 120 if (sc->mii_capabilities & BMSR_EXTSTAT) 121 PHY_READ(sc, MII_EXTSR, &sc->mii_extcapabilities); 122 aprint_normal_dev(self, ""); 123 mii_phy_add_media(sc); 124 aprint_normal("\n"); 125 126 if (!pmf_device_register(self, NULL, mii_phy_resume)) 127 aprint_error_dev(self, "couldn't establish power handler\n"); 128 129 } 130 131 static int 132 rdcphy_service(struct mii_softc *sc, struct mii_data *mii, int cmd) 133 { 134 struct rdcphy_softc *rsc = (struct rdcphy_softc *)sc; 135 struct ifmedia_entry *ife = mii->mii_media.ifm_cur; 136 137 switch (cmd) { 138 case MII_POLLSTAT: 139 break; 140 141 case MII_MEDIACHG: 142 /* 143 * If the interface is not up, don't do anything. 144 */ 145 if ((mii->mii_ifp->if_flags & IFF_UP) == 0) 146 break; 147 148 mii_phy_setmedia(sc); 149 switch (IFM_SUBTYPE(ife->ifm_media)) { 150 case IFM_100_TX: 151 case IFM_10_T: 152 /* 153 * Report fake lost link event to parent 154 * driver. This will stop MAC of parent 155 * driver and make it possible to reconfigure 156 * MAC after completion of link establishment. 157 * Note, the parent MAC seems to require 158 * restarting MAC when underlying any PHY 159 * configuration was changed even if the 160 * resolved speed/duplex was not changed at 161 * all. 162 */ 163 mii->mii_media_status = 0; 164 mii->mii_media_active = IFM_ETHER | IFM_NONE; 165 rsc->sc_mii_link_tick = RDCPHY_MANNEG_TICK; 166 /* Immediately report link down. */ 167 mii_phy_update(sc, MII_MEDIACHG); 168 return (0); 169 default: 170 break; 171 } 172 break; 173 174 case MII_TICK: 175 if (mii_phy_tick(sc) == EJUSTRETURN) 176 return (0); 177 if (IFM_SUBTYPE(ife->ifm_media) != IFM_AUTO) { 178 /* 179 * It seems the PHY hardware does not correctly 180 * report link status changes when manual link 181 * configuration is in progress. It is also 182 * possible for the PHY to complete establishing 183 * a link within one second such that mii(4) 184 * did not notice the link change. To workaround 185 * the issue, emulate lost link event and wait 186 * for 3 seconds when manual link configuration 187 * is in progress. 3 seconds would be long 188 * enough to absorb transient link flips. 189 */ 190 if (rsc->sc_mii_link_tick > 0) { 191 rsc->sc_mii_link_tick--; 192 return (0); 193 } 194 } 195 break; 196 } 197 198 /* Update the media status. */ 199 rdcphy_status(sc); 200 201 /* Callback if something changed. */ 202 mii_phy_update(sc, cmd); 203 return (0); 204 } 205 206 static void 207 rdcphy_status(struct mii_softc *sc) 208 { 209 struct mii_data *mii = sc->mii_pdata; 210 uint16_t bmsr, bmcr, physts; 211 212 mii->mii_media_status = IFM_AVALID; 213 mii->mii_media_active = IFM_ETHER; 214 215 PHY_READ(sc, MII_BMSR, &bmsr); 216 PHY_READ(sc, MII_BMSR, &bmsr); 217 PHY_READ(sc, MII_RDCPHY_STATUS, &physts); 218 219 if ((physts & STATUS_LINK_UP) != 0) 220 mii->mii_media_status |= IFM_ACTIVE; 221 222 PHY_READ(sc, MII_BMCR, &bmcr); 223 if ((bmcr & BMCR_ISO) != 0) { 224 mii->mii_media_active |= IFM_NONE; 225 mii->mii_media_status = 0; 226 return; 227 } 228 229 if ((bmcr & BMCR_LOOP) != 0) 230 mii->mii_media_active |= IFM_LOOP; 231 232 if ((bmcr & BMCR_AUTOEN) != 0) { 233 if ((bmsr & BMSR_ACOMP) == 0) { 234 /* Erg, still trying, I guess... */ 235 mii->mii_media_active |= IFM_NONE; 236 return; 237 } 238 } 239 240 switch (physts & STATUS_SPEED_MASK) { 241 case STATUS_SPEED_100: 242 mii->mii_media_active |= IFM_100_TX; 243 break; 244 case STATUS_SPEED_10: 245 mii->mii_media_active |= IFM_10_T; 246 break; 247 default: 248 mii->mii_media_active |= IFM_NONE; 249 return; 250 } 251 if ((physts & STATUS_FULL_DUPLEX) != 0) 252 mii->mii_media_active |= IFM_FDX | mii_phy_flowstatus(sc); 253 else 254 mii->mii_media_active |= IFM_HDX; 255 } 256
Indexes created Mon Sep 29 21:09:56 GMT 2025