LCOV - code coverage report
Current view: top level - dev/mii - iophy.c (source / functions) Hit Total Coverage
Test: 6.4 Lines: 0 79 0.0 %
Date: 2018-10-19 03:25:38 Functions: 0 4 0.0 %
Legend: Lines: hit not hit

          Line data    Source code
       1             : /*      $OpenBSD: iophy.c,v 1.20 2015/03/14 03:38:48 jsg Exp $  */
       2             : /*      $NetBSD: iophy.c,v 1.8 2000/02/02 23:34:56 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             : /*
      59             :  * Intel 82553 PHY driver
      60             :  */
      61             : 
      62             : #include <sys/param.h>
      63             : #include <sys/systm.h>
      64             : #include <sys/device.h>
      65             : #include <sys/socket.h>
      66             : 
      67             : #include <net/if.h>
      68             : #include <net/if_var.h>
      69             : #include <net/if_media.h>
      70             : 
      71             : #include <dev/mii/mii.h>
      72             : #include <dev/mii/miivar.h>
      73             : #include <dev/mii/miidevs.h>
      74             : 
      75             : #include <dev/mii/iophyreg.h>
      76             : 
      77             : int     iophymatch(struct device *, void *, void *);
      78             : void    iophyattach(struct device *, struct device *, void *);
      79             : 
      80             : struct cfattach iophy_ca = {
      81             :         sizeof(struct mii_softc), iophymatch, iophyattach, mii_phy_detach
      82             : };
      83             : 
      84             : struct cfdriver iophy_cd = {
      85             :         NULL, "iophy", DV_DULL
      86             : };
      87             : 
      88             : int     iophy_service(struct mii_softc *, struct mii_data *, int);
      89             : void    iophy_status(struct mii_softc *);
      90             : 
      91             : const struct mii_phy_funcs iophy_funcs = {
      92             :         iophy_service, iophy_status, mii_phy_reset,
      93             : };
      94             : 
      95             : static const struct mii_phydesc iophys[] = {
      96             :         { MII_OUI_xxINTEL,              MII_MODEL_xxINTEL_I82553,
      97             :           MII_STR_xxINTEL_I82553 },
      98             :         { MII_OUI_INTEL,                MII_MODEL_INTEL_I82553,
      99             :           MII_STR_INTEL_I82553 },
     100             : 
     101             :         { 0,                    0,
     102             :           NULL },
     103             : 
     104             : };
     105             : 
     106             : int
     107           0 : iophymatch(parent, match, aux)
     108             :         struct device *parent;
     109             :         void *match;
     110             :         void *aux;
     111             : {
     112           0 :         struct mii_attach_args *ma = aux;
     113             : 
     114           0 :         if (mii_phy_match(ma, iophys) != NULL)
     115           0 :                 return (10);
     116             : 
     117           0 :         return (0);
     118           0 : }
     119             : 
     120             : void
     121           0 : iophyattach(parent, self, aux)
     122             :         struct device *parent, *self;
     123             :         void *aux;
     124             : {
     125           0 :         struct mii_softc *sc = (struct mii_softc *)self;
     126           0 :         struct mii_attach_args *ma = aux;
     127           0 :         struct mii_data *mii = ma->mii_data;
     128             :         const struct mii_phydesc *mpd;
     129             : 
     130           0 :         mpd = mii_phy_match(ma, iophys);
     131           0 :         printf(": %s, rev. %d\n", mpd->mpd_name, MII_REV(ma->mii_id2));
     132             : 
     133           0 :         sc->mii_inst = mii->mii_instance;
     134           0 :         sc->mii_phy = ma->mii_phyno;
     135           0 :         sc->mii_funcs = &iophy_funcs;
     136           0 :         sc->mii_pdata = mii;
     137           0 :         sc->mii_flags = ma->mii_flags;
     138             : 
     139           0 :         PHY_RESET(sc);
     140             : 
     141           0 :         sc->mii_capabilities =
     142           0 :             PHY_READ(sc, MII_BMSR) & ma->mii_capmask;
     143           0 :         if (sc->mii_capabilities & BMSR_MEDIAMASK)
     144           0 :                 mii_phy_add_media(sc);
     145           0 : }
     146             : 
     147             : int
     148           0 : iophy_service(sc, mii, cmd)
     149             :         struct mii_softc *sc;
     150             :         struct mii_data *mii;
     151             :         int cmd;
     152             : {
     153           0 :         struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
     154             :         int reg;
     155             : 
     156           0 :         if ((sc->mii_dev.dv_flags & DVF_ACTIVE) == 0)
     157           0 :                 return (ENXIO);
     158             : 
     159           0 :         switch (cmd) {
     160             :         case MII_POLLSTAT:
     161             :                 /*
     162             :                  * If we're not polling our PHY instance, just return.
     163             :                  */
     164           0 :                 if (IFM_INST(ife->ifm_media) != sc->mii_inst)
     165           0 :                         return (0);
     166             :                 break;
     167             : 
     168             :         case MII_MEDIACHG:
     169             :                 /*
     170             :                  * If the media indicates a different PHY instance,
     171             :                  * isolate ourselves.
     172             :                  */
     173           0 :                 if (IFM_INST(ife->ifm_media) != sc->mii_inst) {
     174           0 :                         reg = PHY_READ(sc, MII_BMCR);
     175           0 :                         PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO);
     176           0 :                         return (0);
     177             :                 }
     178             : 
     179             :                 /*
     180             :                  * If the interface is not up, don't do anything.
     181             :                  */
     182           0 :                 if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
     183             :                         break;
     184             : 
     185           0 :                 mii_phy_setmedia(sc);
     186           0 :                 break;
     187             : 
     188             :         case MII_TICK:
     189             :                 /*
     190             :                  * If we're not currently selected, just return.
     191             :                  */
     192           0 :                 if (IFM_INST(ife->ifm_media) != sc->mii_inst)
     193           0 :                         return (0);
     194             : 
     195           0 :                 if (mii_phy_tick(sc) == EJUSTRETURN)
     196           0 :                         return (0);
     197             :                 break;
     198             : 
     199             :         case MII_DOWN:
     200           0 :                 mii_phy_down(sc);
     201           0 :                 return (0);
     202             :         }
     203             : 
     204             :         /* Update the media status. */
     205           0 :         mii_phy_status(sc);
     206             : 
     207             :         /* Callback if something changed. */
     208           0 :         mii_phy_update(sc, cmd);
     209           0 :         return (0);
     210           0 : }
     211             : 
     212             : void
     213           0 : iophy_status(sc)
     214             :         struct mii_softc *sc;
     215             : {
     216           0 :         struct mii_data *mii = sc->mii_pdata;
     217           0 :         struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
     218             :         int bmsr, bmcr, ext0;
     219             : 
     220           0 :         mii->mii_media_status = IFM_AVALID;
     221           0 :         mii->mii_media_active = IFM_ETHER;
     222             : 
     223           0 :         bmsr = PHY_READ(sc, MII_BMSR) |
     224           0 :             PHY_READ(sc, MII_BMSR);
     225           0 :         if (bmsr & BMSR_LINK)
     226           0 :                 mii->mii_media_status |= IFM_ACTIVE;
     227             : 
     228           0 :         bmcr = PHY_READ(sc, MII_BMCR);
     229           0 :         if (bmcr & BMCR_ISO) {
     230           0 :                 mii->mii_media_active |= IFM_NONE;
     231           0 :                 mii->mii_media_status = 0;
     232           0 :                 return;
     233             :         }
     234             : 
     235           0 :         if (bmcr & BMCR_LOOP)
     236           0 :                 mii->mii_media_active |= IFM_LOOP;
     237             : 
     238           0 :         if (bmcr & BMCR_AUTOEN) {
     239           0 :                 if ((bmsr & BMSR_ACOMP) == 0) {
     240             :                         /* Erg, still trying, I guess... */
     241           0 :                         mii->mii_media_active |= IFM_NONE;
     242           0 :                         return;
     243             :                 }
     244             : 
     245           0 :                 ext0 = PHY_READ(sc, MII_IOPHY_EXT0);
     246           0 :                 if (ext0 & EXT0_SPEED) {
     247           0 :                         if (bmsr & BMSR_100TXFDX ||
     248           0 :                             bmsr & BMSR_100TXHDX)
     249           0 :                                 mii->mii_media_active |= IFM_100_TX;
     250             :                         else
     251           0 :                                 mii->mii_media_active |= IFM_100_T4;
     252             :                 } else
     253           0 :                         mii->mii_media_active |= IFM_10_T;
     254             : 
     255           0 :                 if (ext0 & EXT0_DUPLEX)
     256           0 :                         mii->mii_media_active |= IFM_FDX;
     257             :                 else
     258           0 :                         mii->mii_media_active |= IFM_HDX;
     259             :         } else
     260           0 :                 mii->mii_media_active = ife->ifm_media;
     261           0 : }

Generated by: LCOV version 1.13