1/* OpenBSD: qsphy.c,v 1.6 2000/08/26 20:04:18 nate Exp */ 2/* NetBSD: qsphy.c,v 1.19 2000/02/02 23:34:57 thorpej Exp */ 3 4/*- 5 * Copyright (c) 1998, 1999 The NetBSD Foundation, Inc. 6 * All rights reserved. 7 * 8 * This code is derived from software contributed to The NetBSD Foundation 9 * by Jason R. Thorpe of the Numerical Aerospace Simulation Facility, 10 * NASA Ames Research Center. 11 * 12 * Redistribution and use in source and binary forms, with or without 13 * modification, are permitted provided that the following conditions 14 * are met: 15 * 1. Redistributions of source code must retain the above copyright 16 * notice, this list of conditions and the following disclaimer. 17 * 2. Redistributions in binary form must reproduce the above copyright 18 * notice, this list of conditions and the following disclaimer in the 19 * documentation and/or other materials provided with the distribution. 20 * 21 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 22 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 23 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 24 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 25 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 26 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 27 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 28 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 29 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 30 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 31 * POSSIBILITY OF SUCH DAMAGE. 32 */ 33 34/*- 35 * Copyright (c) 1997 Manuel Bouyer. All rights reserved. 36 * 37 * Redistribution and use in source and binary forms, with or without 38 * modification, are permitted provided that the following conditions 39 * are met: 40 * 1. Redistributions of source code must retain the above copyright 41 * notice, this list of conditions and the following disclaimer. 42 * 2. Redistributions in binary form must reproduce the above copyright 43 * notice, this list of conditions and the following disclaimer in the 44 * documentation and/or other materials provided with the distribution. 45 * 46 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 47 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 48 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 49 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 50 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 51 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 52 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 53 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 54 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 55 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 56 */ 57 58#include <sys/cdefs.h>
|
59__FBSDID("$FreeBSD: head/sys/dev/mii/qsphy.c 213229 2010-09-27 20:31:03Z marius $");
|
59__FBSDID("$FreeBSD: head/sys/dev/mii/qsphy.c 213364 2010-10-02 18:53:12Z marius $"); |
60 61/* 62 * driver for Quality Semiconductor's QS6612 ethernet 10/100 PHY 63 * datasheet from www.qualitysemi.com 64 */ 65 66#include <sys/param.h> 67#include <sys/systm.h> 68#include <sys/kernel.h> 69#include <sys/socket.h> 70#include <sys/errno.h> 71#include <sys/module.h> 72#include <sys/bus.h> 73 74#include <net/if.h> 75#include <net/if_media.h> 76 77#include <dev/mii/mii.h> 78#include <dev/mii/miivar.h> 79#include "miidevs.h" 80 81#include <dev/mii/qsphyreg.h> 82 83#include "miibus_if.h" 84 85static int qsphy_probe(device_t); 86static int qsphy_attach(device_t); 87 88static device_method_t qsphy_methods[] = { 89 /* device interface */ 90 DEVMETHOD(device_probe, qsphy_probe), 91 DEVMETHOD(device_attach, qsphy_attach), 92 DEVMETHOD(device_detach, mii_phy_detach), 93 DEVMETHOD(device_shutdown, bus_generic_shutdown), 94 { 0, 0 } 95}; 96 97static devclass_t qsphy_devclass; 98 99static driver_t qsphy_driver = { 100 "qsphy", 101 qsphy_methods, 102 sizeof(struct mii_softc) 103}; 104 105DRIVER_MODULE(qsphy, miibus, qsphy_driver, qsphy_devclass, 0, 0); 106 107static int qsphy_service(struct mii_softc *, struct mii_data *, int); 108static void qsphy_reset(struct mii_softc *); 109static void qsphy_status(struct mii_softc *); 110 111static const struct mii_phydesc qsphys[] = { 112 MII_PHY_DESC(QUALSEMI, QS6612), 113 MII_PHY_END 114}; 115 116static int 117qsphy_probe(device_t dev) 118{ 119 120 return (mii_phy_dev_probe(dev, qsphys, BUS_PROBE_DEFAULT)); 121} 122 123static int 124qsphy_attach(device_t dev) 125{ 126 struct mii_softc *sc; 127 struct mii_attach_args *ma; 128 struct mii_data *mii; 129 130 sc = device_get_softc(dev); 131 ma = device_get_ivars(dev); 132 sc->mii_dev = device_get_parent(dev); 133 mii = ma->mii_data; 134 LIST_INSERT_HEAD(&mii->mii_phys, sc, mii_list); 135
|
136 sc->mii_inst = mii->mii_instance;
|
136 sc->mii_inst = mii->mii_instance++; |
137 sc->mii_phy = ma->mii_phyno; 138 sc->mii_service = qsphy_service; 139 sc->mii_pdata = mii; 140
|
141 mii->mii_instance++;
142
|
141 qsphy_reset(sc); 142
|
145 sc->mii_capabilities =
146 PHY_READ(sc, MII_BMSR) & ma->mii_capmask;
|
143 sc->mii_capabilities = PHY_READ(sc, MII_BMSR) & ma->mii_capmask; |
144 device_printf(dev, " "); 145 mii_phy_add_media(sc); 146 printf("\n"); 147 148 MIIBUS_MEDIAINIT(sc->mii_dev); 149 return (0); 150} 151 152static int 153qsphy_service(struct mii_softc *sc, struct mii_data *mii, int cmd) 154{
|
158 struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
159 int reg;
|
155
|
161 /*
162 * If we're not selected, then do nothing, just isolate, if
163 * changing media.
164 */
165 if (IFM_INST(ife->ifm_media) != sc->mii_inst) {
166 if (cmd == MII_MEDIACHG) {
167 reg = PHY_READ(sc, MII_BMCR);
168 PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO);
169 }
170
171 return (0);
172 }
173
|
156 switch (cmd) { 157 case MII_POLLSTAT: 158 break; 159 160 case MII_MEDIACHG: 161 /* 162 * If the interface is not up, don't do anything. 163 */ 164 if ((mii->mii_ifp->if_flags & IFF_UP) == 0) 165 break; 166 167 mii_phy_setmedia(sc); 168 break; 169 170 case MII_TICK: 171 /* 172 * Is the interface even up? 173 */ 174 if ((mii->mii_ifp->if_flags & IFF_UP) == 0) 175 return (0); 176 177 /* 178 * This PHY's autonegotiation doesn't need to be kicked. 179 */ 180 break; 181 } 182 183 /* Update the media status. */ 184 qsphy_status(sc); 185 186 /* Callback if something changed. */ 187 mii_phy_update(sc, cmd); 188 return (0); 189} 190 191static void 192qsphy_status(struct mii_softc *sc) 193{ 194 struct mii_data *mii = sc->mii_pdata; 195 int bmsr, bmcr, pctl; 196 197 mii->mii_media_status = IFM_AVALID; 198 mii->mii_media_active = IFM_ETHER; 199 200 bmsr = PHY_READ(sc, MII_BMSR) | 201 PHY_READ(sc, MII_BMSR); 202 if (bmsr & BMSR_LINK) 203 mii->mii_media_status |= IFM_ACTIVE; 204 205 bmcr = PHY_READ(sc, MII_BMCR); 206 if (bmcr & BMCR_ISO) { 207 mii->mii_media_active |= IFM_NONE; 208 mii->mii_media_status = 0; 209 return; 210 } 211 212 if (bmcr & BMCR_LOOP) 213 mii->mii_media_active |= IFM_LOOP; 214 215 pctl = PHY_READ(sc, MII_QSPHY_PCTL); 216 switch (pctl & PCTL_OPMASK) { 217 case PCTL_10_T: 218 mii->mii_media_active |= IFM_10_T; 219 break; 220 case PCTL_10_T_FDX: 221 mii->mii_media_active |= IFM_10_T|IFM_FDX; 222 break; 223 case PCTL_100_TX: 224 mii->mii_media_active |= IFM_100_TX; 225 break; 226 case PCTL_100_TX_FDX: 227 mii->mii_media_active |= IFM_100_TX|IFM_FDX; 228 break; 229 case PCTL_100_T4: 230 mii->mii_media_active |= IFM_100_T4; 231 break; 232 case PCTL_AN: 233 mii->mii_media_active |= IFM_NONE; 234 break; 235 default: 236 /* Erg... this shouldn't happen. */ 237 mii->mii_media_active |= IFM_NONE; 238 break; 239 } 240} 241 242static void 243qsphy_reset(struct mii_softc *sc) 244{ 245 246 mii_phy_reset(sc); 247 PHY_WRITE(sc, MII_QSPHY_IMASK, 0); 248}
|