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/xilinx/zy7_devcfg.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) 2013 Thomas Skibo
    3  * All rights reserved.
    4  *
    5  * Redistribution and use in source and binary forms, with or without
    6  * modification, are permitted provided that the following conditions
    7  * are met:
    8  * 1. Redistributions of source code must retain the above copyright
    9  *    notice, this list of conditions and the following disclaimer.
   10  * 2. Redistributions in binary form must reproduce the above copyright
   11  *    notice, this list of conditions and the following disclaimer in the
   12  *    documentation and/or other materials provided with the distribution.
   13  *
   14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
   15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
   16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
   17  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
   18  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
   19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
   20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
   21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
   22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
   23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
   24  * SUCH DAMAGE.
   25  *
   26  * $FreeBSD: releng/10.2/sys/arm/xilinx/zy7_devcfg.c 266379 2014-05-17 23:25:20Z ian $
   27  */
   28 
   29 /* 
   30  * Zynq-7000 Devcfg driver.  This allows programming the PL (FPGA) section
   31  * of Zynq.
   32  *
   33  * Reference: Zynq-7000 All Programmable SoC Technical Reference Manual.
   34  * (v1.4) November 16, 2012.  Xilinx doc UG585.  PL Configuration is
   35  * covered in section 6.4.5.
   36  */
   37 
   38 #include <sys/cdefs.h>
   39 __FBSDID("$FreeBSD: releng/10.2/sys/arm/xilinx/zy7_devcfg.c 266379 2014-05-17 23:25:20Z ian $");
   40 
   41 #include <sys/param.h>
   42 #include <sys/systm.h>
   43 #include <sys/conf.h>
   44 #include <sys/kernel.h>
   45 #include <sys/module.h>
   46 #include <sys/sysctl.h>
   47 #include <sys/lock.h>
   48 #include <sys/mutex.h>
   49 #include <sys/resource.h>
   50 #include <sys/rman.h>
   51 #include <sys/uio.h>
   52 
   53 #include <machine/bus.h>
   54 #include <machine/resource.h>
   55 #include <machine/stdarg.h>
   56 
   57 #include <dev/fdt/fdt_common.h>
   58 #include <dev/ofw/ofw_bus.h>
   59 #include <dev/ofw/ofw_bus_subr.h>
   60 
   61 #include <arm/xilinx/zy7_slcr.h>
   62 
   63 struct zy7_devcfg_softc {
   64         device_t        dev;
   65         struct mtx      sc_mtx;
   66         struct resource *mem_res;
   67         struct resource *irq_res;
   68         struct cdev     *sc_ctl_dev;
   69         void            *intrhandle;
   70 
   71         bus_dma_tag_t   dma_tag;
   72         bus_dmamap_t    dma_map;
   73 
   74         int             is_open;
   75 };
   76 
   77 static struct zy7_devcfg_softc *zy7_devcfg_softc_p;
   78 
   79 #define DEVCFG_SC_LOCK(sc)              mtx_lock(&(sc)->sc_mtx)
   80 #define DEVCFG_SC_UNLOCK(sc)            mtx_unlock(&(sc)->sc_mtx)
   81 #define DEVCFG_SC_LOCK_INIT(sc) \
   82         mtx_init(&(sc)->sc_mtx, device_get_nameunit((sc)->dev), \
   83             "zy7_devcfg", MTX_DEF)
   84 #define DEVCFG_SC_LOCK_DESTROY(sc)      mtx_destroy(&(sc)->sc_mtx);
   85 #define DEVCFG_SC_ASSERT_LOCKED(sc)     mtx_assert(&(sc)->sc_mtx, MA_OWNED);
   86 
   87 #define RD4(sc, off)            (bus_read_4((sc)->mem_res, (off)))
   88 #define WR4(sc, off, val)       (bus_write_4((sc)->mem_res, (off), (val)))
   89 
   90 SYSCTL_NODE(_hw, OID_AUTO, fpga, CTLFLAG_RD, 0, \
   91             "Xilinx Zynq-7000 PL (FPGA) section");
   92 
   93 static int zy7_devcfg_sysctl_pl_done(SYSCTL_HANDLER_ARGS);
   94 SYSCTL_PROC(_hw_fpga, OID_AUTO, pl_done, CTLTYPE_INT | CTLFLAG_RD, NULL, 0,
   95             zy7_devcfg_sysctl_pl_done, "I", "PL section config DONE signal");
   96 
   97 static int zy7_en_level_shifters = 1;
   98 SYSCTL_INT(_hw_fpga, OID_AUTO, en_level_shifters, CTLFLAG_RW,
   99            &zy7_en_level_shifters, 0,
  100            "Enable PS-PL level shifters after device config");
  101 
  102 static int zy7_ps_vers = 0;
  103 SYSCTL_INT(_hw, OID_AUTO, ps_vers, CTLFLAG_RD, &zy7_ps_vers, 0,
  104            "Zynq-7000 PS version");
  105 
  106 
  107 /* cdev entry points. */
  108 static int zy7_devcfg_open(struct cdev *, int, int, struct thread *);
  109 static int zy7_devcfg_write(struct cdev *, struct uio *, int);
  110 static int zy7_devcfg_close(struct cdev *, int, int, struct thread *);
  111 
  112 
  113 struct cdevsw zy7_devcfg_cdevsw = {
  114         .d_version =    D_VERSION,
  115         .d_open =       zy7_devcfg_open,
  116         .d_write =      zy7_devcfg_write,
  117         .d_close =      zy7_devcfg_close,
  118         .d_name =       "devcfg",
  119 };
  120 
  121 /* Devcfg block registers. */
  122 #define ZY7_DEVCFG_CTRL                 0x0000
  123 #define   ZY7_DEVCFG_CTRL_FORCE_RST             (1<<31)
  124 #define   ZY7_DEVCFG_CTRL_PCFG_PROG_B           (1<<30)
  125 #define   ZY7_DEVCFG_CTRL_PCFG_POR_CNT_4K       (1<<29)
  126 #define   ZY7_DEVCFG_CTRL_PCAP_PR               (1<<27)
  127 #define   ZY7_DEVCFG_CTRL_PCAP_MODE             (1<<26)
  128 #define   ZY7_DEVCFG_CTRL_QTR_PCAP_RATE_EN      (1<<25)
  129 #define   ZY7_DEVCFG_CTRL_MULTIBOOT_EN          (1<<24)
  130 #define   ZY7_DEVCFG_CTRL_JTAG_CHAIN_DIS        (1<<23)
  131 #define   ZY7_DEVCFG_CTRL_USER_MODE             (1<<15)
  132 #define   ZY7_DEVCFG_CTRL_RESVD_WR11            (3<<13) /* always write 11 */
  133 #define   ZY7_DEVCFG_CTRL_PCFG_AES_FUSE         (1<<12)
  134 #define   ZY7_DEVCFG_CTRL_PCFG_AES_EN_MASK      (7<<9)  /* all 1's or 0's */
  135 #define   ZY7_DEVCFG_CTRL_SEU_EN                (1<<8)
  136 #define   ZY7_DEVCFG_CTRL_SEC_EN                (1<<7)
  137 #define   ZY7_DEVCFG_CTRL_SPNIDEN               (1<<6)
  138 #define   ZY7_DEVCFG_CTRL_SPIDEN                (1<<5)
  139 #define   ZY7_DEVCFG_CTRL_NIDEN                 (1<<4)
  140 #define   ZY7_DEVCFG_CTRL_DBGEN                 (1<<3)
  141 #define   ZY7_DEVCFG_CTRL_DAP_EN_MASK           (7<<0)  /* all 1's to enable */
  142 
  143 #define ZY7_DEVCFG_LOCK                 0x004
  144 #define   ZY7_DEVCFG_LOCK_AES_FUSE_LOCK         (1<<4)
  145 #define   ZY7_DEVCFG_LOCK_AES_EN                (1<<3)
  146 #define   ZY7_DEVCFG_LOCK_SEU_LOCK              (1<<2)
  147 #define   ZY7_DEVCFG_LOCK_SEC_LOCK              (1<<1)
  148 #define   ZY7_DEVCFG_LOCK_DBG_LOCK              (1<<0)
  149 
  150 #define ZY7_DEVCFG_CFG                  0x008
  151 #define   ZY7_DEVCFG_CFG_RFIFO_TH_MASK          (3<<10)
  152 #define   ZY7_DEVCFG_CFG_WFIFO_TH_MASK          (3<<8)
  153 #define   ZY7_DEVCFG_CFG_RCLK_EDGE              (1<<7)
  154 #define   ZY7_DEVCFG_CFG_WCLK_EDGE              (1<<6)
  155 #define   ZY7_DEVCFG_CFG_DIS_SRC_INC            (1<<5)
  156 #define   ZY7_DEVCFG_CFG_DIS_DST_INC            (1<<4)
  157 
  158 #define ZY7_DEVCFG_INT_STATUS           0x00C
  159 #define ZY7_DEVCFG_INT_MASK             0x010
  160 #define   ZY7_DEVCFG_INT_PSS_GTS_USR_B          (1<<31)
  161 #define   ZY7_DEVCFG_INT_PSS_FST_CFG_B          (1<<30)
  162 #define   ZY7_DEVCFG_INT_PSS_GPWRDWN_B          (1<<29)
  163 #define   ZY7_DEVCFG_INT_PSS_GTS_CFG_B          (1<<28)
  164 #define   ZY7_DEVCFG_INT_CFG_RESET_B            (1<<27)
  165 #define   ZY7_DEVCFG_INT_AXI_WTO                (1<<23) /* axi write timeout */
  166 #define   ZY7_DEVCFG_INT_AXI_WERR               (1<<22) /* axi write err */
  167 #define   ZY7_DEVCFG_INT_AXI_RTO                (1<<21) /* axi read timeout */
  168 #define   ZY7_DEVCFG_INT_AXI_RERR               (1<<20) /* axi read err */
  169 #define   ZY7_DEVCFG_INT_RX_FIFO_OV             (1<<18) /* rx fifo overflow */
  170 #define   ZY7_DEVCFG_INT_WR_FIFO_LVL            (1<<17) /* wr fifo < level */
  171 #define   ZY7_DEVCFG_INT_RD_FIFO_LVL            (1<<16) /* rd fifo >= level */
  172 #define   ZY7_DEVCFG_INT_DMA_CMD_ERR            (1<<15)
  173 #define   ZY7_DEVCFG_INT_DMA_Q_OV               (1<<14)
  174 #define   ZY7_DEVCFG_INT_DMA_DONE               (1<<13)
  175 #define   ZY7_DEVCFG_INT_DMA_PCAP_DONE          (1<<12)
  176 #define   ZY7_DEVCFG_INT_P2D_LEN_ERR            (1<<11)
  177 #define   ZY7_DEVCFG_INT_PCFG_HMAC_ERR          (1<<6)
  178 #define   ZY7_DEVCFG_INT_PCFG_SEU_ERR           (1<<5)
  179 #define   ZY7_DEVCFG_INT_PCFG_POR_B             (1<<4)
  180 #define   ZY7_DEVCFG_INT_PCFG_CFG_RST           (1<<3)
  181 #define   ZY7_DEVCFG_INT_PCFG_DONE              (1<<2)
  182 #define   ZY7_DEVCFG_INT_PCFG_INIT_PE           (1<<1)
  183 #define   ZY7_DEVCFG_INT_PCFG_INIT_NE           (1<<0)
  184 #define   ZY7_DEVCFG_INT_ERRORS                 0x00f0f860
  185 #define   ZY7_DEVCFG_INT_ALL                    0xf8f7f87f
  186 
  187 #define ZY7_DEVCFG_STATUS               0x014
  188 #define   ZY7_DEVCFG_STATUS_DMA_CMD_Q_F         (1<<31) /* cmd queue full */
  189 #define   ZY7_DEVCFG_STATUS_DMA_CMD_Q_E         (1<<30) /* cmd queue empty */
  190 #define   ZY7_DEVCFG_STATUS_DONE_COUNT_MASK     (3<<28)
  191 #define   ZY7_DEVCFG_STATUS_DONE_COUNT_SHIFT    28
  192 #define   ZY7_DEVCFG_STATUS_RX_FIFO_LVL_MASK    (0x1f<<20)
  193 #define   ZY7_DEVCFG_STATUS_RX_FIFO_LVL_SHIFT   20
  194 #define   ZY7_DEVCFG_STATUS_TX_FIFO_LVL_MASK    (0x7f<<12)
  195 #define   ZY7_DEVCFG_STATUS_TX_FIFO_LVL_SHIFT   12
  196 #define   ZY7_DEVCFG_STATUS_PSS_GTS_USR_B       (1<<11)
  197 #define   ZY7_DEVCFG_STATUS_PSS_FST_CFG_B       (1<<10)
  198 #define   ZY7_DEVCFG_STATUS_PSS_GPWRDWN_B       (1<<9)
  199 #define   ZY7_DEVCFG_STATUS_PSS_GTS_CFG_B       (1<<8)
  200 #define   ZY7_DEVCFG_STATUS_ILL_APB_ACCE        (1<<6)
  201 #define   ZY7_DEVCFG_STATUS_PSS_CFG_RESET_B     (1<<5)
  202 #define   ZY7_DEVCFG_STATUS_PCFG_INIT           (1<<4)
  203 #define   ZY7_DEVCFG_STATUS_EFUSE_BBRAM_KEY_DIS (1<<3)
  204 #define   ZY7_DEVCFG_STATUS_EFUSE_SEC_EN        (1<<2)
  205 #define   ZY7_DEVCFG_STATUS_EFUSE_JTAG_DIS      (1<<1)
  206 
  207 #define ZY7_DEVCFG_DMA_SRC_ADDR         0x018
  208 #define ZY7_DEVCFG_DMA_DST_ADDR         0x01c
  209 #define   ZY7_DEVCFG_DMA_ADDR_WAIT_PCAP 1
  210 #define   ZY7_DEVCFG_DMA_ADDR_ILLEGAL           0xffffffff
  211 
  212 #define ZY7_DEVCFG_DMA_SRC_LEN          0x020   /* in 4-byte words. */
  213 #define ZY7_DEVCFG_DMA_SRC_LEN_MAX              0x7ffffff
  214 #define ZY7_DEVCFG_DMA_DST_LEN          0x024
  215 #define ZY7_DEVCFG_ROM_SHADOW           0x028
  216 #define ZY7_DEVCFG_MULTIBOOT_ADDR       0x02c
  217 #define ZY7_DEVCFG_SW_ID                0x030
  218 #define ZY7_DEVCFG_UNLOCK               0x034
  219 #define ZY7_DEVCFG_UNLOCK_MAGIC                 0x757bdf0d
  220 #define ZY7_DEVCFG_MCTRL                0x080
  221 #define   ZY7_DEVCFG_MCTRL_PS_VERS_MASK         (0xf<<28)
  222 #define   ZY7_DEVCFG_MCTRL_PS_VERS_SHIFT        28
  223 #define   ZY7_DEVCFG_MCTRL_PCFG_POR_B           (1<<8)
  224 #define   ZY7_DEVCFG_MCTRL_INT_PCAP_LPBK        (1<<4)
  225 #define ZY7_DEVCFG_XADCIF_CFG           0x100
  226 #define ZY7_DEVCFG_XADCIF_INT_STAT      0x104
  227 #define ZY7_DEVCFG_XADCIF_INT_MASK      0x108
  228 #define ZY7_DEVCFG_XADCIF_MSTS          0x10c
  229 #define ZY7_DEVCFG_XADCIF_CMD_FIFO      0x110
  230 #define ZY7_DEVCFG_XADCIF_RD_FIFO       0x114
  231 #define ZY7_DEVCFG_XADCIF_MCTL          0x118
  232 
  233 
  234 /* Enable programming the PL through PCAP. */
  235 static void
  236 zy7_devcfg_init_hw(struct zy7_devcfg_softc *sc)
  237 {
  238 
  239         DEVCFG_SC_ASSERT_LOCKED(sc);
  240 
  241         /* Set devcfg control register. */
  242         WR4(sc, ZY7_DEVCFG_CTRL,
  243             ZY7_DEVCFG_CTRL_PCFG_PROG_B |
  244             ZY7_DEVCFG_CTRL_PCAP_PR |
  245             ZY7_DEVCFG_CTRL_PCAP_MODE |
  246             ZY7_DEVCFG_CTRL_USER_MODE |
  247             ZY7_DEVCFG_CTRL_RESVD_WR11 |
  248             ZY7_DEVCFG_CTRL_SPNIDEN |
  249             ZY7_DEVCFG_CTRL_SPIDEN |
  250             ZY7_DEVCFG_CTRL_NIDEN |
  251             ZY7_DEVCFG_CTRL_DBGEN |
  252             ZY7_DEVCFG_CTRL_DAP_EN_MASK);
  253 
  254         /* Turn off internal PCAP loopback. */
  255         WR4(sc, ZY7_DEVCFG_MCTRL, RD4(sc, ZY7_DEVCFG_MCTRL) &
  256             ~ZY7_DEVCFG_MCTRL_INT_PCAP_LPBK);
  257 }
  258 
  259 /* Clear previous configuration of the PL by asserting PROG_B. */
  260 static int
  261 zy7_devcfg_reset_pl(struct zy7_devcfg_softc *sc)
  262 {
  263         uint32_t devcfg_ctl;
  264         int tries, err;
  265 
  266         DEVCFG_SC_ASSERT_LOCKED(sc);
  267 
  268         devcfg_ctl = RD4(sc, ZY7_DEVCFG_CTRL);
  269 
  270         /* Clear sticky bits and set up INIT signal positive edge interrupt. */
  271         WR4(sc, ZY7_DEVCFG_INT_STATUS, ZY7_DEVCFG_INT_ALL);
  272         WR4(sc, ZY7_DEVCFG_INT_MASK, ~ZY7_DEVCFG_INT_PCFG_INIT_PE);
  273 
  274         /* Deassert PROG_B (active low). */
  275         devcfg_ctl |= ZY7_DEVCFG_CTRL_PCFG_PROG_B;
  276         WR4(sc, ZY7_DEVCFG_CTRL, devcfg_ctl);
  277 
  278         /*
  279          * Wait for INIT to assert.  If it is already asserted, we may not get
  280          * an edge interrupt so cancel it and continue.
  281          */
  282         if ((RD4(sc, ZY7_DEVCFG_STATUS) &
  283              ZY7_DEVCFG_STATUS_PCFG_INIT) != 0) {
  284                 /* Already asserted.  Cancel interrupt. */
  285                 WR4(sc, ZY7_DEVCFG_INT_MASK, ~0);
  286         }
  287         else {
  288                 /* Wait for positive edge interrupt. */
  289                 err = mtx_sleep(sc, &sc->sc_mtx, PCATCH, "zy7i1", hz);
  290                 if (err != 0)
  291                         return (err);
  292         }
  293         
  294         /* Reassert PROG_B (active low). */
  295         devcfg_ctl &= ~ZY7_DEVCFG_CTRL_PCFG_PROG_B;
  296         WR4(sc, ZY7_DEVCFG_CTRL, devcfg_ctl);
  297 
  298         /* Wait for INIT deasserted.  This happens almost instantly. */
  299         tries = 0;
  300         while ((RD4(sc, ZY7_DEVCFG_STATUS) &
  301                 ZY7_DEVCFG_STATUS_PCFG_INIT) != 0) {
  302                 if (++tries >= 100)
  303                         return (EIO);
  304                 DELAY(5);
  305         }
  306 
  307         /* Clear sticky bits and set up INIT positive edge interrupt. */
  308         WR4(sc, ZY7_DEVCFG_INT_STATUS, ZY7_DEVCFG_INT_ALL);
  309         WR4(sc, ZY7_DEVCFG_INT_MASK, ~ZY7_DEVCFG_INT_PCFG_INIT_PE);
  310 
  311         /* Deassert PROG_B again. */
  312         devcfg_ctl |= ZY7_DEVCFG_CTRL_PCFG_PROG_B;
  313         WR4(sc, ZY7_DEVCFG_CTRL, devcfg_ctl);
  314 
  315         /*
  316          * Wait for INIT asserted indicating FPGA internal initialization
  317          * is complete.
  318          */
  319         err = mtx_sleep(sc, &sc->sc_mtx, PCATCH, "zy7i2", hz);
  320         if (err != 0)
  321                 return (err);
  322 
  323         /* Clear sticky DONE bit in interrupt status. */
  324         WR4(sc, ZY7_DEVCFG_INT_STATUS, ZY7_DEVCFG_INT_ALL);
  325 
  326         return (0);
  327 }
  328 
  329 /* Callback function for bus_dmamap_load(). */
  330 static void
  331 zy7_dma_cb2(void *arg, bus_dma_segment_t *seg, int nsegs, int error)
  332 {
  333         if (!error && nsegs == 1)
  334                 *(bus_addr_t *)arg = seg[0].ds_addr;
  335 }
  336 
  337 
  338 static int
  339 zy7_devcfg_open(struct cdev *dev, int oflags, int devtype, struct thread *td)
  340 {
  341         struct zy7_devcfg_softc *sc = dev->si_drv1;
  342         int err;
  343 
  344         DEVCFG_SC_LOCK(sc);
  345         if (sc->is_open) {
  346                 DEVCFG_SC_UNLOCK(sc);
  347                 return (EBUSY);
  348         }
  349 
  350         sc->dma_map = NULL;
  351         err = bus_dma_tag_create(bus_get_dma_tag(sc->dev), 4, 0,
  352                                  BUS_SPACE_MAXADDR_32BIT,
  353                                  BUS_SPACE_MAXADDR,
  354                                  NULL, NULL,
  355                                  PAGE_SIZE,
  356                                  1,
  357                                  PAGE_SIZE,
  358                                  0,
  359                                  busdma_lock_mutex,
  360                                  &sc->sc_mtx,
  361                                  &sc->dma_tag);
  362         if (err) {
  363                 DEVCFG_SC_UNLOCK(sc);
  364                 return (err);
  365         }
  366 
  367         sc->is_open = 1;
  368         DEVCFG_SC_UNLOCK(sc);
  369         return (0);
  370 }
  371 
  372 static int
  373 zy7_devcfg_write(struct cdev *dev, struct uio *uio, int ioflag)
  374 {
  375         struct zy7_devcfg_softc *sc = dev->si_drv1;
  376         void *dma_mem;
  377         bus_addr_t dma_physaddr;
  378         int segsz, err;
  379 
  380         DEVCFG_SC_LOCK(sc);
  381 
  382         /* First write?  Reset PL. */
  383         if (uio->uio_offset == 0 && uio->uio_resid > 0) {
  384                 zy7_devcfg_init_hw(sc);
  385                 zy7_slcr_preload_pl();
  386                 err = zy7_devcfg_reset_pl(sc);
  387                 if (err != 0) {
  388                         DEVCFG_SC_UNLOCK(sc);
  389                         return (err);
  390                 }
  391         }
  392 
  393         /* Allocate dma memory and load. */
  394         err = bus_dmamem_alloc(sc->dma_tag, &dma_mem, BUS_DMA_NOWAIT,
  395                                &sc->dma_map);
  396         if (err != 0) {
  397                 DEVCFG_SC_UNLOCK(sc);
  398                 return (err);
  399         }
  400         err = bus_dmamap_load(sc->dma_tag, sc->dma_map, dma_mem, PAGE_SIZE,
  401                               zy7_dma_cb2, &dma_physaddr, 0);
  402         if (err != 0) {
  403                 bus_dmamem_free(sc->dma_tag, dma_mem, sc->dma_map);
  404                 DEVCFG_SC_UNLOCK(sc);
  405                 return (err);
  406         }
  407 
  408         while (uio->uio_resid > 0) {
  409                 /* If DONE signal has been set, we shouldn't write anymore. */
  410                 if ((RD4(sc, ZY7_DEVCFG_INT_STATUS) &
  411                      ZY7_DEVCFG_INT_PCFG_DONE) != 0) {
  412                         err = EIO;
  413                         break;
  414                 }
  415 
  416                 /* uiomove the data from user buffer to our dma map. */
  417                 segsz = MIN(PAGE_SIZE, uio->uio_resid);
  418                 DEVCFG_SC_UNLOCK(sc);
  419                 err = uiomove(dma_mem, segsz, uio);
  420                 DEVCFG_SC_LOCK(sc);
  421                 if (err != 0)
  422                         break;
  423 
  424                 /* Flush the cache to memory. */
  425                 bus_dmamap_sync(sc->dma_tag, sc->dma_map,
  426                                 BUS_DMASYNC_PREWRITE);
  427 
  428                 /* Program devcfg's DMA engine.  The ordering of these
  429                  * register writes is critical.
  430                  */
  431                 if (uio->uio_resid > segsz)
  432                         WR4(sc, ZY7_DEVCFG_DMA_SRC_ADDR,
  433                             (uint32_t) dma_physaddr);
  434                 else
  435                         WR4(sc, ZY7_DEVCFG_DMA_SRC_ADDR,
  436                             (uint32_t) dma_physaddr |
  437                             ZY7_DEVCFG_DMA_ADDR_WAIT_PCAP);
  438                 WR4(sc, ZY7_DEVCFG_DMA_DST_ADDR, ZY7_DEVCFG_DMA_ADDR_ILLEGAL);
  439                 WR4(sc, ZY7_DEVCFG_DMA_SRC_LEN, (segsz+3)/4);
  440                 WR4(sc, ZY7_DEVCFG_DMA_DST_LEN, 0);
  441 
  442                 /* Now clear done bit and set up DMA done interrupt. */
  443                 WR4(sc, ZY7_DEVCFG_INT_STATUS, ZY7_DEVCFG_INT_ALL);
  444                 WR4(sc, ZY7_DEVCFG_INT_MASK, ~ZY7_DEVCFG_INT_DMA_DONE);
  445 
  446                 /* Wait for DMA done interrupt. */
  447                 err = mtx_sleep(sc->dma_map, &sc->sc_mtx, PCATCH,
  448                                 "zy7dma", hz);
  449                 if (err != 0)
  450                         break;
  451 
  452                 bus_dmamap_sync(sc->dma_tag, sc->dma_map,
  453                                 BUS_DMASYNC_POSTWRITE);
  454 
  455                 /* Check DONE signal. */
  456                 if ((RD4(sc, ZY7_DEVCFG_INT_STATUS) &
  457                      ZY7_DEVCFG_INT_PCFG_DONE) != 0)
  458                         zy7_slcr_postload_pl(zy7_en_level_shifters);
  459         }
  460 
  461         bus_dmamap_unload(sc->dma_tag, sc->dma_map);
  462         bus_dmamem_free(sc->dma_tag, dma_mem, sc->dma_map);
  463         DEVCFG_SC_UNLOCK(sc);
  464         return (err);
  465 }
  466 
  467 static int
  468 zy7_devcfg_close(struct cdev *dev, int fflag, int devtype, struct thread *td)
  469 {
  470         struct zy7_devcfg_softc *sc = dev->si_drv1;
  471 
  472         DEVCFG_SC_LOCK(sc);
  473         sc->is_open = 0;
  474         bus_dma_tag_destroy(sc->dma_tag);
  475         DEVCFG_SC_UNLOCK(sc);
  476 
  477         return (0);
  478 }
  479 
  480 
  481 static void
  482 zy7_devcfg_intr(void *arg)
  483 {
  484         struct zy7_devcfg_softc *sc = (struct zy7_devcfg_softc *)arg;
  485         uint32_t istatus, imask;
  486 
  487         DEVCFG_SC_LOCK(sc);
  488 
  489         istatus = RD4(sc, ZY7_DEVCFG_INT_STATUS);
  490         imask = ~RD4(sc, ZY7_DEVCFG_INT_MASK);
  491 
  492         /* Turn interrupt off. */
  493         WR4(sc, ZY7_DEVCFG_INT_MASK, ~0);
  494 
  495         if ((istatus & imask) == 0) {
  496                 DEVCFG_SC_UNLOCK(sc);
  497                 return;
  498         }
  499 
  500         /* DMA done? */
  501         if ((istatus & ZY7_DEVCFG_INT_DMA_DONE) != 0)
  502                 wakeup(sc->dma_map);
  503 
  504         /* INIT_B positive edge? */
  505         if ((istatus & ZY7_DEVCFG_INT_PCFG_INIT_PE) != 0)
  506                 wakeup(sc);
  507 
  508         DEVCFG_SC_UNLOCK(sc);
  509 }
  510 
  511 /* zy7_devcfg_sysctl_pl_done() returns status of the PL_DONE signal.
  512  */
  513 static int
  514 zy7_devcfg_sysctl_pl_done(SYSCTL_HANDLER_ARGS)
  515 {
  516         struct zy7_devcfg_softc *sc = zy7_devcfg_softc_p;
  517         int pl_done = 0;
  518 
  519         if (sc) {
  520                 DEVCFG_SC_LOCK(sc);
  521 
  522                 /* PCFG_DONE bit is sticky.  Clear it before checking it. */
  523                 WR4(sc, ZY7_DEVCFG_INT_STATUS, ZY7_DEVCFG_INT_PCFG_DONE);
  524                 pl_done = ((RD4(sc, ZY7_DEVCFG_INT_STATUS) &
  525                             ZY7_DEVCFG_INT_PCFG_DONE) != 0);
  526 
  527                 DEVCFG_SC_UNLOCK(sc);
  528         }
  529         return (sysctl_handle_int(oidp, &pl_done, 0, req));
  530 }
  531 
  532 static int
  533 zy7_devcfg_probe(device_t dev)
  534 {
  535 
  536         if (!ofw_bus_status_okay(dev))
  537                 return (ENXIO);
  538 
  539         if (!ofw_bus_is_compatible(dev, "xlnx,zy7_devcfg"))
  540                 return (ENXIO);
  541 
  542         device_set_desc(dev, "Zynq devcfg block");
  543         return (0);
  544 }
  545 
  546 static int zy7_devcfg_detach(device_t dev);
  547 
  548 static int
  549 zy7_devcfg_attach(device_t dev)
  550 {
  551         struct zy7_devcfg_softc *sc = device_get_softc(dev);
  552         int rid, err;
  553 
  554         /* Allow only one attach. */
  555         if (zy7_devcfg_softc_p != NULL)
  556                 return (ENXIO);
  557 
  558         sc->dev = dev;
  559 
  560         DEVCFG_SC_LOCK_INIT(sc);
  561 
  562         /* Get memory resource. */
  563         rid = 0;
  564         sc->mem_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid,
  565                                              RF_ACTIVE);
  566         if (sc->mem_res == NULL) {
  567                 device_printf(dev, "could not allocate memory resources.\n");
  568                 zy7_devcfg_detach(dev);
  569                 return (ENOMEM);
  570         }
  571 
  572         /* Allocate IRQ. */
  573         rid = 0;
  574         sc->irq_res = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid,
  575                                              RF_ACTIVE);
  576         if (sc->irq_res == NULL) {
  577                 device_printf(dev, "cannot allocate IRQ\n");
  578                 zy7_devcfg_detach(dev);
  579                 return (ENOMEM);
  580         }
  581 
  582         /* Activate the interrupt. */
  583         err = bus_setup_intr(dev, sc->irq_res, INTR_TYPE_MISC | INTR_MPSAFE,
  584                              NULL, zy7_devcfg_intr, sc, &sc->intrhandle);
  585         if (err) {
  586                 device_printf(dev, "cannot setup IRQ\n");
  587                 zy7_devcfg_detach(dev);
  588                 return (err);
  589         }
  590 
  591         /* Create /dev/devcfg */
  592         sc->sc_ctl_dev = make_dev(&zy7_devcfg_cdevsw, 0,
  593                           UID_ROOT, GID_WHEEL, 0600, "devcfg");
  594         if (sc->sc_ctl_dev == NULL) {
  595                 device_printf(dev, "failed to create /dev/devcfg");
  596                 zy7_devcfg_detach(dev);
  597                 return (ENXIO);
  598         }
  599         sc->sc_ctl_dev->si_drv1 = sc;
  600 
  601         zy7_devcfg_softc_p = sc;
  602 
  603         /* Unlock devcfg registers. */
  604         WR4(sc, ZY7_DEVCFG_UNLOCK, ZY7_DEVCFG_UNLOCK_MAGIC);
  605 
  606         /* Make sure interrupts are completely disabled. */
  607         WR4(sc, ZY7_DEVCFG_INT_STATUS, ZY7_DEVCFG_INT_ALL);
  608         WR4(sc, ZY7_DEVCFG_INT_MASK, 0xffffffff);
  609 
  610         /* Get PS_VERS for SYSCTL. */
  611         zy7_ps_vers = (RD4(sc, ZY7_DEVCFG_MCTRL) &
  612                        ZY7_DEVCFG_MCTRL_PS_VERS_MASK) >>
  613                 ZY7_DEVCFG_MCTRL_PS_VERS_SHIFT;
  614 
  615         return (0);
  616 }
  617 
  618 static int
  619 zy7_devcfg_detach(device_t dev)
  620 {
  621         struct zy7_devcfg_softc *sc = device_get_softc(dev);
  622 
  623         if (device_is_attached(dev))
  624                 bus_generic_detach(dev);
  625 
  626         /* Get rid of /dev/devcfg0. */
  627         if (sc->sc_ctl_dev != NULL)
  628                 destroy_dev(sc->sc_ctl_dev);
  629 
  630         /* Teardown and release interrupt. */
  631         if (sc->irq_res != NULL) {
  632                 if (sc->intrhandle)
  633                         bus_teardown_intr(dev, sc->irq_res, sc->intrhandle);
  634                 bus_release_resource(dev, SYS_RES_IRQ,
  635                              rman_get_rid(sc->irq_res), sc->irq_res);
  636         }
  637 
  638         /* Release memory resource. */
  639         if (sc->mem_res != NULL)
  640                 bus_release_resource(dev, SYS_RES_MEMORY,
  641                              rman_get_rid(sc->mem_res), sc->mem_res);
  642 
  643         zy7_devcfg_softc_p = NULL;
  644 
  645         DEVCFG_SC_LOCK_DESTROY(sc);
  646 
  647         return (0);
  648 }
  649 
  650 static device_method_t zy7_devcfg_methods[] = {
  651         /* device_if */
  652         DEVMETHOD(device_probe,         zy7_devcfg_probe),
  653         DEVMETHOD(device_attach,        zy7_devcfg_attach),
  654         DEVMETHOD(device_detach,        zy7_devcfg_detach),
  655 
  656         DEVMETHOD_END
  657 };
  658 
  659 static driver_t zy7_devcfg_driver = {
  660         "zy7_devcfg",
  661         zy7_devcfg_methods,
  662         sizeof(struct zy7_devcfg_softc),
  663 };
  664 static devclass_t zy7_devcfg_devclass;
  665 
  666 DRIVER_MODULE(zy7_devcfg, simplebus, zy7_devcfg_driver, zy7_devcfg_devclass, \
  667               0, 0);
  668 MODULE_DEPEND(zy7_devcfg, zy7_slcr, 1, 1, 1);

Cache object: 39595029e54c7884efa509a2e4cdddb5


[ 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.