The Design and Implementation of the FreeBSD Operating System, Second Edition
Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]

FreeBSD/Linux Kernel Cross Reference
sys/arm/allwinner/aw_gmacclk.c

Version: -  FREEBSD  -  FREEBSD-13-STABLE  -  FREEBSD-13-0  -  FREEBSD-12-STABLE  -  FREEBSD-12-0  -  FREEBSD-11-STABLE  -  FREEBSD-11-0  -  FREEBSD-10-STABLE  -  FREEBSD-10-0  -  FREEBSD-9-STABLE  -  FREEBSD-9-0  -  FREEBSD-8-STABLE  -  FREEBSD-8-0  -  FREEBSD-7-STABLE  -  FREEBSD-7-0  -  FREEBSD-6-STABLE  -  FREEBSD-6-0  -  FREEBSD-5-STABLE  -  FREEBSD-5-0  -  FREEBSD-4-STABLE  -  FREEBSD-3-STABLE  -  FREEBSD22  -  l41  -  OPENBSD  -  linux-2.6  -  MK84  -  PLAN9  -  xnu-8792 
SearchContext: -  none  -  3  -  10 

    1 /*-
    2  * Copyright (c) 2016 Jared McNeill <jmcneill@invisible.ca>
    3  *
    4  * Redistribution and use in source and binary forms, with or without
    5  * modification, are permitted provided that the following conditions
    6  * are met:
    7  * 1. Redistributions of source code must retain the above copyright
    8  *    notice, this list of conditions and the following disclaimer.
    9  * 2. Redistributions in binary form must reproduce the above copyright
   10  *    notice, this list of conditions and the following disclaimer in the
   11  *    documentation and/or other materials provided with the distribution.
   12  *
   13  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
   14  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
   15  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
   16  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
   17  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
   18  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
   19  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
   20  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
   21  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
   22  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
   23  * SUCH DAMAGE.
   24  *
   25  * $FreeBSD$
   26  */
   27 
   28 /*
   29  * Allwinner GMAC clock
   30  */
   31 
   32 #include <sys/cdefs.h>
   33 __FBSDID("$FreeBSD$");
   34 
   35 #include <sys/param.h>
   36 #include <sys/systm.h>
   37 #include <sys/bus.h>
   38 #include <sys/rman.h>
   39 #include <sys/kernel.h>
   40 #include <sys/module.h>
   41 #include <machine/bus.h>
   42 
   43 #include <dev/ofw/ofw_bus.h>
   44 #include <dev/ofw/ofw_bus_subr.h>
   45 #include <dev/ofw/ofw_subr.h>
   46 
   47 #include <dev/extres/clk/clk_mux.h>
   48 #include <dev/extres/clk/clk_gate.h>
   49 
   50 #include "clkdev_if.h"
   51 
   52 #define GMAC_CLK_PIT            (0x1 << 2)
   53 #define GMAC_CLK_PIT_SHIFT      2
   54 #define GMAC_CLK_PIT_MII        0
   55 #define GMAC_CLK_PIT_RGMII      1
   56 #define GMAC_CLK_SRC            (0x3 << 0)
   57 #define GMAC_CLK_SRC_SHIFT      0
   58 #define GMAC_CLK_SRC_MII        0
   59 #define GMAC_CLK_SRC_EXT_RGMII  1
   60 #define GMAC_CLK_SRC_RGMII      2
   61 
   62 #define EMAC_TXC_DIV_CFG        (1 << 15)
   63 #define EMAC_TXC_DIV_CFG_SHIFT  15
   64 #define EMAC_TXC_DIV_CFG_125MHZ 0
   65 #define EMAC_TXC_DIV_CFG_25MHZ  1
   66 #define EMAC_PHY_SELECT         (1 << 16)
   67 #define EMAC_PHY_SELECT_SHIFT   16
   68 #define EMAC_PHY_SELECT_INT     0
   69 #define EMAC_PHY_SELECT_EXT     1
   70 #define EMAC_ETXDC              (0x7 << 10)
   71 #define EMAC_ETXDC_SHIFT        10
   72 #define EMAC_ERXDC              (0x1f << 5)
   73 #define EMAC_ERXDC_SHIFT        5
   74 
   75 #define CLK_IDX_MII             0
   76 #define CLK_IDX_RGMII           1
   77 #define CLK_IDX_COUNT           2
   78 
   79 static struct ofw_compat_data compat_data[] = {
   80         { "allwinner,sun7i-a20-gmac-clk",       1 },
   81         { NULL, 0 }
   82 };
   83 
   84 struct aw_gmacclk_sc {
   85         device_t        clkdev;
   86         bus_addr_t      reg;
   87 
   88         int             rx_delay;
   89         int             tx_delay;
   90 };
   91 
   92 #define GMACCLK_READ(sc, val)   CLKDEV_READ_4((sc)->clkdev, (sc)->reg, (val))
   93 #define GMACCLK_WRITE(sc, val)  CLKDEV_WRITE_4((sc)->clkdev, (sc)->reg, (val))
   94 #define DEVICE_LOCK(sc)         CLKDEV_DEVICE_LOCK((sc)->clkdev)
   95 #define DEVICE_UNLOCK(sc)       CLKDEV_DEVICE_UNLOCK((sc)->clkdev)
   96 
   97 static int
   98 aw_gmacclk_init(struct clknode *clk, device_t dev)
   99 {
  100         struct aw_gmacclk_sc *sc;
  101         uint32_t val, index;
  102 
  103         sc = clknode_get_softc(clk);
  104 
  105         DEVICE_LOCK(sc);
  106         GMACCLK_READ(sc, &val);
  107         DEVICE_UNLOCK(sc);
  108 
  109         switch ((val & GMAC_CLK_SRC) >> GMAC_CLK_SRC_SHIFT) {
  110         case GMAC_CLK_SRC_MII:
  111                 index = CLK_IDX_MII;
  112                 break;
  113         case GMAC_CLK_SRC_RGMII:
  114                 index = CLK_IDX_RGMII;
  115                 break;
  116         default:
  117                 return (ENXIO);
  118         }
  119 
  120         clknode_init_parent_idx(clk, index);
  121         return (0);
  122 }
  123 
  124 static int
  125 aw_gmacclk_set_mux(struct clknode *clk, int index)
  126 {
  127         struct aw_gmacclk_sc *sc;
  128         uint32_t val, clk_src, pit;
  129 
  130         sc = clknode_get_softc(clk);
  131 
  132         switch (index) {
  133         case CLK_IDX_MII:
  134                 clk_src = GMAC_CLK_SRC_MII;
  135                 pit = GMAC_CLK_PIT_MII;
  136                 break;
  137         case CLK_IDX_RGMII:
  138                 clk_src = GMAC_CLK_SRC_RGMII;
  139                 pit = GMAC_CLK_PIT_RGMII;
  140                 break;
  141         default:
  142                 return (ENXIO);
  143         }
  144 
  145         DEVICE_LOCK(sc);
  146         GMACCLK_READ(sc, &val);
  147         val &= ~(GMAC_CLK_SRC | GMAC_CLK_PIT);
  148         val |= (clk_src << GMAC_CLK_SRC_SHIFT);
  149         val |= (pit << GMAC_CLK_PIT_SHIFT);
  150         GMACCLK_WRITE(sc, val);
  151         DEVICE_UNLOCK(sc);
  152 
  153         return (0);
  154 }
  155 
  156 static clknode_method_t aw_gmacclk_clknode_methods[] = {
  157         /* Device interface */
  158         CLKNODEMETHOD(clknode_init,             aw_gmacclk_init),
  159         CLKNODEMETHOD(clknode_set_mux,          aw_gmacclk_set_mux),
  160         CLKNODEMETHOD_END
  161 };
  162 DEFINE_CLASS_1(aw_gmacclk_clknode, aw_gmacclk_clknode_class,
  163     aw_gmacclk_clknode_methods, sizeof(struct aw_gmacclk_sc), clknode_class);
  164 
  165 static int
  166 aw_gmacclk_probe(device_t dev)
  167 {
  168         if (!ofw_bus_status_okay(dev))
  169                 return (ENXIO);
  170 
  171         if (ofw_bus_search_compatible(dev, compat_data)->ocd_data == 0)
  172                 return (ENXIO);
  173 
  174         device_set_desc(dev, "Allwinner GMAC Clock");
  175         return (BUS_PROBE_DEFAULT);
  176 }
  177 
  178 static int
  179 aw_gmacclk_attach(device_t dev)
  180 {
  181         struct clknode_init_def def;
  182         struct aw_gmacclk_sc *sc;
  183         struct clkdom *clkdom;
  184         struct clknode *clk;
  185         clk_t clk_parent;
  186         bus_addr_t paddr;
  187         bus_size_t psize;
  188         phandle_t node;
  189         int error, ncells, i;
  190 
  191         node = ofw_bus_get_node(dev);
  192 
  193         if (ofw_reg_to_paddr(node, 0, &paddr, &psize, NULL) != 0) {
  194                 device_printf(dev, "cannot parse 'reg' property\n");
  195                 return (ENXIO);
  196         }
  197 
  198         error = ofw_bus_parse_xref_list_get_length(node, "clocks",
  199             "#clock-cells", &ncells);
  200         if (error != 0 || ncells != CLK_IDX_COUNT) {
  201                 device_printf(dev, "couldn't find parent clocks\n");
  202                 return (ENXIO);
  203         }
  204 
  205         clkdom = clkdom_create(dev);
  206 
  207         memset(&def, 0, sizeof(def));
  208         error = clk_parse_ofw_clk_name(dev, node, &def.name);
  209         if (error != 0) {
  210                 device_printf(dev, "cannot parse clock name\n");
  211                 error = ENXIO;
  212                 goto fail;
  213         }
  214         def.id = 1;
  215         def.parent_names = malloc(sizeof(char *) * ncells, M_OFWPROP, M_WAITOK);
  216         for (i = 0; i < ncells; i++) {
  217                 error = clk_get_by_ofw_index(dev, 0, i, &clk_parent);
  218                 if (error != 0) {
  219                         device_printf(dev, "cannot get clock %d\n", error);
  220                         goto fail;
  221                 }
  222                 def.parent_names[i] = clk_get_name(clk_parent);
  223                 clk_release(clk_parent);
  224         }
  225         def.parent_cnt = ncells;
  226 
  227         clk = clknode_create(clkdom, &aw_gmacclk_clknode_class, &def);
  228         if (clk == NULL) {
  229                 device_printf(dev, "cannot create clknode\n");
  230                 error = ENXIO;
  231                 goto fail;
  232         }
  233 
  234         sc = clknode_get_softc(clk);
  235         sc->reg = paddr;
  236         sc->clkdev = device_get_parent(dev);
  237         sc->tx_delay = sc->rx_delay = -1;
  238         OF_getencprop(node, "tx-delay", &sc->tx_delay, sizeof(sc->tx_delay));
  239         OF_getencprop(node, "rx-delay", &sc->rx_delay, sizeof(sc->rx_delay));
  240 
  241         clknode_register(clkdom, clk);
  242 
  243         if (clkdom_finit(clkdom) != 0) {
  244                 device_printf(dev, "cannot finalize clkdom initialization\n");
  245                 error = ENXIO;
  246                 goto fail;
  247         }
  248 
  249         if (bootverbose)
  250                 clkdom_dump(clkdom);
  251 
  252         return (0);
  253 
  254 fail:
  255         return (error);
  256 }
  257 
  258 static device_method_t aw_gmacclk_methods[] = {
  259         /* Device interface */
  260         DEVMETHOD(device_probe,         aw_gmacclk_probe),
  261         DEVMETHOD(device_attach,        aw_gmacclk_attach),
  262 
  263         DEVMETHOD_END
  264 };
  265 
  266 static driver_t aw_gmacclk_driver = {
  267         "aw_gmacclk",
  268         aw_gmacclk_methods,
  269         0
  270 };
  271 
  272 EARLY_DRIVER_MODULE(aw_gmacclk, simplebus, aw_gmacclk_driver, 0, 0,
  273     BUS_PASS_RESOURCE + BUS_PASS_ORDER_MIDDLE);

Cache object: a237d03d21df8c14ca06f5931f87c9b0


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]


This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.