bmtphy.c (215716) | bmtphy.c (215720) |
---|---|
1/*- 2 * Copyright (c) 1998, 1999, 2000, 2001 The NetBSD Foundation, Inc. 3 * All rights reserved. 4 * 5 * This code is derived from software contributed to The NetBSD Foundation 6 * by Jason R. Thorpe of the Numerical Aerospace Simulation Facility, 7 * NASA Ames Research Center. 8 * --- 42 unchanged lines hidden (view full) --- 51 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 52 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 53 * 54 * from: NetBSD: bmtphy.c,v 1.8 2002/07/03 06:25:50 simonb Exp 55 * 56 */ 57 58#include <sys/cdefs.h> | 1/*- 2 * Copyright (c) 1998, 1999, 2000, 2001 The NetBSD Foundation, Inc. 3 * All rights reserved. 4 * 5 * This code is derived from software contributed to The NetBSD Foundation 6 * by Jason R. Thorpe of the Numerical Aerospace Simulation Facility, 7 * NASA Ames Research Center. 8 * --- 42 unchanged lines hidden (view full) --- 51 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 52 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 53 * 54 * from: NetBSD: bmtphy.c,v 1.8 2002/07/03 06:25:50 simonb Exp 55 * 56 */ 57 58#include <sys/cdefs.h> |
59__FBSDID("$FreeBSD: head/sys/dev/mii/bmtphy.c 215716 2010-11-22 21:24:29Z marius $"); | 59__FBSDID("$FreeBSD: head/sys/dev/mii/bmtphy.c 215720 2010-11-22 22:03:11Z marius $"); |
60 61/* 62 * Driver for the Broadcom BCM5201/BCM5202 "Mini-Theta" PHYs. This also 63 * drives the PHY on the 3Com 3c905C. The 3c905C's PHY is described in 64 * the 3c905C data sheet. 65 */ 66 67#include <sys/param.h> --- 12 unchanged lines hidden (view full) --- 80 81#include <dev/mii/bmtphyreg.h> 82 83#include "miibus_if.h" 84 85static int bmtphy_probe(device_t); 86static int bmtphy_attach(device_t); 87 | 60 61/* 62 * Driver for the Broadcom BCM5201/BCM5202 "Mini-Theta" PHYs. This also 63 * drives the PHY on the 3Com 3c905C. The 3c905C's PHY is described in 64 * the 3c905C data sheet. 65 */ 66 67#include <sys/param.h> --- 12 unchanged lines hidden (view full) --- 80 81#include <dev/mii/bmtphyreg.h> 82 83#include "miibus_if.h" 84 85static int bmtphy_probe(device_t); 86static int bmtphy_attach(device_t); 87 |
88struct bmtphy_softc { 89 struct mii_softc mii_sc; 90 int mii_model; 91}; 92 |
|
88static device_method_t bmtphy_methods[] = { 89 /* Device interface */ 90 DEVMETHOD(device_probe, bmtphy_probe), 91 DEVMETHOD(device_attach, bmtphy_attach), 92 DEVMETHOD(device_detach, mii_phy_detach), 93 DEVMETHOD(device_shutdown, bus_generic_shutdown), 94 95 { 0, 0 } 96}; 97 98static devclass_t bmtphy_devclass; 99 100static driver_t bmtphy_driver = { 101 "bmtphy", 102 bmtphy_methods, | 93static device_method_t bmtphy_methods[] = { 94 /* Device interface */ 95 DEVMETHOD(device_probe, bmtphy_probe), 96 DEVMETHOD(device_attach, bmtphy_attach), 97 DEVMETHOD(device_detach, mii_phy_detach), 98 DEVMETHOD(device_shutdown, bus_generic_shutdown), 99 100 { 0, 0 } 101}; 102 103static devclass_t bmtphy_devclass; 104 105static driver_t bmtphy_driver = { 106 "bmtphy", 107 bmtphy_methods, |
103 sizeof(struct mii_softc) | 108 sizeof(struct bmtphy_softc) |
104}; 105 106DRIVER_MODULE(bmtphy, miibus, bmtphy_driver, bmtphy_devclass, 0, 0); 107 108static int bmtphy_service(struct mii_softc *, struct mii_data *, int); 109static void bmtphy_status(struct mii_softc *); | 109}; 110 111DRIVER_MODULE(bmtphy, miibus, bmtphy_driver, bmtphy_devclass, 0, 0); 112 113static int bmtphy_service(struct mii_softc *, struct mii_data *, int); 114static void bmtphy_status(struct mii_softc *); |
115static void bmtphy_reset(struct mii_softc *); |
|
110 111static const struct mii_phydesc bmtphys_dp[] = { 112 MII_PHY_DESC(BROADCOM, BCM4401), 113 MII_PHY_DESC(BROADCOM, BCM5201), | 116 117static const struct mii_phydesc bmtphys_dp[] = { 118 MII_PHY_DESC(BROADCOM, BCM4401), 119 MII_PHY_DESC(BROADCOM, BCM5201), |
120 MII_PHY_DESC(BROADCOM, BCM5214), |
|
114 MII_PHY_DESC(BROADCOM, BCM5221), | 121 MII_PHY_DESC(BROADCOM, BCM5221), |
122 MII_PHY_DESC(BROADCOM, BCM5222), |
|
115 MII_PHY_END 116}; 117 118static const struct mii_phydesc bmtphys_lp[] = { 119 MII_PHY_DESC(BROADCOM, 3C905B), 120 MII_PHY_DESC(BROADCOM, 3C905C), 121 MII_PHY_END 122}; --- 9 unchanged lines hidden (view full) --- 132 return (rval); 133 134 return (mii_phy_dev_probe(dev, bmtphys_dp, BUS_PROBE_DEFAULT)); 135} 136 137static int 138bmtphy_attach(device_t dev) 139{ | 123 MII_PHY_END 124}; 125 126static const struct mii_phydesc bmtphys_lp[] = { 127 MII_PHY_DESC(BROADCOM, 3C905B), 128 MII_PHY_DESC(BROADCOM, 3C905C), 129 MII_PHY_END 130}; --- 9 unchanged lines hidden (view full) --- 140 return (rval); 141 142 return (mii_phy_dev_probe(dev, bmtphys_dp, BUS_PROBE_DEFAULT)); 143} 144 145static int 146bmtphy_attach(device_t dev) 147{ |
140 struct mii_softc *sc; 141 struct mii_attach_args *ma; 142 struct mii_data *mii; | 148 struct bmtphy_softc *bsc; 149 struct mii_softc *sc; 150 struct mii_attach_args *ma; 151 struct mii_data *mii; |
143 | 152 |
144 sc = device_get_softc(dev); | 153 bsc = device_get_softc(dev); 154 sc = &bsc->mii_sc; |
145 ma = device_get_ivars(dev); 146 sc->mii_dev = device_get_parent(dev); 147 mii = ma->mii_data; 148 LIST_INSERT_HEAD(&mii->mii_phys, sc, mii_list); 149 150 sc->mii_flags = miibus_get_flags(dev); 151 sc->mii_inst = mii->mii_instance++; 152 sc->mii_phy = ma->mii_phyno; 153 sc->mii_service = bmtphy_service; 154 sc->mii_pdata = mii; 155 156 sc->mii_flags |= MIIF_NOMANPAUSE; 157 | 155 ma = device_get_ivars(dev); 156 sc->mii_dev = device_get_parent(dev); 157 mii = ma->mii_data; 158 LIST_INSERT_HEAD(&mii->mii_phys, sc, mii_list); 159 160 sc->mii_flags = miibus_get_flags(dev); 161 sc->mii_inst = mii->mii_instance++; 162 sc->mii_phy = ma->mii_phyno; 163 sc->mii_service = bmtphy_service; 164 sc->mii_pdata = mii; 165 166 sc->mii_flags |= MIIF_NOMANPAUSE; 167 |
158 mii_phy_reset(sc); | 168 bsc->mii_model = MII_MODEL(ma->mii_id2); |
159 | 169 |
170 bmtphy_reset(sc); 171 |
|
160 sc->mii_capabilities = PHY_READ(sc, MII_BMSR) & ma->mii_capmask; 161 device_printf(dev, " "); 162 mii_phy_add_media(sc); 163 printf("\n"); 164 165 MIIBUS_MEDIAINIT(sc->mii_dev); 166 167 return (0); --- 23 unchanged lines hidden (view full) --- 191 break; 192 } 193 194 /* Update the media status. */ 195 bmtphy_status(sc); 196 197 /* Callback if something changed. */ 198 mii_phy_update(sc, cmd); | 172 sc->mii_capabilities = PHY_READ(sc, MII_BMSR) & ma->mii_capmask; 173 device_printf(dev, " "); 174 mii_phy_add_media(sc); 175 printf("\n"); 176 177 MIIBUS_MEDIAINIT(sc->mii_dev); 178 179 return (0); --- 23 unchanged lines hidden (view full) --- 203 break; 204 } 205 206 /* Update the media status. */ 207 bmtphy_status(sc); 208 209 /* Callback if something changed. */ 210 mii_phy_update(sc, cmd); |
199 | |
200 return (0); 201} 202 203static void 204bmtphy_status(struct mii_softc *sc) 205{ | 211 return (0); 212} 213 214static void 215bmtphy_status(struct mii_softc *sc) 216{ |
206 struct mii_data *mii; 207 struct ifmedia_entry *ife; 208 int bmsr, bmcr, aux_csr; | 217 struct mii_data *mii; 218 struct ifmedia_entry *ife; 219 int bmsr, bmcr, aux_csr; |
209 210 mii = sc->mii_pdata; 211 ife = mii->mii_media.ifm_cur; 212 213 mii->mii_media_status = IFM_AVALID; 214 mii->mii_media_active = IFM_ETHER; 215 216 bmsr = PHY_READ(sc, MII_BMSR) | PHY_READ(sc, MII_BMSR); | 220 221 mii = sc->mii_pdata; 222 ife = mii->mii_media.ifm_cur; 223 224 mii->mii_media_status = IFM_AVALID; 225 mii->mii_media_active = IFM_ETHER; 226 227 bmsr = PHY_READ(sc, MII_BMSR) | PHY_READ(sc, MII_BMSR); |
217 aux_csr = PHY_READ(sc, MII_BMTPHY_AUX_CSR); | |
218 219 if (bmsr & BMSR_LINK) 220 mii->mii_media_status |= IFM_ACTIVE; 221 222 bmcr = PHY_READ(sc, MII_BMCR); 223 if (bmcr & BMCR_ISO) { 224 mii->mii_media_active |= IFM_NONE; 225 mii->mii_media_status = 0; --- 9 unchanged lines hidden (view full) --- 235 * has completed (or it's disabled). 236 */ 237 if ((bmsr & BMSR_ACOMP) == 0) { 238 /* Erg, still trying, I guess... */ 239 mii->mii_media_active |= IFM_NONE; 240 return; 241 } 242 | 228 229 if (bmsr & BMSR_LINK) 230 mii->mii_media_status |= IFM_ACTIVE; 231 232 bmcr = PHY_READ(sc, MII_BMCR); 233 if (bmcr & BMCR_ISO) { 234 mii->mii_media_active |= IFM_NONE; 235 mii->mii_media_status = 0; --- 9 unchanged lines hidden (view full) --- 245 * has completed (or it's disabled). 246 */ 247 if ((bmsr & BMSR_ACOMP) == 0) { 248 /* Erg, still trying, I guess... */ 249 mii->mii_media_active |= IFM_NONE; 250 return; 251 } 252 |
253 aux_csr = PHY_READ(sc, MII_BMTPHY_AUX_CSR); |
|
243 if (aux_csr & AUX_CSR_SPEED) 244 mii->mii_media_active |= IFM_100_TX; 245 else 246 mii->mii_media_active |= IFM_10_T; 247 if (aux_csr & AUX_CSR_FDX) 248 mii->mii_media_active |= 249 IFM_FDX | mii_phy_flowstatus(sc); 250 else 251 mii->mii_media_active |= IFM_HDX; 252 } else 253 mii->mii_media_active = ife->ifm_media; 254} | 254 if (aux_csr & AUX_CSR_SPEED) 255 mii->mii_media_active |= IFM_100_TX; 256 else 257 mii->mii_media_active |= IFM_10_T; 258 if (aux_csr & AUX_CSR_FDX) 259 mii->mii_media_active |= 260 IFM_FDX | mii_phy_flowstatus(sc); 261 else 262 mii->mii_media_active |= IFM_HDX; 263 } else 264 mii->mii_media_active = ife->ifm_media; 265} |
266 267static void 268bmtphy_reset(struct mii_softc *sc) 269{ 270 struct bmtphy_softc *bsc; 271 u_int16_t data; 272 273 bsc = (struct bmtphy_softc *)sc; 274 275 mii_phy_reset(sc); 276 277 if (bsc->mii_model == MII_MODEL_BROADCOM_BCM5221) { 278 /* Enable shadow register mode. */ 279 data = PHY_READ(sc, 0x1f); 280 PHY_WRITE(sc, 0x1f, data | 0x0080); 281 282 /* Enable APD (Auto PowerDetect). */ 283 data = PHY_READ(sc, MII_BMTPHY_AUX2); 284 PHY_WRITE(sc, MII_BMTPHY_AUX2, data | 0x0020); 285 286 /* Enable clocks across APD for Auto-MDIX functionality. */ 287 data = PHY_READ(sc, MII_BMTPHY_INTR); 288 PHY_WRITE(sc, MII_BMTPHY_INTR, data | 0x0004); 289 290 /* Disable shadow register mode. */ 291 data = PHY_READ(sc, 0x1f); 292 PHY_WRITE(sc, 0x1f, data & ~0x0080); 293 } 294} |
|