sys/isa/vga_isa.c

   1 /*-
   2  * Copyright (c) 1999 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp>
   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 as
  10  *    the first lines of this file unmodified.
  11  * 2. Redistributions in binary form must reproduce the above copyright
  12  *    notice, this list of conditions and the following disclaimer in the
  13  *    documentation and/or other materials provided with the distribution.
  14  *
  15  * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
  16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  17  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  18  * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
  19  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  20  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  21  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  22  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  23  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  24  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  25  */
  26
  27 #include <sys/cdefs.h>
  28 __FBSDID("$FreeBSD$");
  29
  30 #include "opt_vga.h"
  31 #include "opt_fb.h"
  32 #include "opt_syscons.h"        /* should be removed in the future, XXX */
  33
  34 #include <sys/param.h>
  35 #include <sys/systm.h>
  36 #include <sys/kernel.h>
  37 #include <sys/malloc.h>
  38 #include <sys/module.h>
  39 #include <sys/conf.h>
  40 #include <sys/bus.h>
  41 #include <sys/fbio.h>
  42
  43 #include <machine/bus.h>
  44 #include <machine/resource.h>
  45
  46 #include <sys/rman.h>
  47
  48 #include <vm/vm.h>
  49 #include <vm/pmap.h>
  50
  51 #include <machine/md_var.h>
  52 #ifdef __i386__
  53 #include <machine/pc/bios.h>
  54 #endif
  55
  56 #include <dev/fb/fbreg.h>
  57 #include <dev/fb/vgareg.h>
  58
  59 #include <isa/isareg.h>
  60 #include <isa/isavar.h>
  61
  62 #define VGA_SOFTC(unit)         \
  63         ((vga_softc_t *)devclass_get_softc(isavga_devclass, unit))
  64
  65 static devclass_t       isavga_devclass;
  66
  67 #ifdef FB_INSTALL_CDEV
  68
  69 static d_open_t         isavga_open;
  70 static d_close_t        isavga_close;
  71 static d_read_t         isavga_read;
  72 static d_write_t        isavga_write;
  73 static d_ioctl_t        isavga_ioctl;
  74 static d_mmap_t         isavga_mmap;
  75
  76 static struct cdevsw isavga_cdevsw = {
  77         .d_version =    D_VERSION,
  78         .d_flags =      D_NEEDGIANT,
  79         .d_open =       isavga_open,
  80         .d_close =      isavga_close,
  81         .d_read =       isavga_read,
  82         .d_write =      isavga_write,
  83         .d_ioctl =      isavga_ioctl,
  84         .d_mmap =       isavga_mmap,
  85         .d_name =       VGA_DRIVER_NAME,
  86 };
  87
  88 #endif /* FB_INSTALL_CDEV */
  89
  90 static void
  91 isavga_identify(driver_t *driver, device_t parent)
  92 {
  93         BUS_ADD_CHILD(parent, ISA_ORDER_SPECULATIVE, VGA_DRIVER_NAME, 0);
  94 }
  95
  96 static int
  97 isavga_probe(device_t dev)
  98 {
  99         video_adapter_t adp;
 100         int error;
 101
 102         /* No pnp support */
 103         if (isa_get_vendorid(dev))
 104                 return (ENXIO);
 105
 106         device_set_desc(dev, "Generic ISA VGA");
 107         error = vga_probe_unit(device_get_unit(dev), &adp, device_get_flags(dev));
 108         if (error == 0) {
 109                 bus_set_resource(dev, SYS_RES_IOPORT, 0,
 110                                  adp.va_io_base, adp.va_io_size);
 111                 bus_set_resource(dev, SYS_RES_MEMORY, 0,
 112                                  adp.va_mem_base, adp.va_mem_size);
 113 #if 0
 114                 isa_set_port(dev, adp.va_io_base);
 115                 isa_set_portsize(dev, adp.va_io_size);
 116                 isa_set_maddr(dev, adp.va_mem_base);
 117                 isa_set_msize(dev, adp.va_mem_size);
 118 #endif
 119         }
 120         return error;
 121 }
 122
 123 static int
 124 isavga_attach(device_t dev)
 125 {
 126         vga_softc_t *sc;
 127         int unit;
 128         int rid;
 129         int error;
 130
 131         unit = device_get_unit(dev);
 132         sc = device_get_softc(dev);
 133
 134         rid = 0;
 135         bus_alloc_resource(dev, SYS_RES_IOPORT, &rid,
 136                                   0, ~0, 0, RF_ACTIVE | RF_SHAREABLE);
 137         rid = 0;
 138         bus_alloc_resource(dev, SYS_RES_MEMORY, &rid,
 139                                  0, ~0, 0, RF_ACTIVE | RF_SHAREABLE);
 140
 141         error = vga_attach_unit(unit, sc, device_get_flags(dev));
 142         if (error)
 143                 return error;
 144
 145 #ifdef FB_INSTALL_CDEV
 146         /* attach a virtual frame buffer device */
 147         error = fb_attach(VGA_MKMINOR(unit), sc->adp, &isavga_cdevsw);
 148         if (error)
 149                 return error;
 150 #endif /* FB_INSTALL_CDEV */
 151
 152         if (0 && bootverbose)
 153                 (*vidsw[sc->adp->va_index]->diag)(sc->adp, bootverbose);
 154
 155 #if 0 /* experimental */
 156         device_add_child(dev, "fb", -1);
 157         bus_generic_attach(dev);
 158 #endif
 159
 160         return 0;
 161 }
 162
 163 static int
 164 isavga_suspend(device_t dev)
 165 {
 166         vga_softc_t *sc;
 167         int err, nbytes;
 168
 169         sc = device_get_softc(dev);
 170         err = bus_generic_suspend(dev);
 171         if (err)
 172                 return (err);
 173
 174         /* Save the video state across the suspend. */
 175         if (sc->state_buf != NULL) {
 176                 free(sc->state_buf, M_TEMP);
 177                 sc->state_buf = NULL;
 178         }
 179         nbytes = (*vidsw[sc->adp->va_index]->save_state)(sc->adp, NULL, 0);
 180         if (nbytes <= 0)
 181                 return (0);
 182         sc->state_buf = malloc(nbytes, M_TEMP, M_NOWAIT | M_ZERO);
 183         if (sc->state_buf == NULL)
 184                 return (0);
 185         if (bootverbose)
 186                 device_printf(dev, "saving %d bytes of video state\n", nbytes);
 187         if ((*vidsw[sc->adp->va_index]->save_state)(sc->adp, sc->state_buf,
 188             nbytes) != 0) {
 189                 device_printf(dev, "failed to save state (nbytes=%d)\n",
 190                     nbytes);
 191                 free(sc->state_buf, M_TEMP);
 192                 sc->state_buf = NULL;
 193         }
 194         return (0);
 195 }
 196
 197 static int
 198 isavga_resume(device_t dev)
 199 {
 200         vga_softc_t *sc;
 201
 202         sc = device_get_softc(dev);
 203         if (sc->state_buf != NULL) {
 204                 if ((*vidsw[sc->adp->va_index]->load_state)(sc->adp,
 205                     sc->state_buf) != 0)
 206                         device_printf(dev, "failed to reload state\n");
 207                 free(sc->state_buf, M_TEMP);
 208                 sc->state_buf = NULL;
 209         }
 210
 211         bus_generic_resume(dev);
 212         return 0;
 213 }
 214
 215 #ifdef FB_INSTALL_CDEV
 216
 217 static int
 218 isavga_open(struct cdev *dev, int flag, int mode, struct thread *td)
 219 {
 220         return vga_open(dev, VGA_SOFTC(VGA_UNIT(dev)), flag, mode, td);
 221 }
 222
 223 static int
 224 isavga_close(struct cdev *dev, int flag, int mode, struct thread *td)
 225 {
 226         return vga_close(dev, VGA_SOFTC(VGA_UNIT(dev)), flag, mode, td);
 227 }
 228
 229 static int
 230 isavga_read(struct cdev *dev, struct uio *uio, int flag)
 231 {
 232         return vga_read(dev, VGA_SOFTC(VGA_UNIT(dev)), uio, flag);
 233 }
 234
 235 static int
 236 isavga_write(struct cdev *dev, struct uio *uio, int flag)
 237 {
 238         return vga_write(dev, VGA_SOFTC(VGA_UNIT(dev)), uio, flag);
 239 }
 240
 241 static int
 242 isavga_ioctl(struct cdev *dev, u_long cmd, caddr_t arg, int flag, struct thread *td)
 243 {
 244         return vga_ioctl(dev, VGA_SOFTC(VGA_UNIT(dev)), cmd, arg, flag, td);
 245 }
 246
 247 static int
 248 isavga_mmap(struct cdev *dev, vm_offset_t offset, vm_paddr_t *paddr, int prot)
 249 {
 250         return vga_mmap(dev, VGA_SOFTC(VGA_UNIT(dev)), offset, paddr, prot);
 251 }
 252
 253 #endif /* FB_INSTALL_CDEV */
 254
 255 static device_method_t isavga_methods[] = {
 256         DEVMETHOD(device_identify,      isavga_identify),
 257         DEVMETHOD(device_probe,         isavga_probe),
 258         DEVMETHOD(device_attach,        isavga_attach),
 259         DEVMETHOD(device_suspend,       isavga_suspend),
 260         DEVMETHOD(device_resume,        isavga_resume),
 261
 262         DEVMETHOD(bus_print_child,      bus_generic_print_child),
 263         { 0, 0 }
 264 };
 265
 266 static driver_t isavga_driver = {
 267         VGA_DRIVER_NAME,
 268         isavga_methods,
 269         sizeof(vga_softc_t),
 270 };
 271
 272 DRIVER_MODULE(vga, isa, isavga_driver, isavga_devclass, 0, 0);