vga_isa.c revision 199002
143105Sdfr/*- 243105Sdfr * Copyright (c) 1999 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp> 343105Sdfr * All rights reserved. 443105Sdfr * 543105Sdfr * Redistribution and use in source and binary forms, with or without 643105Sdfr * modification, are permitted provided that the following conditions 743105Sdfr * are met: 843105Sdfr * 1. Redistributions of source code must retain the above copyright 943105Sdfr * notice, this list of conditions and the following disclaimer as 1043105Sdfr * the first lines of this file unmodified. 1143105Sdfr * 2. Redistributions in binary form must reproduce the above copyright 1243105Sdfr * notice, this list of conditions and the following disclaimer in the 1343105Sdfr * documentation and/or other materials provided with the distribution. 1443105Sdfr * 1543105Sdfr * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR 1643105Sdfr * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 1743105Sdfr * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 1843105Sdfr * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT, 1943105Sdfr * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 2043105Sdfr * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 2143105Sdfr * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 2243105Sdfr * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 2343105Sdfr * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 2443105Sdfr * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 2543105Sdfr */ 2643105Sdfr 27116181Sobrien#include <sys/cdefs.h> 28116181Sobrien__FBSDID("$FreeBSD: head/sys/isa/vga_isa.c 199002 2009-11-06 20:32:26Z jkim $"); 29116181Sobrien 3043105Sdfr#include "opt_vga.h" 3143105Sdfr#include "opt_fb.h" 3243105Sdfr#include "opt_syscons.h" /* should be removed in the future, XXX */ 3343105Sdfr 3443105Sdfr#include <sys/param.h> 3543105Sdfr#include <sys/systm.h> 3643105Sdfr#include <sys/kernel.h> 37142833Siedowse#include <sys/malloc.h> 38129880Sphk#include <sys/module.h> 3948104Syokota#include <sys/conf.h> 4043105Sdfr#include <sys/bus.h> 4148104Syokota#include <sys/fbio.h> 4243105Sdfr 4348104Syokota#include <machine/bus.h> 4448104Syokota#include <machine/resource.h> 4548104Syokota 4648104Syokota#include <sys/rman.h> 4748104Syokota 4843105Sdfr#include <vm/vm.h> 4943105Sdfr#include <vm/pmap.h> 5043105Sdfr 5143105Sdfr#include <machine/md_var.h> 52114384Speter#ifdef __i386__ 5343105Sdfr#include <machine/pc/bios.h> 54114384Speter#endif 5543105Sdfr 5643105Sdfr#include <dev/fb/fbreg.h> 5743105Sdfr#include <dev/fb/vgareg.h> 5843105Sdfr 5943105Sdfr#include <isa/isareg.h> 6043105Sdfr#include <isa/isavar.h> 6143105Sdfr 6248104Syokota#define VGA_SOFTC(unit) \ 6348104Syokota ((vga_softc_t *)devclass_get_softc(isavga_devclass, unit)) 6443105Sdfr 6548104Syokotastatic devclass_t isavga_devclass; 6643105Sdfr 6743105Sdfr#ifdef FB_INSTALL_CDEV 6843105Sdfr 6948104Syokotastatic d_open_t isavga_open; 7048104Syokotastatic d_close_t isavga_close; 7148104Syokotastatic d_read_t isavga_read; 7248104Syokotastatic d_write_t isavga_write; 7348104Syokotastatic d_ioctl_t isavga_ioctl; 7448104Syokotastatic d_mmap_t isavga_mmap; 7543105Sdfr 7648104Syokotastatic struct cdevsw isavga_cdevsw = { 77126080Sphk .d_version = D_VERSION, 78126080Sphk .d_flags = D_NEEDGIANT, 79111815Sphk .d_open = isavga_open, 80111815Sphk .d_close = isavga_close, 81111815Sphk .d_read = isavga_read, 82111815Sphk .d_write = isavga_write, 83111815Sphk .d_ioctl = isavga_ioctl, 84111815Sphk .d_mmap = isavga_mmap, 85111815Sphk .d_name = VGA_DRIVER_NAME, 8643105Sdfr}; 8743105Sdfr 8843105Sdfr#endif /* FB_INSTALL_CDEV */ 8943105Sdfr 9062225Speterstatic void 9162225Speterisavga_identify(driver_t *driver, device_t parent) 9262225Speter{ 9362225Speter BUS_ADD_CHILD(parent, ISA_ORDER_SPECULATIVE, VGA_DRIVER_NAME, 0); 9462225Speter} 9562225Speter 9643105Sdfrstatic int 9743105Sdfrisavga_probe(device_t dev) 9843105Sdfr{ 9948104Syokota video_adapter_t adp; 10048104Syokota int error; 10143105Sdfr 10247618Sdfr /* No pnp support */ 10347618Sdfr if (isa_get_vendorid(dev)) 10447618Sdfr return (ENXIO); 10547618Sdfr 10643105Sdfr device_set_desc(dev, "Generic ISA VGA"); 10751052Sdfr error = vga_probe_unit(device_get_unit(dev), &adp, device_get_flags(dev)); 10848104Syokota if (error == 0) { 10952174Sdfr bus_set_resource(dev, SYS_RES_IOPORT, 0, 11048104Syokota adp.va_io_base, adp.va_io_size); 11152174Sdfr bus_set_resource(dev, SYS_RES_MEMORY, 0, 11248104Syokota adp.va_mem_base, adp.va_mem_size); 11348104Syokota#if 0 11448104Syokota isa_set_port(dev, adp.va_io_base); 11548104Syokota isa_set_portsize(dev, adp.va_io_size); 11648104Syokota isa_set_maddr(dev, adp.va_mem_base); 11748104Syokota isa_set_msize(dev, adp.va_mem_size); 11848104Syokota#endif 11948104Syokota } 120199002Sjkim return (error); 12143105Sdfr} 12243105Sdfr 12343105Sdfrstatic int 12443105Sdfrisavga_attach(device_t dev) 12543105Sdfr{ 12648104Syokota vga_softc_t *sc; 127199002Sjkim devclass_t dc; 128199002Sjkim device_t *devs; 129199002Sjkim void *vgapci_sc; 130199002Sjkim int count, i; 13148104Syokota int unit; 13248104Syokota int rid; 13348104Syokota int error; 13443105Sdfr 13548104Syokota unit = device_get_unit(dev); 13643105Sdfr sc = device_get_softc(dev); 13743105Sdfr 13848104Syokota rid = 0; 139115549Sphk bus_alloc_resource(dev, SYS_RES_IOPORT, &rid, 14048104Syokota 0, ~0, 0, RF_ACTIVE | RF_SHAREABLE); 14148104Syokota rid = 0; 142115549Sphk bus_alloc_resource(dev, SYS_RES_MEMORY, &rid, 14348104Syokota 0, ~0, 0, RF_ACTIVE | RF_SHAREABLE); 14443105Sdfr 14551052Sdfr error = vga_attach_unit(unit, sc, device_get_flags(dev)); 14643105Sdfr if (error) 147199002Sjkim return (error); 14843105Sdfr 14943105Sdfr#ifdef FB_INSTALL_CDEV 15043105Sdfr /* attach a virtual frame buffer device */ 151120465Sphk error = fb_attach(VGA_MKMINOR(unit), sc->adp, &isavga_cdevsw); 15243105Sdfr if (error) 153199002Sjkim return (error); 15443105Sdfr#endif /* FB_INSTALL_CDEV */ 15543105Sdfr 156137148Sphk if (0 && bootverbose) 157174985Swkoszek vidd_diag(sc->adp, bootverbose); 15843105Sdfr 159153072Sru#if 0 /* experimental */ 16054073Smdodd device_add_child(dev, "fb", -1); 16148104Syokota bus_generic_attach(dev); 16243105Sdfr#endif 16343105Sdfr 164199002Sjkim /* Find the matching PCI video controller. */ 165199002Sjkim if (unit == 0) { 166199002Sjkim dc = devclass_find("vgapci"); 167199002Sjkim if (dc != NULL && 168199002Sjkim devclass_get_devices(dc, &devs, &count) == 0) { 169199002Sjkim for (i = 0; i < count; i++) 170199002Sjkim if (device_get_flags(devs[i]) != 0) { 171199002Sjkim sc->pci_dev = devs[i]; 172199002Sjkim break; 173199002Sjkim } 174199002Sjkim free(devs, M_TEMP); 175199002Sjkim } 176199002Sjkim if (sc->pci_dev != NULL) { 177199002Sjkim vgapci_sc = device_get_softc(sc->pci_dev); 178199002Sjkim *(device_t *)vgapci_sc = dev; 179199002Sjkim device_printf(dev, "associated with %s\n", 180199002Sjkim device_get_nameunit(sc->pci_dev)); 181199002Sjkim } 182199002Sjkim } 183199002Sjkim 184199002Sjkim return (0); 18543105Sdfr} 18643105Sdfr 187142833Siedowsestatic int 188142833Siedowseisavga_suspend(device_t dev) 189142833Siedowse{ 190142833Siedowse vga_softc_t *sc; 191199002Sjkim device_t isa_dev; 192142833Siedowse int err, nbytes; 193142833Siedowse 194199002Sjkim err = 0; 195199002Sjkim isa_dev = dev; 196199002Sjkim sc = device_get_softc(isa_dev); 197199002Sjkim if (sc->pci_dev != NULL) 198199002Sjkim dev = sc->pci_dev; 199199002Sjkim else 200199002Sjkim err = bus_generic_suspend(isa_dev); 201142833Siedowse 202142833Siedowse /* Save the video state across the suspend. */ 203198964Sjkim if (sc->state_buf != NULL) 204198964Sjkim goto save_palette; 205174985Swkoszek nbytes = vidd_save_state(sc->adp, NULL, 0); 206142833Siedowse if (nbytes <= 0) 207198964Sjkim goto save_palette; 208198866Sjkim sc->state_buf = malloc(nbytes, M_TEMP, M_NOWAIT); 209198964Sjkim if (sc->state_buf == NULL) 210198964Sjkim goto save_palette; 211198964Sjkim if (bootverbose) 212198964Sjkim device_printf(dev, "saving %d bytes of video state\n", nbytes); 213198964Sjkim if (vidd_save_state(sc->adp, sc->state_buf, nbytes) != 0) { 214198964Sjkim device_printf(dev, "failed to save state (nbytes=%d)\n", 215198964Sjkim nbytes); 216198964Sjkim free(sc->state_buf, M_TEMP); 217198964Sjkim sc->state_buf = NULL; 218142833Siedowse } 219198866Sjkim 220198964Sjkimsave_palette: 221198866Sjkim /* Save the color palette across the suspend. */ 222198866Sjkim if (sc->pal_buf != NULL) 223199002Sjkim return (err); 224198866Sjkim sc->pal_buf = malloc(256 * 3, M_TEMP, M_NOWAIT); 225198866Sjkim if (sc->pal_buf != NULL) { 226198866Sjkim if (bootverbose) 227198866Sjkim device_printf(dev, "saving color palette\n"); 228198866Sjkim if (vidd_save_palette(sc->adp, sc->pal_buf) != 0) { 229198866Sjkim device_printf(dev, "failed to save palette\n"); 230198866Sjkim free(sc->pal_buf, M_TEMP); 231198866Sjkim sc->pal_buf = NULL; 232198866Sjkim } 233198866Sjkim } 234198866Sjkim 235199002Sjkim return (err); 236142833Siedowse} 237142833Siedowse 238142833Siedowsestatic int 239142833Siedowseisavga_resume(device_t dev) 240142833Siedowse{ 241142833Siedowse vga_softc_t *sc; 242199002Sjkim device_t isa_dev; 243142833Siedowse 244199002Sjkim isa_dev = dev; 245199002Sjkim sc = device_get_softc(isa_dev); 246199002Sjkim if (sc->pci_dev != NULL) 247199002Sjkim dev = sc->pci_dev; 248198964Sjkim 249142833Siedowse if (sc->state_buf != NULL) { 250174985Swkoszek if (vidd_load_state(sc->adp, sc->state_buf) != 0) 251142833Siedowse device_printf(dev, "failed to reload state\n"); 252142833Siedowse free(sc->state_buf, M_TEMP); 253142833Siedowse sc->state_buf = NULL; 254142833Siedowse } 255198866Sjkim if (sc->pal_buf != NULL) { 256198866Sjkim if (vidd_load_palette(sc->adp, sc->pal_buf) != 0) 257198866Sjkim device_printf(dev, "failed to reload palette\n"); 258198866Sjkim free(sc->pal_buf, M_TEMP); 259198866Sjkim sc->pal_buf = NULL; 260198866Sjkim } 261142833Siedowse 262199002Sjkim if (isa_dev != dev) 263199002Sjkim return (0); 264199002Sjkim 265199002Sjkim return (bus_generic_resume(isa_dev)); 266142833Siedowse} 267142833Siedowse 26848104Syokota#ifdef FB_INSTALL_CDEV 26943105Sdfr 27043105Sdfrstatic int 271130585Sphkisavga_open(struct cdev *dev, int flag, int mode, struct thread *td) 27243105Sdfr{ 273199002Sjkim return (vga_open(dev, VGA_SOFTC(VGA_UNIT(dev)), flag, mode, td)); 27443105Sdfr} 27543105Sdfr 27643105Sdfrstatic int 277130585Sphkisavga_close(struct cdev *dev, int flag, int mode, struct thread *td) 27843105Sdfr{ 279199002Sjkim return (vga_close(dev, VGA_SOFTC(VGA_UNIT(dev)), flag, mode, td)); 28043105Sdfr} 28143105Sdfr 28243105Sdfrstatic int 283130585Sphkisavga_read(struct cdev *dev, struct uio *uio, int flag) 28443105Sdfr{ 285199002Sjkim return (vga_read(dev, VGA_SOFTC(VGA_UNIT(dev)), uio, flag)); 28643105Sdfr} 28743105Sdfr 28843105Sdfrstatic int 289130585Sphkisavga_write(struct cdev *dev, struct uio *uio, int flag) 29043105Sdfr{ 291199002Sjkim return (vga_write(dev, VGA_SOFTC(VGA_UNIT(dev)), uio, flag)); 29243105Sdfr} 29343105Sdfr 29443105Sdfrstatic int 295130585Sphkisavga_ioctl(struct cdev *dev, u_long cmd, caddr_t arg, int flag, struct thread *td) 29643105Sdfr{ 297199002Sjkim return (vga_ioctl(dev, VGA_SOFTC(VGA_UNIT(dev)), cmd, arg, flag, td)); 29843105Sdfr} 29943105Sdfr 30043105Sdfrstatic int 301130585Sphkisavga_mmap(struct cdev *dev, vm_offset_t offset, vm_paddr_t *paddr, int prot) 30243105Sdfr{ 303199002Sjkim return (vga_mmap(dev, VGA_SOFTC(VGA_UNIT(dev)), offset, paddr, prot)); 30443105Sdfr} 30543105Sdfr 30648104Syokota#endif /* FB_INSTALL_CDEV */ 30762225Speter 30862225Speterstatic device_method_t isavga_methods[] = { 30962225Speter DEVMETHOD(device_identify, isavga_identify), 31062225Speter DEVMETHOD(device_probe, isavga_probe), 31162225Speter DEVMETHOD(device_attach, isavga_attach), 312142833Siedowse DEVMETHOD(device_suspend, isavga_suspend), 313142833Siedowse DEVMETHOD(device_resume, isavga_resume), 31462225Speter 31562225Speter DEVMETHOD(bus_print_child, bus_generic_print_child), 31662225Speter { 0, 0 } 31762225Speter}; 31862225Speter 31962225Speterstatic driver_t isavga_driver = { 32062225Speter VGA_DRIVER_NAME, 32162225Speter isavga_methods, 32262225Speter sizeof(vga_softc_t), 32362225Speter}; 32462225Speter 32562225SpeterDRIVER_MODULE(vga, isa, isavga_driver, isavga_devclass, 0, 0); 326