/*- * Copyright (c) 2012 Robert N. M. Watson * All rights reserved. * * This software was developed by SRI International and the University of * Cambridge Computer Laboratory under DARPA/AFRL contract (FA8750-10-C-0237) * ("CTSRD"), as part of the DARPA CRASH research programme. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. */ #include __FBSDID("$FreeBSD$"); #include #include #include #include /* struct vt_mode */ #include #include /* video_adapter_t */ #include #include #include #include #include #include #include #include #include static d_mmap_t terasic_mtl_reg_mmap; static d_read_t terasic_mtl_reg_read; static d_write_t terasic_mtl_reg_write; static struct cdevsw terasic_mtl_reg_cdevsw = { .d_version = D_VERSION, .d_mmap = terasic_mtl_reg_mmap, .d_read = terasic_mtl_reg_read, .d_write = terasic_mtl_reg_write, .d_name = "terasic_mtl_reg", }; /* * All I/O to/from the MTL register device must be 32-bit, and aligned to * 32-bit. */ static int terasic_mtl_reg_read(struct cdev *dev, struct uio *uio, int flag) { struct terasic_mtl_softc *sc; u_long offset, size; uint32_t v; int error; if (uio->uio_offset < 0 || uio->uio_offset % 4 != 0 || uio->uio_resid % 4 != 0) return (ENODEV); sc = dev->si_drv1; size = rman_get_size(sc->mtl_reg_res); error = 0; if ((uio->uio_offset + uio->uio_resid < 0) || (uio->uio_offset + uio->uio_resid > size)) return (ENODEV); while (uio->uio_resid > 0) { offset = uio->uio_offset; if (offset + sizeof(v) > size) return (ENODEV); v = bus_read_4(sc->mtl_reg_res, offset); error = uiomove(&v, sizeof(v), uio); if (error) return (error); } return (error); } static int terasic_mtl_reg_write(struct cdev *dev, struct uio *uio, int flag) { struct terasic_mtl_softc *sc; u_long offset, size; uint32_t v; int error; if (uio->uio_offset < 0 || uio->uio_offset % 4 != 0 || uio->uio_resid % 4 != 0) return (ENODEV); sc = dev->si_drv1; size = rman_get_size(sc->mtl_reg_res); error = 0; while (uio->uio_resid > 0) { offset = uio->uio_offset; if (offset + sizeof(v) > size) return (ENODEV); error = uiomove(&v, sizeof(v), uio); if (error) return (error); bus_write_4(sc->mtl_reg_res, offset, v); } return (error); } static int terasic_mtl_reg_mmap(struct cdev *dev, vm_ooffset_t offset, vm_paddr_t *paddr, int nprot, vm_memattr_t *memattr) { struct terasic_mtl_softc *sc; int error; sc = dev->si_drv1; error = 0; if (trunc_page(offset) == offset && rman_get_size(sc->mtl_reg_res) >= offset + PAGE_SIZE) { *paddr = rman_get_start(sc->mtl_reg_res) + offset; *memattr = VM_MEMATTR_UNCACHEABLE; } else error = ENODEV; return (error); } void terasic_mtl_reg_blend_get(struct terasic_mtl_softc *sc, uint32_t *blendp) { *blendp = le32toh(bus_read_4(sc->mtl_reg_res, TERASIC_MTL_OFF_BLEND)); } void terasic_mtl_reg_blend_set(struct terasic_mtl_softc *sc, uint32_t blend) { bus_write_4(sc->mtl_reg_res, TERASIC_MTL_OFF_BLEND, htole32(blend)); } void terasic_mtl_blend_default_set(struct terasic_mtl_softc *sc, uint8_t colour) { uint32_t v; TERASIC_MTL_LOCK(sc); terasic_mtl_reg_blend_get(sc, &v); v &= ~TERASIC_MTL_BLEND_DEFAULT_MASK; v |= colour << TERASIC_MTL_BLEND_DEFAULT_SHIFT; terasic_mtl_reg_blend_set(sc, v); TERASIC_MTL_UNLOCK(sc); } void terasic_mtl_blend_pixel_set(struct terasic_mtl_softc *sc, uint8_t alpha) { uint32_t v; TERASIC_MTL_LOCK(sc); terasic_mtl_reg_blend_get(sc, &v); v &= ~TERASIC_MTL_BLEND_PIXEL_MASK; v |= alpha << TERASIC_MTL_BLEND_PIXEL_SHIFT; terasic_mtl_reg_blend_set(sc, v); TERASIC_MTL_UNLOCK(sc); } void terasic_mtl_blend_textfg_set(struct terasic_mtl_softc *sc, uint8_t alpha) { uint32_t v; TERASIC_MTL_LOCK(sc); terasic_mtl_reg_blend_get(sc, &v); v &= ~TERASIC_MTL_BLEND_TEXTFG_MASK; v |= alpha << TERASIC_MTL_BLEND_TEXTFG_SHIFT; terasic_mtl_reg_blend_set(sc, v); TERASIC_MTL_UNLOCK(sc); } void terasic_mtl_blend_textbg_set(struct terasic_mtl_softc *sc, uint8_t alpha) { uint32_t v; TERASIC_MTL_LOCK(sc); terasic_mtl_reg_blend_get(sc, &v); v &= ~TERASIC_MTL_BLEND_TEXTBG_MASK; v |= alpha << TERASIC_MTL_BLEND_TEXTBG_SHIFT; terasic_mtl_reg_blend_set(sc, v); TERASIC_MTL_UNLOCK(sc); } void terasic_mtl_reg_textcursor_get(struct terasic_mtl_softc *sc, uint8_t *colp, uint8_t *rowp) { uint32_t v; v = bus_read_4(sc->mtl_reg_res, TERASIC_MTL_OFF_TEXTCURSOR); v = le32toh(v); *colp = (v & TERASIC_MTL_TEXTCURSOR_COL_MASK) >> TERASIC_MTL_TEXTCURSOR_COL_SHIFT; *rowp = (v & TERASIC_MTL_TEXTCURSOR_ROW_MASK); } void terasic_mtl_reg_textcursor_set(struct terasic_mtl_softc *sc, uint8_t col, uint8_t row) { uint32_t v; v = (col << TERASIC_MTL_TEXTCURSOR_COL_SHIFT) | row; v = htole32(v); bus_write_4(sc->mtl_reg_res, TERASIC_MTL_OFF_TEXTCURSOR, v); } void terasic_mtl_reg_blank(struct terasic_mtl_softc *sc) { device_printf(sc->mtl_dev, "%s: not yet", __func__); } void terasic_mtl_reg_textframebufaddr_get(struct terasic_mtl_softc *sc, uint32_t *addrp) { uint32_t addr; addr = bus_read_4(sc->mtl_reg_res, TERASIC_MTL_OFF_TEXTFRAMEBUFADDR); *addrp = le32toh(addr); } void terasic_mtl_reg_textframebufaddr_set(struct terasic_mtl_softc *sc, uint32_t addr) { addr = htole32(addr); bus_write_4(sc->mtl_reg_res, TERASIC_MTL_OFF_TEXTFRAMEBUFADDR, addr); } int terasic_mtl_reg_attach(struct terasic_mtl_softc *sc) { sc->mtl_reg_cdev = make_dev(&terasic_mtl_reg_cdevsw, sc->mtl_unit, UID_ROOT, GID_WHEEL, 0400, "mtl_reg%d", sc->mtl_unit); if (sc->mtl_reg_cdev == NULL) { device_printf(sc->mtl_dev, "%s: make_dev failed\n", __func__); return (ENXIO); } /* XXXRW: Slight race between make_dev(9) and here. */ sc->mtl_reg_cdev->si_drv1 = sc; return (0); } void terasic_mtl_reg_detach(struct terasic_mtl_softc *sc) { if (sc->mtl_reg_cdev != NULL) destroy_dev(sc->mtl_reg_cdev); }