zy7_devcfg.c revision 265690
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: head/sys/arm/xilinx/zy7_devcfg.c 265690 2014-05-08 17:20:45Z 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: head/sys/arm/xilinx/zy7_devcfg.c 265690 2014-05-08 17:20:45Z 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 63struct 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 77static 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 90SYSCTL_NODE(_hw, OID_AUTO, fpga, CTLFLAG_RD, 0, \ 91 "Xilinx Zynq-7000 PL (FPGA) section"); 92 93static int zy7_devcfg_sysctl_pl_done(SYSCTL_HANDLER_ARGS); 94SYSCTL_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 97static int zy7_en_level_shifters = 1; 98SYSCTL_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 102static int zy7_ps_vers = 0; 103SYSCTL_INT(_hw, OID_AUTO, ps_vers, CTLFLAG_RD, &zy7_ps_vers, 0, 104 "Zynq-7000 PS version"); 105 106 107/* cdev entry points. */ 108static int zy7_devcfg_open(struct cdev *, int, int, struct thread *); 109static int zy7_devcfg_write(struct cdev *, struct uio *, int); 110static int zy7_devcfg_close(struct cdev *, int, int, struct thread *); 111 112 113struct 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. */ 235static void 236zy7_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. */ 260static int 261zy7_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(). */ 330static void 331zy7_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 338static int 339zy7_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 372static int 373zy7_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 467static int 468zy7_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 481static void 482zy7_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 */ 513static int 514zy7_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 532static int 533zy7_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 546static int zy7_devcfg_detach(device_t dev); 547 548static int 549zy7_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 618static int 619zy7_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 650static 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 659static driver_t zy7_devcfg_driver = { 660 "zy7_devcfg", 661 zy7_devcfg_methods, 662 sizeof(struct zy7_devcfg_softc), 663}; 664static devclass_t zy7_devcfg_devclass; 665 666DRIVER_MODULE(zy7_devcfg, simplebus, zy7_devcfg_driver, zy7_devcfg_devclass, \ 667 0, 0); 668MODULE_DEPEND(zy7_devcfg, zy7_slcr, 1, 1, 1); 669