LCOV - code coverage report
Current view: top level - dev/mii - tqphy.c (source / functions) Hit Total Coverage
Test: 6.4 Lines: 0 77 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: tqphy.c,v 1.18 2015/03/14 03:38:48 jsg Exp $  */
       2             : /*      $NetBSD: tqphy.c,v 1.9 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             : /*
      59             :  * TDK TSC78Q2120 PHY driver
      60             :  *
      61             :  * Documentation available at http://www.tsc.tdk.com/lan/78Q2120.pdf .
      62             :  */
      63             : 
      64             : #include <sys/param.h>
      65             : #include <sys/systm.h>
      66             : #include <sys/device.h>
      67             : #include <sys/socket.h>
      68             : 
      69             : #include <net/if.h>
      70             : #include <net/if_var.h>
      71             : #include <net/if_media.h>
      72             : 
      73             : #include <dev/mii/mii.h>
      74             : #include <dev/mii/miivar.h>
      75             : #include <dev/mii/miidevs.h>
      76             : 
      77             : #include <dev/mii/tqphyreg.h>
      78             : 
      79             : int     tqphymatch(struct device *, void *, void *);
      80             : void    tqphyattach(struct device *, struct device *, void *);
      81             : int     tqphydetach(struct device *, int);
      82             : 
      83             : struct cfattach tqphy_ca = {
      84             :         sizeof(struct mii_softc), tqphymatch, tqphyattach, mii_phy_detach
      85             : };
      86             : 
      87             : struct cfdriver tqphy_cd = {
      88             :         NULL, "tqphy", DV_DULL
      89             : };
      90             : 
      91             : int     tqphy_service(struct mii_softc *, struct mii_data *, int);
      92             : void    tqphy_status(struct mii_softc *);
      93             : 
      94             : const struct mii_phy_funcs tqphy_funcs = {
      95             :         tqphy_service, tqphy_status, mii_phy_reset,
      96             : };
      97             : 
      98             : static const struct mii_phydesc tqphys[] = {
      99             :         { MII_OUI_TDK,          MII_MODEL_TDK_78Q2120,
     100             :           MII_STR_TDK_78Q2120 },
     101             : 
     102             :         { 0,                    0,
     103             :           NULL },
     104             : };
     105             : 
     106             : int
     107           0 : tqphymatch(struct device *parent, void *match, void *aux)
     108             : {
     109           0 :         struct mii_attach_args *ma = aux;
     110             : 
     111           0 :         if (mii_phy_match(ma, tqphys) != NULL)
     112           0 :                 return (10);
     113             : 
     114           0 :         return (0);
     115           0 : }
     116             : 
     117             : void
     118           0 : tqphyattach(struct device *parent, struct device *self, void *aux)
     119             : {
     120           0 :         struct mii_softc *sc = (struct mii_softc *)self;
     121           0 :         struct mii_attach_args *ma = aux;
     122           0 :         struct mii_data *mii = ma->mii_data;
     123             :         const struct mii_phydesc *mpd;
     124             : 
     125           0 :         mpd = mii_phy_match(ma, tqphys);
     126           0 :         printf(": %s, rev. %d\n", mpd->mpd_name, MII_REV(ma->mii_id2));
     127             : 
     128           0 :         sc->mii_inst = mii->mii_instance;
     129           0 :         sc->mii_phy = ma->mii_phyno;
     130           0 :         sc->mii_funcs = &tqphy_funcs;
     131           0 :         sc->mii_pdata = mii;
     132           0 :         sc->mii_flags = ma->mii_flags;
     133             : 
     134           0 :         sc->mii_flags |= MIIF_NOLOOP;
     135             : 
     136           0 :         PHY_RESET(sc);
     137             : 
     138           0 :         sc->mii_capabilities =
     139           0 :             PHY_READ(sc, MII_BMSR) & ma->mii_capmask;
     140           0 :         if (sc->mii_capabilities & BMSR_MEDIAMASK)
     141           0 :                 mii_phy_add_media(sc);
     142           0 : }
     143             : 
     144             : int
     145           0 : tqphy_service(struct mii_softc *sc, struct mii_data *mii, int cmd)
     146             : {
     147           0 :         struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
     148             :         int reg;
     149             : 
     150           0 :         if ((sc->mii_dev.dv_flags & DVF_ACTIVE) == 0)
     151           0 :                 return (ENXIO);
     152             : 
     153           0 :         switch (cmd) {
     154             :         case MII_POLLSTAT:
     155             :                 /*
     156             :                  * If we're not polling our PHY instance, just return.
     157             :                  */
     158           0 :                 if (IFM_INST(ife->ifm_media) != sc->mii_inst)
     159           0 :                         return (0);
     160             :                 break;
     161             : 
     162             :         case MII_MEDIACHG:
     163             :                 /*
     164             :                  * If the media indicates a different PHY instance,
     165             :                  * isolate ourselves.
     166             :                  */
     167           0 :                 if (IFM_INST(ife->ifm_media) != sc->mii_inst) {
     168           0 :                         reg = PHY_READ(sc, MII_BMCR);
     169           0 :                         PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO);
     170           0 :                         return (0);
     171             :                 }
     172             : 
     173             :                 /*
     174             :                  * If the interface is not up, don't do anything.
     175             :                  */
     176           0 :                 if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
     177             :                         break;
     178             : 
     179           0 :                 mii_phy_setmedia(sc);
     180           0 :                 break;
     181             : 
     182             :         case MII_TICK:
     183             :                 /*
     184             :                  * If we're not currently selected, just return.
     185             :                  */
     186           0 :                 if (IFM_INST(ife->ifm_media) != sc->mii_inst)
     187           0 :                         return (0);
     188             : 
     189           0 :                 if (mii_phy_tick(sc) == EJUSTRETURN)
     190           0 :                         return (0);
     191             :                 break;
     192             : 
     193             :         case MII_DOWN:
     194           0 :                 mii_phy_down(sc);
     195           0 :                 return (0);
     196             :         }
     197             : 
     198             :         /* Update the media status. */
     199           0 :         mii_phy_status(sc);
     200             : 
     201             :         /* Callback if something changed. */
     202           0 :         mii_phy_update(sc, cmd);
     203           0 :         return (0);
     204           0 : }
     205             : 
     206             : void
     207           0 : tqphy_status(struct mii_softc *sc)
     208             : {
     209           0 :         struct mii_data *mii = sc->mii_pdata;
     210           0 :         struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
     211             :         int bmsr, bmcr, diag;
     212             : 
     213           0 :         mii->mii_media_status = IFM_AVALID;
     214           0 :         mii->mii_media_active = IFM_ETHER;
     215             : 
     216           0 :         bmsr = PHY_READ(sc, MII_BMSR) |
     217           0 :             PHY_READ(sc, MII_BMSR);
     218           0 :         if (bmsr & BMSR_LINK)
     219           0 :                 mii->mii_media_status |= IFM_ACTIVE;
     220             : 
     221           0 :         bmcr = PHY_READ(sc, MII_BMCR);
     222           0 :         if (bmcr & BMCR_ISO) {
     223           0 :                 mii->mii_media_active |= IFM_NONE;
     224           0 :                 mii->mii_media_status = 0;
     225           0 :                 return;
     226             :         }
     227             : 
     228           0 :         if (bmcr & BMCR_LOOP)
     229           0 :                 mii->mii_media_active |= IFM_LOOP;
     230             : 
     231           0 :         if (bmcr & BMCR_AUTOEN) {
     232           0 :                 if ((bmsr & BMSR_ACOMP) == 0) {
     233             :                         /* Erg, still trying, I guess... */
     234           0 :                         mii->mii_media_active |= IFM_NONE;
     235           0 :                         return;
     236             :                 }
     237           0 :                 diag = PHY_READ(sc, MII_TQPHY_DIAG);
     238           0 :                 if (diag & DIAG_RATE)
     239           0 :                         mii->mii_media_active |= IFM_100_TX;
     240             :                 else
     241           0 :                         mii->mii_media_active |= IFM_10_T;
     242             : 
     243           0 :                 if (diag & DIAG_DPLX)
     244           0 :                         mii->mii_media_active |= IFM_FDX;
     245             :                 else
     246           0 :                         mii->mii_media_active |= IFM_HDX;
     247             :         } else
     248           0 :                 mii->mii_media_active = ife->ifm_media;
     249           0 : }

Generated by: LCOV version 1.13