mntva.c revision 1.3.2.2
1 1.3.2.2 jdolecek /* $NetBSD: mntva.c,v 1.3.2.2 2017/12/03 11:35:48 jdolecek Exp $ */ 2 1.3.2.2 jdolecek 3 1.3.2.2 jdolecek /* 4 1.3.2.2 jdolecek * Copyright (c) 2012, 2016 The NetBSD Foundation, Inc. 5 1.3.2.2 jdolecek * All rights reserved. 6 1.3.2.2 jdolecek * 7 1.3.2.2 jdolecek * This code is derived from software contributed to The NetBSD Foundation 8 1.3.2.2 jdolecek * by Lukas F. Hartmann. 9 1.3.2.2 jdolecek * This code is derived from software contributed to The NetBSD Foundation 10 1.3.2.2 jdolecek * by Radoslaw Kujawa. 11 1.3.2.2 jdolecek * 12 1.3.2.2 jdolecek * Redistribution and use in source and binary forms, with or without 13 1.3.2.2 jdolecek * modification, are permitted provided that the following conditions 14 1.3.2.2 jdolecek * are met: 15 1.3.2.2 jdolecek * 1. Redistributions of source code must retain the above copyright 16 1.3.2.2 jdolecek * notice, this list of conditions and the following disclaimer. 17 1.3.2.2 jdolecek * 2. Redistributions in binary form must reproduce the above copyright 18 1.3.2.2 jdolecek * notice, this list of conditions and the following disclaimer in the 19 1.3.2.2 jdolecek * documentation and/or other materials provided with the distribution. 20 1.3.2.2 jdolecek * 21 1.3.2.2 jdolecek * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 22 1.3.2.2 jdolecek * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 23 1.3.2.2 jdolecek * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 24 1.3.2.2 jdolecek * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 25 1.3.2.2 jdolecek * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 26 1.3.2.2 jdolecek * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 27 1.3.2.2 jdolecek * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 28 1.3.2.2 jdolecek * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 29 1.3.2.2 jdolecek * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 30 1.3.2.2 jdolecek * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 31 1.3.2.2 jdolecek */ 32 1.3.2.2 jdolecek 33 1.3.2.2 jdolecek #include <sys/cdefs.h> 34 1.3.2.2 jdolecek __KERNEL_RCSID(0, "$NetBSD: mntva.c,v 1.3.2.2 2017/12/03 11:35:48 jdolecek Exp $"); 35 1.3.2.2 jdolecek 36 1.3.2.2 jdolecek #include <sys/param.h> 37 1.3.2.2 jdolecek #include <sys/systm.h> 38 1.3.2.2 jdolecek #include <sys/kernel.h> 39 1.3.2.2 jdolecek #include <sys/device.h> 40 1.3.2.2 jdolecek #include <sys/endian.h> 41 1.3.2.2 jdolecek #include <sys/bus.h> 42 1.3.2.2 jdolecek #include <sys/cpu.h> 43 1.3.2.2 jdolecek #include <sys/conf.h> 44 1.3.2.2 jdolecek 45 1.3.2.2 jdolecek #include <dev/cons.h> 46 1.3.2.2 jdolecek 47 1.3.2.2 jdolecek #include <amiga/amiga/device.h> 48 1.3.2.2 jdolecek #include <amiga/amiga/isr.h> 49 1.3.2.2 jdolecek 50 1.3.2.2 jdolecek #include <amiga/dev/zbusvar.h> 51 1.3.2.2 jdolecek #include <amiga/dev/mntvavar.h> 52 1.3.2.2 jdolecek #include <amiga/dev/mntvareg.h> 53 1.3.2.2 jdolecek #include <dev/wsfb/genfbvar.h> 54 1.3.2.2 jdolecek 55 1.3.2.2 jdolecek #include "opt_amigacons.h" 56 1.3.2.2 jdolecek #include "opt_wsemul.h" 57 1.3.2.2 jdolecek #include "opt_mntva.h" 58 1.3.2.2 jdolecek #include "opt_wsfb.h" 59 1.3.2.2 jdolecek 60 1.3.2.2 jdolecek #include "mntva.h" 61 1.3.2.2 jdolecek 62 1.3.2.2 jdolecek /* #define MNTVA_DEBUG 1 */ 63 1.3.2.2 jdolecek 64 1.3.2.2 jdolecek static int mntva_match(device_t, cfdata_t, void *); 65 1.3.2.2 jdolecek static void mntva_attach(device_t, device_t, void *); 66 1.3.2.2 jdolecek 67 1.3.2.2 jdolecek static uint16_t mntva_reg_read(struct mntva_softc *sc, uint32_t reg); 68 1.3.2.2 jdolecek static void mntva_reg_write(struct mntva_softc *sc, uint32_t reg, uint32_t val); 69 1.3.2.2 jdolecek 70 1.3.2.2 jdolecek static bool mntva_mode_set(struct mntva_softc *sc); 71 1.3.2.2 jdolecek 72 1.3.2.2 jdolecek static paddr_t mntva_mmap(void *v, void *vs, off_t offset, int prot); 73 1.3.2.2 jdolecek static int mntva_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, 74 1.3.2.2 jdolecek struct lwp *l); 75 1.3.2.2 jdolecek static void mntva_init_screen(void *cookie, struct vcons_screen *scr, 76 1.3.2.2 jdolecek int existing, long *defattr); 77 1.3.2.2 jdolecek static void mntva_init_palette(struct mntva_softc *sc); 78 1.3.2.2 jdolecek /* blitter support */ 79 1.3.2.2 jdolecek static void mntva_rectfill(struct mntva_softc *sc, int x, int y, int wi, 80 1.3.2.2 jdolecek int he, uint32_t color); 81 1.3.2.2 jdolecek static void mntva_bitblt(struct mntva_softc *sc, int xs, int ys, int xd, 82 1.3.2.2 jdolecek int yd, int wi, int he); 83 1.3.2.2 jdolecek 84 1.3.2.2 jdolecek /* accelerated raster ops */ 85 1.3.2.2 jdolecek static void mntva_eraserows(void *cookie, int row, int nrows, long fillattr); 86 1.3.2.2 jdolecek static void mntva_copyrows(void *cookie, int srcrow, int dstrow, int nrows); 87 1.3.2.2 jdolecek static void mntva_copycols(void *cookie, int row, int srccol, int dstcol, 88 1.3.2.2 jdolecek int ncols); 89 1.3.2.2 jdolecek static void mntva_erasecols(void *cookie, int row, int startcol, int ncols, 90 1.3.2.2 jdolecek long fillattr); 91 1.3.2.2 jdolecek #if 0 92 1.3.2.2 jdolecek static void mntva_cursor(void *cookie, int on, int row, int col); 93 1.3.2.2 jdolecek #endif 94 1.3.2.2 jdolecek 95 1.3.2.2 jdolecek /* 96 1.3.2.2 jdolecek * XXX: these will be called by console handling code, shouldn't they be 97 1.3.2.2 jdolecek * included from somewhere else? 98 1.3.2.2 jdolecek */ 99 1.3.2.2 jdolecek void mntvacninit(struct consdev *cd); 100 1.3.2.2 jdolecek void mntvacnprobe(struct consdev *cd); 101 1.3.2.2 jdolecek void mntvacnputc(dev_t cd, int ch); 102 1.3.2.2 jdolecek int mntvacngetc(dev_t cd); 103 1.3.2.2 jdolecek void mntvacnpollc(dev_t cd, int on); 104 1.3.2.2 jdolecek 105 1.3.2.2 jdolecek CFATTACH_DECL_NEW(mntva, sizeof(struct mntva_softc), 106 1.3.2.2 jdolecek mntva_match, mntva_attach, NULL, NULL); 107 1.3.2.2 jdolecek 108 1.3.2.2 jdolecek struct wsdisplay_accessops mntva_accessops = { 109 1.3.2.2 jdolecek mntva_ioctl, 110 1.3.2.2 jdolecek mntva_mmap, 111 1.3.2.2 jdolecek NULL, // alloc_screen 112 1.3.2.2 jdolecek NULL, // free_screen 113 1.3.2.2 jdolecek NULL, // show_screen 114 1.3.2.2 jdolecek NULL, // load_font 115 1.3.2.2 jdolecek NULL, // pollc 116 1.3.2.2 jdolecek NULL // scroll 117 1.3.2.2 jdolecek }; 118 1.3.2.2 jdolecek 119 1.3.2.2 jdolecek static int 120 1.3.2.2 jdolecek mntva_match(device_t parent, cfdata_t match, void *aux) 121 1.3.2.2 jdolecek { 122 1.3.2.2 jdolecek struct zbus_args *zap = aux; 123 1.3.2.2 jdolecek 124 1.3.2.2 jdolecek if (zap->manid == 0x6d6e && zap->prodid == 1) { 125 1.3.2.2 jdolecek #ifdef MNTVA_DEBUG 126 1.3.2.2 jdolecek /* XXX: this might not work during console init? */ 127 1.3.2.2 jdolecek aprint_normal("mntva_match... success!\n"); 128 1.3.2.2 jdolecek #endif /* MNTVA_DEBUG */ 129 1.3.2.2 jdolecek return 1; 130 1.3.2.2 jdolecek } 131 1.3.2.2 jdolecek 132 1.3.2.2 jdolecek return 0; 133 1.3.2.2 jdolecek } 134 1.3.2.2 jdolecek 135 1.3.2.2 jdolecek static void 136 1.3.2.2 jdolecek mntva_attach(device_t parent, device_t self, void *aux) 137 1.3.2.2 jdolecek { 138 1.3.2.2 jdolecek struct mntva_softc *sc = device_private(self); 139 1.3.2.2 jdolecek struct wsemuldisplaydev_attach_args ws_aa; 140 1.3.2.2 jdolecek struct rasops_info *ri; 141 1.3.2.2 jdolecek struct zbus_args *zap = aux; 142 1.3.2.2 jdolecek long defattr; 143 1.3.2.2 jdolecek 144 1.3.2.2 jdolecek sc->sc_isconsole = false; 145 1.3.2.2 jdolecek /* this should come from "opt_mntva.h" auto generated by kernel conf system */ 146 1.3.2.2 jdolecek #ifdef MNTVA_CONSOLE 147 1.3.2.2 jdolecek sc->sc_isconsole = true; 148 1.3.2.2 jdolecek #endif /* MNTVA_CONSOLE */ 149 1.3.2.2 jdolecek 150 1.3.2.2 jdolecek printf(": MNT VA2000"); 151 1.3.2.2 jdolecek 152 1.3.2.2 jdolecek if(sc->sc_isconsole) 153 1.3.2.2 jdolecek printf(" (console)"); 154 1.3.2.2 jdolecek 155 1.3.2.2 jdolecek printf("\n"); 156 1.3.2.2 jdolecek 157 1.3.2.2 jdolecek sc->sc_dev = self; 158 1.3.2.2 jdolecek sc->sc_memsize = MNTVA_FB_SIZE; 159 1.3.2.2 jdolecek 160 1.3.2.2 jdolecek sc->sc_bst.base = (bus_addr_t) zap->va; 161 1.3.2.2 jdolecek sc->sc_bst.absm = &amiga_bus_stride_1; 162 1.3.2.2 jdolecek sc->sc_iot = &sc->sc_bst; 163 1.3.2.2 jdolecek 164 1.3.2.2 jdolecek if (bus_space_map(sc->sc_iot, MNTVA_OFF_REG, MNTVA_REG_SIZE , 0, 165 1.3.2.2 jdolecek &sc->sc_regh)) { 166 1.3.2.2 jdolecek aprint_error_dev(sc->sc_dev, "mapping registers failed\n"); 167 1.3.2.2 jdolecek return; 168 1.3.2.2 jdolecek } 169 1.3.2.2 jdolecek if (bus_space_map(sc->sc_iot, MNTVA_OFF_FB, sc->sc_memsize, 170 1.3.2.2 jdolecek BUS_SPACE_MAP_LINEAR, &sc->sc_fbh)) { 171 1.3.2.2 jdolecek aprint_error_dev(sc->sc_dev, "mapping framebuffer failed\n"); 172 1.3.2.2 jdolecek return; 173 1.3.2.2 jdolecek } 174 1.3.2.2 jdolecek 175 1.3.2.2 jdolecek sc->sc_regpa = (bus_addr_t) kvtop((void*) sc->sc_regh); 176 1.3.2.2 jdolecek sc->sc_fbpa = (bus_addr_t) kvtop((void*) sc->sc_fbh); 177 1.3.2.2 jdolecek 178 1.3.2.2 jdolecek /* print the physical and virt addresses for registers and fb */ 179 1.3.2.2 jdolecek aprint_normal_dev(sc->sc_dev, 180 1.3.2.2 jdolecek "registers at pa/va 0x%08x/0x%08x, fb at pa/va 0x%08x/0x%08x\n", 181 1.3.2.2 jdolecek (uint32_t) sc->sc_regpa, 182 1.3.2.2 jdolecek (uint32_t) bus_space_vaddr(sc->sc_iot, sc->sc_regh), 183 1.3.2.2 jdolecek (uint32_t) sc->sc_fbpa, 184 1.3.2.2 jdolecek (uint32_t) bus_space_vaddr(sc->sc_iot, sc->sc_fbh)); 185 1.3.2.2 jdolecek 186 1.3.2.2 jdolecek sc->sc_width = 1280; 187 1.3.2.2 jdolecek sc->sc_height = 720; 188 1.3.2.2 jdolecek sc->sc_bpp = 16; 189 1.3.2.2 jdolecek sc->sc_linebytes = 4096; 190 1.3.2.2 jdolecek 191 1.3.2.2 jdolecek aprint_normal_dev(sc->sc_dev, "%zu kB framebuffer memory present\n", 192 1.3.2.2 jdolecek sc->sc_memsize / 1024); 193 1.3.2.2 jdolecek 194 1.3.2.2 jdolecek aprint_normal_dev(sc->sc_dev, "setting %dx%d %d bpp resolution\n", 195 1.3.2.2 jdolecek sc->sc_width, sc->sc_height, sc->sc_bpp); 196 1.3.2.2 jdolecek 197 1.3.2.2 jdolecek mntva_mode_set(sc); 198 1.3.2.2 jdolecek 199 1.3.2.2 jdolecek sc->sc_defaultscreen_descr = (struct wsscreen_descr) { 200 1.3.2.2 jdolecek "default", 0, 0, NULL, 8, 16, 201 1.3.2.2 jdolecek WSSCREEN_WSCOLORS | WSSCREEN_HILIT, NULL }; 202 1.3.2.2 jdolecek sc->sc_screens[0] = &sc->sc_defaultscreen_descr; 203 1.3.2.2 jdolecek sc->sc_screenlist = (struct wsscreen_list) { 1, sc->sc_screens }; 204 1.3.2.2 jdolecek sc->sc_mode = WSDISPLAYIO_MODE_EMUL; 205 1.3.2.2 jdolecek 206 1.3.2.2 jdolecek vcons_init(&sc->vd, sc, &sc->sc_defaultscreen_descr, &mntva_accessops); 207 1.3.2.2 jdolecek sc->vd.init_screen = mntva_init_screen; 208 1.3.2.2 jdolecek 209 1.3.2.2 jdolecek ri = &sc->sc_console_screen.scr_ri; 210 1.3.2.2 jdolecek 211 1.3.2.2 jdolecek mntva_init_palette(sc); 212 1.3.2.2 jdolecek 213 1.3.2.2 jdolecek if (sc->sc_isconsole) { 214 1.3.2.2 jdolecek vcons_init_screen(&sc->vd, &sc->sc_console_screen, 1, 215 1.3.2.2 jdolecek &defattr); 216 1.3.2.2 jdolecek 217 1.3.2.2 jdolecek sc->sc_console_screen.scr_flags = VCONS_SCREEN_IS_STATIC; 218 1.3.2.2 jdolecek vcons_redraw_screen(&sc->sc_console_screen); 219 1.3.2.2 jdolecek 220 1.3.2.2 jdolecek sc->sc_defaultscreen_descr.textops = &ri->ri_ops; 221 1.3.2.2 jdolecek sc->sc_defaultscreen_descr.capabilities = ri->ri_caps; 222 1.3.2.2 jdolecek sc->sc_defaultscreen_descr.nrows = ri->ri_rows; 223 1.3.2.2 jdolecek sc->sc_defaultscreen_descr.ncols = ri->ri_cols; 224 1.3.2.2 jdolecek 225 1.3.2.2 jdolecek wsdisplay_cnattach(&sc->sc_defaultscreen_descr, ri, 0, 0, 226 1.3.2.2 jdolecek defattr); 227 1.3.2.2 jdolecek vcons_replay_msgbuf(&sc->sc_console_screen); 228 1.3.2.2 jdolecek } else { 229 1.3.2.2 jdolecek if (sc->sc_console_screen.scr_ri.ri_rows == 0) 230 1.3.2.2 jdolecek vcons_init_screen(&sc->vd, &sc->sc_console_screen, 1, 231 1.3.2.2 jdolecek &defattr); 232 1.3.2.2 jdolecek else 233 1.3.2.2 jdolecek (*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr); 234 1.3.2.2 jdolecek } 235 1.3.2.2 jdolecek 236 1.3.2.2 jdolecek ws_aa.console = sc->sc_isconsole; 237 1.3.2.2 jdolecek ws_aa.scrdata = &sc->sc_screenlist; 238 1.3.2.2 jdolecek ws_aa.accessops = &mntva_accessops; 239 1.3.2.2 jdolecek ws_aa.accesscookie = &sc->vd; 240 1.3.2.2 jdolecek 241 1.3.2.2 jdolecek config_found(sc->sc_dev, &ws_aa, wsemuldisplaydevprint); 242 1.3.2.2 jdolecek } 243 1.3.2.2 jdolecek 244 1.3.2.2 jdolecek static void 245 1.3.2.2 jdolecek mntva_init_palette(struct mntva_softc *sc) 246 1.3.2.2 jdolecek { 247 1.3.2.2 jdolecek int i, j; 248 1.3.2.2 jdolecek 249 1.3.2.2 jdolecek j = 0; 250 1.3.2.2 jdolecek for (i=0; i<256; i++) { 251 1.3.2.2 jdolecek mntva_reg_write(sc, 0x200+i*2, rasops_cmap[j]); 252 1.3.2.2 jdolecek mntva_reg_write(sc, 0x400+i*2, rasops_cmap[j+1]); 253 1.3.2.2 jdolecek mntva_reg_write(sc, 0x600+i*2, rasops_cmap[j+2]); 254 1.3.2.2 jdolecek j+=3; 255 1.3.2.2 jdolecek } 256 1.3.2.2 jdolecek } 257 1.3.2.2 jdolecek 258 1.3.2.2 jdolecek static void 259 1.3.2.2 jdolecek mntva_init_screen(void *cookie, struct vcons_screen *scr, int existing, 260 1.3.2.2 jdolecek long *defattr) 261 1.3.2.2 jdolecek { 262 1.3.2.2 jdolecek struct mntva_softc *sc = cookie; 263 1.3.2.2 jdolecek struct rasops_info *ri = &scr->scr_ri; 264 1.3.2.2 jdolecek 265 1.3.2.2 jdolecek wsfont_init(); 266 1.3.2.2 jdolecek 267 1.3.2.2 jdolecek ri->ri_depth = sc->sc_bpp; 268 1.3.2.2 jdolecek ri->ri_width = sc->sc_width; 269 1.3.2.2 jdolecek ri->ri_height = sc->sc_height; 270 1.3.2.2 jdolecek ri->ri_stride = sc->sc_linebytes; 271 1.3.2.2 jdolecek ri->ri_flg = 0; 272 1.3.2.2 jdolecek 273 1.3.2.2 jdolecek /*ri->ri_flg = RI_BSWAP;*/ 274 1.3.2.2 jdolecek 275 1.3.2.2 jdolecek ri->ri_bits = (char *) bus_space_vaddr(sc->sc_iot, sc->sc_fbh); 276 1.3.2.2 jdolecek #ifdef MNTVA_DEBUG 277 1.3.2.2 jdolecek aprint_normal_dev(sc->sc_dev, "ri_bits: %p\n", ri->ri_bits); 278 1.3.2.2 jdolecek #endif /* MNTVA_DEBUG */ 279 1.3.2.2 jdolecek 280 1.3.2.2 jdolecek scr->scr_flags = VCONS_SCREEN_IS_STATIC; 281 1.3.2.2 jdolecek 282 1.3.2.2 jdolecek rasops_init(ri, 0, 0); 283 1.3.2.2 jdolecek ri->ri_caps = WSSCREEN_WSCOLORS; 284 1.3.2.2 jdolecek rasops_reconfig(ri, sc->sc_height / ri->ri_font->fontheight, 285 1.3.2.2 jdolecek sc->sc_width / ri->ri_font->fontwidth); 286 1.3.2.2 jdolecek 287 1.3.2.2 jdolecek ri->ri_hw = scr; 288 1.3.2.2 jdolecek 289 1.3.2.2 jdolecek ri->ri_ops.eraserows = mntva_eraserows; 290 1.3.2.2 jdolecek ri->ri_ops.copyrows = mntva_copyrows; 291 1.3.2.2 jdolecek ri->ri_ops.erasecols = mntva_erasecols; 292 1.3.2.2 jdolecek ri->ri_ops.copycols = mntva_copycols; 293 1.3.2.2 jdolecek #if 0 294 1.3.2.2 jdolecek ri->ri_ops.cursor = mntva_cursor; 295 1.3.2.2 jdolecek #endif 296 1.3.2.2 jdolecek } 297 1.3.2.2 jdolecek 298 1.3.2.2 jdolecek static bool 299 1.3.2.2 jdolecek mntva_mode_set(struct mntva_softc *sc) 300 1.3.2.2 jdolecek { 301 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_CAPTURE_MODE, 0); 302 1.3.2.2 jdolecek 303 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_H_SYNC_START, 1390); 304 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_H_SYNC_END, 1430); 305 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_H_MAX, 1650); 306 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_V_SYNC_START, 725); 307 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_V_SYNC_END, 730); 308 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_V_MAX, 750); 309 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_PIXEL_CLK_SEL, MNTVA_CLK_75MHZ); 310 1.3.2.2 jdolecek 311 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_SCALEMODE, 0); 312 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_SCREENW, sc->sc_width); 313 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_SCREENH, sc->sc_height); 314 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_ROW_PITCH, 2048); 315 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_ROW_PITCH_SHIFT, 11); 316 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_BLITTER_ROW_PITCH, 2048); 317 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_BLITTER_ROW_PITCH_SHIFT, 11); 318 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_MARGIN_X, 8); 319 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_SAFE_X, 0x50); 320 1.3.2.2 jdolecek 321 1.3.2.2 jdolecek if (sc->sc_bpp == 8) 322 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_COLORMODE, MNTVA_COLORMODE8); 323 1.3.2.2 jdolecek else if (sc->sc_bpp == 16) 324 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_COLORMODE, MNTVA_COLORMODE16); 325 1.3.2.2 jdolecek else if (sc->sc_bpp == 32) 326 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_COLORMODE, MNTVA_COLORMODE32); 327 1.3.2.2 jdolecek 328 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_PANPTRHI, 0); 329 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_PANPTRLO, 0); 330 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_BLITTERBASEHI, 0); 331 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_BLITTERBASELO, 0); 332 1.3.2.2 jdolecek 333 1.3.2.2 jdolecek return true; 334 1.3.2.2 jdolecek } 335 1.3.2.2 jdolecek 336 1.3.2.2 jdolecek static uint16_t 337 1.3.2.2 jdolecek mntva_reg_read(struct mntva_softc *sc, uint32_t reg) 338 1.3.2.2 jdolecek { 339 1.3.2.2 jdolecek uint32_t rv; 340 1.3.2.2 jdolecek rv = bus_space_read_2(sc->sc_iot, sc->sc_regh, reg); 341 1.3.2.2 jdolecek return rv; 342 1.3.2.2 jdolecek } 343 1.3.2.2 jdolecek 344 1.3.2.2 jdolecek static void 345 1.3.2.2 jdolecek mntva_reg_write(struct mntva_softc *sc, uint32_t reg, uint32_t val) 346 1.3.2.2 jdolecek { 347 1.3.2.2 jdolecek bus_space_write_2(sc->sc_iot, sc->sc_regh, reg, val); 348 1.3.2.2 jdolecek } 349 1.3.2.2 jdolecek 350 1.3.2.2 jdolecek static void 351 1.3.2.2 jdolecek mntva_rectfill(struct mntva_softc *sc, int x, int y, int wi, int he, 352 1.3.2.2 jdolecek uint32_t color) 353 1.3.2.2 jdolecek { 354 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_BLITTERRGB, (uint16_t) color); 355 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_BLITTERX1, (uint16_t) x); 356 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_BLITTERY1, (uint16_t) y); 357 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_BLITTERX2, (uint16_t) x + wi - 1); 358 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_BLITTERY2, (uint16_t) y + he - 1); 359 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_BLITTER_ENABLE, MNTVA_BLITTER_FILL); 360 1.3.2.2 jdolecek 361 1.3.2.2 jdolecek while(mntva_reg_read(sc, MNTVA_BLITTER_ENABLE)) { 362 1.3.2.2 jdolecek /* busy wait */ 363 1.3.2.2 jdolecek } 364 1.3.2.2 jdolecek } 365 1.3.2.2 jdolecek 366 1.3.2.2 jdolecek static void 367 1.3.2.2 jdolecek mntva_bitblt(struct mntva_softc *sc, int xs, int ys, int xd, int yd, int wi, 368 1.3.2.2 jdolecek int he) 369 1.3.2.2 jdolecek { 370 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_BLITTERX1, (uint16_t) xd); 371 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_BLITTERY1, (uint16_t) yd); 372 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_BLITTERX2, (uint16_t) xd + wi - 1); 373 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_BLITTERY2, (uint16_t) yd + he - 1); 374 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_BLITTERX3, (uint16_t) xs); 375 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_BLITTERY3, (uint16_t) ys); 376 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_BLITTERX4, (uint16_t) xs + wi - 1); 377 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_BLITTERY4, (uint16_t) ys + he - 1); 378 1.3.2.2 jdolecek mntva_reg_write(sc, MNTVA_BLITTER_ENABLE, MNTVA_BLITTER_COPY); 379 1.3.2.2 jdolecek 380 1.3.2.2 jdolecek while(mntva_reg_read(sc, MNTVA_BLITTER_ENABLE)) { 381 1.3.2.2 jdolecek /* busy wait */ 382 1.3.2.2 jdolecek } 383 1.3.2.2 jdolecek } 384 1.3.2.2 jdolecek 385 1.3.2.2 jdolecek static void 386 1.3.2.2 jdolecek mntva_copyrows(void *cookie, int srcrow, int dstrow, int nrows) 387 1.3.2.2 jdolecek { 388 1.3.2.2 jdolecek struct mntva_softc *sc; 389 1.3.2.2 jdolecek struct rasops_info *ri; 390 1.3.2.2 jdolecek struct vcons_screen *scr; 391 1.3.2.2 jdolecek int x, ys, yd, wi, he; 392 1.3.2.2 jdolecek 393 1.3.2.2 jdolecek ri = cookie; 394 1.3.2.2 jdolecek scr = ri->ri_hw; 395 1.3.2.2 jdolecek sc = scr->scr_cookie; 396 1.3.2.2 jdolecek 397 1.3.2.2 jdolecek if (sc->sc_mode == WSDISPLAYIO_MODE_EMUL) { 398 1.3.2.2 jdolecek x = ri->ri_xorigin; 399 1.3.2.2 jdolecek ys = ri->ri_yorigin + ri->ri_font->fontheight * srcrow; 400 1.3.2.2 jdolecek yd = ri->ri_yorigin + ri->ri_font->fontheight * dstrow; 401 1.3.2.2 jdolecek wi = ri->ri_emuwidth; 402 1.3.2.2 jdolecek he = ri->ri_font->fontheight * nrows; 403 1.3.2.2 jdolecek mntva_bitblt(sc, x, ys, x, yd, wi, he); 404 1.3.2.2 jdolecek } 405 1.3.2.2 jdolecek } 406 1.3.2.2 jdolecek 407 1.3.2.2 jdolecek static void 408 1.3.2.2 jdolecek mntva_eraserows(void *cookie, int row, int nrows, long fillattr) 409 1.3.2.2 jdolecek { 410 1.3.2.2 jdolecek struct mntva_softc *sc; 411 1.3.2.2 jdolecek struct rasops_info *ri; 412 1.3.2.2 jdolecek struct vcons_screen *scr; 413 1.3.2.2 jdolecek int x, y, wi, he, fg, bg, ul; 414 1.3.2.2 jdolecek 415 1.3.2.2 jdolecek ri = cookie; 416 1.3.2.2 jdolecek scr = ri->ri_hw; 417 1.3.2.2 jdolecek sc = scr->scr_cookie; 418 1.3.2.2 jdolecek 419 1.3.2.2 jdolecek if (sc->sc_mode == WSDISPLAYIO_MODE_EMUL) { 420 1.3.2.2 jdolecek rasops_unpack_attr(fillattr, &fg, &bg, &ul); 421 1.3.2.2 jdolecek if ((row == 0) && (nrows == ri->ri_rows)) 422 1.3.2.2 jdolecek mntva_rectfill(sc, 0, 0, ri->ri_width, 423 1.3.2.2 jdolecek ri->ri_height, ri->ri_devcmap[bg]); 424 1.3.2.2 jdolecek else { 425 1.3.2.2 jdolecek x = ri->ri_xorigin; 426 1.3.2.2 jdolecek y = ri->ri_yorigin + ri->ri_font->fontheight * row; 427 1.3.2.2 jdolecek wi = ri->ri_emuwidth; 428 1.3.2.2 jdolecek he = ri->ri_font->fontheight * nrows; 429 1.3.2.2 jdolecek mntva_rectfill(sc, x, y, wi, he, ri->ri_devcmap[bg]); 430 1.3.2.2 jdolecek } 431 1.3.2.2 jdolecek } 432 1.3.2.2 jdolecek } 433 1.3.2.2 jdolecek 434 1.3.2.2 jdolecek static void 435 1.3.2.2 jdolecek mntva_copycols(void *cookie, int row, int srccol, int dstcol, int ncols) 436 1.3.2.2 jdolecek { 437 1.3.2.2 jdolecek struct mntva_softc *sc; 438 1.3.2.2 jdolecek struct rasops_info *ri; 439 1.3.2.2 jdolecek struct vcons_screen *scr; 440 1.3.2.2 jdolecek int xs, xd, y, w, h; 441 1.3.2.2 jdolecek 442 1.3.2.2 jdolecek ri = cookie; 443 1.3.2.2 jdolecek scr = ri->ri_hw; 444 1.3.2.2 jdolecek sc = scr->scr_cookie; 445 1.3.2.2 jdolecek 446 1.3.2.2 jdolecek if (sc->sc_mode == WSDISPLAYIO_MODE_EMUL) { 447 1.3.2.2 jdolecek xs = ri->ri_xorigin + ri->ri_font->fontwidth * srccol; 448 1.3.2.2 jdolecek xd = ri->ri_xorigin + ri->ri_font->fontwidth * dstcol; 449 1.3.2.2 jdolecek y = ri->ri_yorigin + ri->ri_font->fontheight * row; 450 1.3.2.2 jdolecek w = ri->ri_font->fontwidth * ncols; 451 1.3.2.2 jdolecek h = ri->ri_font->fontheight; 452 1.3.2.2 jdolecek mntva_bitblt(sc, xs, y, xd, y, w, h); 453 1.3.2.2 jdolecek } 454 1.3.2.2 jdolecek 455 1.3.2.2 jdolecek } 456 1.3.2.2 jdolecek 457 1.3.2.2 jdolecek static void 458 1.3.2.2 jdolecek mntva_erasecols(void *cookie, int row, int startcol, int ncols, long fillattr) 459 1.3.2.2 jdolecek { 460 1.3.2.2 jdolecek struct mntva_softc *sc; 461 1.3.2.2 jdolecek struct rasops_info *ri; 462 1.3.2.2 jdolecek struct vcons_screen *scr; 463 1.3.2.2 jdolecek int x, y, w, h, fg, bg, ul; 464 1.3.2.2 jdolecek 465 1.3.2.2 jdolecek ri = cookie; 466 1.3.2.2 jdolecek scr = ri->ri_hw; 467 1.3.2.2 jdolecek sc = scr->scr_cookie; 468 1.3.2.2 jdolecek 469 1.3.2.2 jdolecek if (sc->sc_mode == WSDISPLAYIO_MODE_EMUL) { 470 1.3.2.2 jdolecek x = ri->ri_xorigin + ri->ri_font->fontwidth * startcol; 471 1.3.2.2 jdolecek y = ri->ri_yorigin + ri->ri_font->fontheight * row; 472 1.3.2.2 jdolecek w = ri->ri_font->fontwidth * ncols; 473 1.3.2.2 jdolecek h = ri->ri_font->fontheight; 474 1.3.2.2 jdolecek rasops_unpack_attr(fillattr, &fg, &bg, &ul); 475 1.3.2.2 jdolecek mntva_rectfill(sc, x, y, w, h, ri->ri_devcmap[bg & 0xf]); 476 1.3.2.2 jdolecek } 477 1.3.2.2 jdolecek } 478 1.3.2.2 jdolecek 479 1.3.2.2 jdolecek static int 480 1.3.2.2 jdolecek mntva_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, struct lwp *l) 481 1.3.2.2 jdolecek { 482 1.3.2.2 jdolecek struct vcons_data *vd; 483 1.3.2.2 jdolecek struct mntva_softc *sc; 484 1.3.2.2 jdolecek struct wsdisplay_fbinfo *wsfbi; 485 1.3.2.2 jdolecek struct vcons_screen *ms; 486 1.3.2.2 jdolecek struct wsdisplayio_bus_id *busid; 487 1.3.2.2 jdolecek 488 1.3.2.2 jdolecek vd = v; 489 1.3.2.2 jdolecek sc = vd->cookie; 490 1.3.2.2 jdolecek ms = vd->active; 491 1.3.2.2 jdolecek 492 1.3.2.2 jdolecek switch (cmd) { 493 1.3.2.2 jdolecek case WSDISPLAYIO_GTYPE: 494 1.3.2.2 jdolecek *(u_int *) data = WSDISPLAY_TYPE_UNKNOWN; 495 1.3.2.2 jdolecek return 0; 496 1.3.2.2 jdolecek 497 1.3.2.2 jdolecek case WSDISPLAYIO_GET_BUSID: 498 1.3.2.2 jdolecek busid = data; 499 1.3.2.2 jdolecek busid->bus_type = WSDISPLAYIO_BUS_SOC; 500 1.3.2.2 jdolecek return 0; 501 1.3.2.2 jdolecek 502 1.3.2.2 jdolecek case WSDISPLAYIO_GINFO: 503 1.3.2.2 jdolecek if (ms == NULL) 504 1.3.2.2 jdolecek return ENODEV; 505 1.3.2.2 jdolecek 506 1.3.2.2 jdolecek wsfbi = (void *) data; 507 1.3.2.2 jdolecek wsfbi->height = ms->scr_ri.ri_height; 508 1.3.2.2 jdolecek wsfbi->width = ms->scr_ri.ri_width; 509 1.3.2.2 jdolecek wsfbi->depth = ms->scr_ri.ri_depth; 510 1.3.2.2 jdolecek wsfbi->cmsize = 256; 511 1.3.2.2 jdolecek return 0; 512 1.3.2.2 jdolecek 513 1.3.2.2 jdolecek case WSDISPLAYIO_LINEBYTES: 514 1.3.2.2 jdolecek *(u_int *) data = sc->sc_linebytes; 515 1.3.2.2 jdolecek return 0; 516 1.3.2.2 jdolecek 517 1.3.2.2 jdolecek case WSDISPLAYIO_SMODE: 518 1.3.2.2 jdolecek { 519 1.3.2.2 jdolecek int new_mode = *(int *) data; 520 1.3.2.2 jdolecek if (new_mode != sc->sc_mode) { 521 1.3.2.2 jdolecek sc->sc_mode = new_mode; 522 1.3.2.2 jdolecek if (new_mode == WSDISPLAYIO_MODE_EMUL) 523 1.3.2.2 jdolecek vcons_redraw_screen(ms); 524 1.3.2.2 jdolecek } 525 1.3.2.2 jdolecek return 0; 526 1.3.2.2 jdolecek } 527 1.3.2.2 jdolecek case WSDISPLAYIO_GET_FBINFO: 528 1.3.2.2 jdolecek { 529 1.3.2.2 jdolecek struct wsdisplayio_fbinfo *fbi = data; 530 1.3.2.2 jdolecek struct rasops_info *ri; 531 1.3.2.2 jdolecek int ret; 532 1.3.2.2 jdolecek 533 1.3.2.2 jdolecek ri = &sc->vd.active->scr_ri; 534 1.3.2.2 jdolecek ret = wsdisplayio_get_fbinfo(ri, fbi); 535 1.3.2.2 jdolecek return ret; 536 1.3.2.2 jdolecek } 537 1.3.2.2 jdolecek } 538 1.3.2.2 jdolecek 539 1.3.2.2 jdolecek return EPASSTHROUGH; 540 1.3.2.2 jdolecek } 541 1.3.2.2 jdolecek 542 1.3.2.2 jdolecek #if 0 543 1.3.2.2 jdolecek static void 544 1.3.2.2 jdolecek mntva_cursor(void *cookie, int on, int row, int col) 545 1.3.2.2 jdolecek { 546 1.3.2.2 jdolecek struct mntva_softc *sc; 547 1.3.2.2 jdolecek struct rasops_info *ri; 548 1.3.2.2 jdolecek struct vcons_screen *scr; 549 1.3.2.2 jdolecek int x, y, wi, he; 550 1.3.2.2 jdolecek 551 1.3.2.2 jdolecek ri = cookie; 552 1.3.2.2 jdolecek scr = ri->ri_hw; 553 1.3.2.2 jdolecek sc = scr->scr_cookie; 554 1.3.2.2 jdolecek 555 1.3.2.2 jdolecek wi = ri->ri_font->fontwidth; 556 1.3.2.2 jdolecek he = ri->ri_font->fontheight; 557 1.3.2.2 jdolecek 558 1.3.2.2 jdolecek if (sc->sc_mode == WSDISPLAYIO_MODE_EMUL) { 559 1.3.2.2 jdolecek x = ri->ri_ccol * wi + ri->ri_xorigin; 560 1.3.2.2 jdolecek y = ri->ri_crow * he + ri->ri_yorigin; 561 1.3.2.2 jdolecek if (ri->ri_flg & RI_CURSOR) { 562 1.3.2.2 jdolecek mntva_bitblt(sc, x, y, x, y, wi, he); 563 1.3.2.2 jdolecek ri->ri_flg &= ~RI_CURSOR; 564 1.3.2.2 jdolecek } 565 1.3.2.2 jdolecek ri->ri_crow = row; 566 1.3.2.2 jdolecek ri->ri_ccol = col; 567 1.3.2.2 jdolecek if (on) { 568 1.3.2.2 jdolecek x = ri->ri_ccol * wi + ri->ri_xorigin; 569 1.3.2.2 jdolecek y = ri->ri_crow * he + ri->ri_yorigin; 570 1.3.2.2 jdolecek mntva_bitblt(sc, x, y, x, y, wi, he); 571 1.3.2.2 jdolecek ri->ri_flg |= RI_CURSOR; 572 1.3.2.2 jdolecek } 573 1.3.2.2 jdolecek } else { 574 1.3.2.2 jdolecek scr->scr_ri.ri_crow = row; 575 1.3.2.2 jdolecek scr->scr_ri.ri_ccol = col; 576 1.3.2.2 jdolecek scr->scr_ri.ri_flg &= ~RI_CURSOR; 577 1.3.2.2 jdolecek } 578 1.3.2.2 jdolecek } 579 1.3.2.2 jdolecek #endif 580 1.3.2.2 jdolecek 581 1.3.2.2 jdolecek static paddr_t 582 1.3.2.2 jdolecek mntva_mmap(void *v, void *vs, off_t offset, int prot) 583 1.3.2.2 jdolecek { 584 1.3.2.2 jdolecek struct vcons_data *vd; 585 1.3.2.2 jdolecek struct mntva_softc *sc; 586 1.3.2.2 jdolecek paddr_t pa; 587 1.3.2.2 jdolecek 588 1.3.2.2 jdolecek vd = v; 589 1.3.2.2 jdolecek sc = vd->cookie; 590 1.3.2.2 jdolecek 591 1.3.2.2 jdolecek if (offset >= 0 && offset < sc->sc_memsize) { 592 1.3.2.2 jdolecek pa = bus_space_mmap(sc->sc_iot, sc->sc_fbpa, offset, prot, 593 1.3.2.2 jdolecek BUS_SPACE_MAP_LINEAR); 594 1.3.2.2 jdolecek return pa; 595 1.3.2.2 jdolecek } 596 1.3.2.2 jdolecek 597 1.3.2.2 jdolecek return -1; 598 1.3.2.2 jdolecek } 599 1.3.2.2 jdolecek 600 1.3.2.2 jdolecek void 601 1.3.2.2 jdolecek mntvacninit(struct consdev *cd) 602 1.3.2.2 jdolecek { 603 1.3.2.2 jdolecek /*wsdisplay_preattach(sc->sc_defaultscreen, ri, 0, 0, defattr);*/ 604 1.3.2.2 jdolecek } 605 1.3.2.2 jdolecek 606 1.3.2.2 jdolecek void 607 1.3.2.2 jdolecek mntvacnprobe(struct consdev *cd) 608 1.3.2.2 jdolecek { 609 1.3.2.2 jdolecek #ifdef MNTVA_CONSOLE 610 1.3.2.2 jdolecek /* 611 1.3.2.2 jdolecek * This isn't exactly true, but cons.h does not define anything 612 1.3.2.2 jdolecek * that would fit our case exactly. 613 1.3.2.2 jdolecek */ 614 1.3.2.2 jdolecek cd->cn_pri = CN_INTERNAL; 615 1.3.2.2 jdolecek 616 1.3.2.2 jdolecek cd->cn_dev = NODEV; /* Filled later by wscons. */ 617 1.3.2.2 jdolecek #endif /* MNTVA_CONSOLE */ 618 1.3.2.2 jdolecek } 619 1.3.2.2 jdolecek 620 1.3.2.2 jdolecek /* ARGSUSED */ 621 1.3.2.2 jdolecek void 622 1.3.2.2 jdolecek mntvacnputc(dev_t cd, int ch) 623 1.3.2.2 jdolecek { 624 1.3.2.2 jdolecek } 625 1.3.2.2 jdolecek 626 1.3.2.2 jdolecek /* ARGSUSED */ 627 1.3.2.2 jdolecek int 628 1.3.2.2 jdolecek mntvacngetc(dev_t cd) 629 1.3.2.2 jdolecek { 630 1.3.2.2 jdolecek return(0); 631 1.3.2.2 jdolecek } 632 1.3.2.2 jdolecek 633 1.3.2.2 jdolecek /* ARGSUSED */ 634 1.3.2.2 jdolecek void 635 1.3.2.2 jdolecek mntvacnpollc(dev_t cd, int on) 636 1.3.2.2 jdolecek { 637 1.3.2.2 jdolecek } 638 1.3.2.2 jdolecek 639
Indexes created Wed Oct 22 13:09:56 GMT 2025