[dragonfly.git] / sys / bus / isa / vga_isa.c

/*-
 * Copyright (c) 1999 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp>
 * All rights reserved.
 *
 * 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 as
 *    the first lines of this file unmodified.
 * 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 AUTHORS ``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 AUTHORS 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.
 *
 * $FreeBSD: src/sys/isa/vga_isa.c,v 1.17 2000/01/29 15:08:56 peter Exp $
 * $DragonFly: src/sys/bus/isa/vga_isa.c,v 1.14 2008/03/20 21:25:30 swildner Exp $
 */

#include "opt_vga.h"
#include "opt_fb.h"
#include "opt_syscons.h"	/* should be removed in the future, XXX */

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/malloc.h>
#include <sys/conf.h>
#include <sys/device.h>
#include <sys/bus.h>
#include <sys/fbio.h>
#include <sys/rman.h>

#include <vm/vm.h>
#include <vm/pmap.h>

#include <machine/md_var.h>
#include <machine/pc/bios.h>

#include <dev/video/fb/fbreg.h>
#include <dev/video/fb/vgareg.h>

#include "isareg.h"
#include "isavar.h"

#define VGA_SOFTC(unit)		\
	((vga_softc_t *)devclass_get_softc(isavga_devclass, unit))

static devclass_t	isavga_devclass;

static int		isavga_probe(device_t dev);
static int		isavga_attach(device_t dev);
static int		isavga_suspend(device_t dev);
static int		isavga_resume(device_t dev);

static device_method_t isavga_methods[] = {
	DEVMETHOD(device_probe,		isavga_probe),
	DEVMETHOD(device_attach,	isavga_attach),
	DEVMETHOD(device_suspend,	isavga_suspend),
	DEVMETHOD(device_resume,	isavga_resume),

	DEVMETHOD(bus_print_child,	bus_generic_print_child),
	{ 0, 0 }
};

static driver_t isavga_driver = {
	VGA_DRIVER_NAME,
	isavga_methods,
	sizeof(vga_softc_t),
};

DRIVER_MODULE(vga, isa, isavga_driver, isavga_devclass, 0, 0);

#ifdef FB_INSTALL_CDEV

static d_open_t		isavga_open;
static d_close_t	isavga_close;
static d_read_t		isavga_read;
static d_write_t	isavga_write;
static d_ioctl_t	isavga_ioctl;
static d_mmap_t		isavga_mmap;

static struct dev_ops isavga_ops = {
	{ VGA_DRIVER_NAME, -1, 0 },
	.d_open =	isavga_open,
	.d_close =	isavga_close,
	.d_read =	isavga_read,
	.d_write =	isavga_write,
	.d_ioctl =	isavga_ioctl,
	.d_mmap =	isavga_mmap,
};

#endif /* FB_INSTALL_CDEV */

static int
isavga_probe(device_t dev)
{
	video_adapter_t adp;
	int error;

	/* No pnp support */
	if (isa_get_vendorid(dev))
		return (ENXIO);

	device_set_desc(dev, "Generic ISA VGA");
	error = vga_probe_unit(device_get_unit(dev), &adp, device_get_flags(dev));
	if (error == 0) {
		bus_set_resource(dev, SYS_RES_IOPORT, 0,
				 adp.va_io_base, adp.va_io_size);
		bus_set_resource(dev, SYS_RES_MEMORY, 0,
				 adp.va_mem_base, adp.va_mem_size);
#if 0
		isa_set_port(dev, adp.va_io_base);
		isa_set_portsize(dev, adp.va_io_size);
		isa_set_maddr(dev, adp.va_mem_base);
		isa_set_msize(dev, adp.va_mem_size);
#endif
	}
	return error;
}

static int
isavga_attach(device_t dev)
{
	vga_softc_t *sc;
	int unit;
	int rid;
	int error;

	unit = device_get_unit(dev);
	sc = device_get_softc(dev);

	rid = 0;
	bus_alloc_resource(dev, SYS_RES_IOPORT, &rid,
			   0, ~0, 0, RF_ACTIVE | RF_SHAREABLE);
	rid = 0;
	bus_alloc_resource(dev, SYS_RES_MEMORY, &rid,
			   0, ~0, 0, RF_ACTIVE | RF_SHAREABLE);

	error = vga_attach_unit(unit, sc, device_get_flags(dev));
	if (error)
		return error;

#ifdef FB_INSTALL_CDEV
	/* attach a virtual frame buffer device */
	sc->devt = make_dev(&isavga_ops, VGA_MKMINOR(unit), 0, 0, 02660, "vga%x", VGA_MKMINOR(unit));
	reference_dev(sc->devt);
	error = fb_attach(sc->devt, sc->adp);
	if (error)
		return error;
#endif /* FB_INSTALL_CDEV */

	if (bootverbose)
		(*vidsw[sc->adp->va_index]->diag)(sc->adp, bootverbose);

#if experimental
	device_add_child(dev, "fb", -1);
	bus_generic_attach(dev);
#endif

	return 0;
}

static int
isavga_suspend(device_t dev)
{
	vga_softc_t *sc;
	int err, nbytes;

	sc = device_get_softc(dev);
	err = bus_generic_suspend(dev);
	if (err)
		return (err);

	/* Save the video state across the suspend. */
	if (sc->state_buf != NULL) {
		kfree(sc->state_buf, M_TEMP);
		sc->state_buf = NULL;
	}
	nbytes = (*vidsw[sc->adp->va_index]->save_state)(sc->adp, NULL, 0);
	if (nbytes <= 0)
		return (0);
	sc->state_buf = kmalloc(nbytes, M_TEMP, M_NOWAIT | M_ZERO);
	if (sc->state_buf == NULL)
		return (0);
	if (bootverbose)
		device_printf(dev, "saving %d bytes of video state\n", nbytes);
	if ((*vidsw[sc->adp->va_index]->save_state)(sc->adp, sc->state_buf,
	    nbytes) != 0) {
		device_printf(dev, "failed to save state (nbytes=%d)\n",
		    nbytes);
		kfree(sc->state_buf, M_TEMP);
		sc->state_buf = NULL;
	}
	return (0);
}

static int
isavga_resume(device_t dev)
{
	vga_softc_t *sc;

	sc = device_get_softc(dev);
	if (sc->state_buf != NULL) {
		if ((*vidsw[sc->adp->va_index]->load_state)(sc->adp,
		    sc->state_buf) != 0)
			device_printf(dev, "failed to reload state\n");
		kfree(sc->state_buf, M_TEMP);
		sc->state_buf = NULL;
	}

	bus_generic_resume(dev);
	return 0;
}

#ifdef FB_INSTALL_CDEV

static int
isavga_open(struct dev_open_args *ap)
{
	cdev_t dev = ap->a_head.a_dev;

	return vga_open(dev, VGA_SOFTC(VGA_UNIT(dev)), ap->a_oflags,
			ap->a_devtype, ap->a_cred);
}

static int
isavga_close(struct dev_close_args *ap)
{
	cdev_t dev = ap->a_head.a_dev;

	return vga_close(dev, VGA_SOFTC(VGA_UNIT(dev)),
			 ap->a_fflag, ap->a_devtype);
}

static int
isavga_read(struct dev_read_args *ap)
{
	cdev_t dev = ap->a_head.a_dev;

	return vga_read(dev, VGA_SOFTC(VGA_UNIT(dev)), ap->a_uio, ap->a_ioflag);
}

static int
isavga_write(struct dev_write_args *ap)
{
	cdev_t dev = ap->a_head.a_dev;

	return vga_write(dev, VGA_SOFTC(VGA_UNIT(dev)), ap->a_uio, ap->a_ioflag);
}

static int
isavga_ioctl(struct dev_ioctl_args *ap)
{
	cdev_t dev = ap->a_head.a_dev;

	return vga_ioctl(dev, VGA_SOFTC(VGA_UNIT(dev)), ap->a_cmd, ap->a_data, ap->a_fflag, ap->a_cred);
}

static int
isavga_mmap(struct dev_mmap_args *ap)
{
	cdev_t dev = ap->a_head.a_dev;

	ap->a_result = vga_mmap(dev, VGA_SOFTC(VGA_UNIT(dev)), ap->a_offset, ap->a_nprot);
	return(0);
}

#endif /* FB_INSTALL_CDEV */
Commit	Line	Data
984263bc MD	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	* $FreeBSD: src/sys/isa/vga_isa.c,v 1.17 2000/01/29 15:08:56 peter Exp $
4a7d638e	27	* $DragonFly: src/sys/bus/isa/vga_isa.c,v 1.14 2008/03/20 21:25:30 swildner Exp $
984263bc MD	28	*/
	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>
b5f86e2f	37	#include <sys/malloc.h>
984263bc	38	#include <sys/conf.h>
fef8985e	39	#include <sys/device.h>
984263bc MD	40	#include <sys/bus.h>
984263bc MD	41	#include <sys/fbio.h>
984263bc MD	42	#include <sys/rman.h>
	43
	44	#include <vm/vm.h>
	45	#include <vm/pmap.h>
	46
	47	#include <machine/md_var.h>
	48	#include <machine/pc/bios.h>
	49
1f2de5d4 MD	50	#include <dev/video/fb/fbreg.h>
1f2de5d4 MD	51	#include <dev/video/fb/vgareg.h>
984263bc	52
1f2de5d4 MD	53	#include "isareg.h"
1f2de5d4 MD	54	#include "isavar.h"
984263bc MD	55
	56	#define VGA_SOFTC(unit) \
	57	((vga_softc_t *)devclass_get_softc(isavga_devclass, unit))
	58
	59	static devclass_t isavga_devclass;
	60
	61	static int isavga_probe(device_t dev);
	62	static int isavga_attach(device_t dev);
b5f86e2f SW	63	static int isavga_suspend(device_t dev);
b5f86e2f SW	64	static int isavga_resume(device_t dev);
984263bc MD	65
	66	static device_method_t isavga_methods[] = {
	67	DEVMETHOD(device_probe, isavga_probe),
	68	DEVMETHOD(device_attach, isavga_attach),
b5f86e2f SW	69	DEVMETHOD(device_suspend, isavga_suspend),
b5f86e2f SW	70	DEVMETHOD(device_resume, isavga_resume),
984263bc MD	71
	72	DEVMETHOD(bus_print_child, bus_generic_print_child),
	73	{ 0, 0 }
	74	};
	75
	76	static driver_t isavga_driver = {
	77	VGA_DRIVER_NAME,
	78	isavga_methods,
	79	sizeof(vga_softc_t),
	80	};
	81
	82	DRIVER_MODULE(vga, isa, isavga_driver, isavga_devclass, 0, 0);
	83
	84	#ifdef FB_INSTALL_CDEV
	85
	86	static d_open_t isavga_open;
	87	static d_close_t isavga_close;
	88	static d_read_t isavga_read;
	89	static d_write_t isavga_write;
	90	static d_ioctl_t isavga_ioctl;
	91	static d_mmap_t isavga_mmap;
	92
fef8985e MD	93	static struct dev_ops isavga_ops = {
	94	{ VGA_DRIVER_NAME, -1, 0 },
	95	.d_open = isavga_open,
	96	.d_close = isavga_close,
	97	.d_read = isavga_read,
	98	.d_write = isavga_write,
	99	.d_ioctl = isavga_ioctl,
	100	.d_mmap = isavga_mmap,
984263bc MD	101	};
	102
	103	#endif /* FB_INSTALL_CDEV */
	104
	105	static int
	106	isavga_probe(device_t dev)
	107	{
	108	video_adapter_t adp;
984263bc MD	109	int error;
	110
	111	/* No pnp support */
	112	if (isa_get_vendorid(dev))
	113	return (ENXIO);
	114
	115	device_set_desc(dev, "Generic ISA VGA");
	116	error = vga_probe_unit(device_get_unit(dev), &adp, device_get_flags(dev));
	117	if (error == 0) {
984263bc MD	118	bus_set_resource(dev, SYS_RES_IOPORT, 0,
	119	adp.va_io_base, adp.va_io_size);
	120	bus_set_resource(dev, SYS_RES_MEMORY, 0,
	121	adp.va_mem_base, adp.va_mem_size);
	122	#if 0
	123	isa_set_port(dev, adp.va_io_base);
	124	isa_set_portsize(dev, adp.va_io_size);
	125	isa_set_maddr(dev, adp.va_mem_base);
	126	isa_set_msize(dev, adp.va_mem_size);
	127	#endif
	128	}
	129	return error;
	130	}
	131
	132	static int
	133	isavga_attach(device_t dev)
	134	{
	135	vga_softc_t *sc;
984263bc MD	136	int unit;
	137	int rid;
	138	int error;
	139
	140	unit = device_get_unit(dev);
	141	sc = device_get_softc(dev);
	142
	143	rid = 0;
4a7d638e SW	144	bus_alloc_resource(dev, SYS_RES_IOPORT, &rid,
4a7d638e SW	145	0, ~0, 0, RF_ACTIVE \| RF_SHAREABLE);
984263bc	146	rid = 0;
4a7d638e SW	147	bus_alloc_resource(dev, SYS_RES_MEMORY, &rid,
4a7d638e SW	148	0, ~0, 0, RF_ACTIVE \| RF_SHAREABLE);
984263bc MD	149
	150	error = vga_attach_unit(unit, sc, device_get_flags(dev));
	151	if (error)
	152	return error;
	153
	154	#ifdef FB_INSTALL_CDEV
	155	/* attach a virtual frame buffer device */
fef8985e	156	sc->devt = make_dev(&isavga_ops, VGA_MKMINOR(unit), 0, 0, 02660, "vga%x", VGA_MKMINOR(unit));
e4c9c0c8	157	reference_dev(sc->devt);
335dda38	158	error = fb_attach(sc->devt, sc->adp);
984263bc MD	159	if (error)
	160	return error;
	161	#endif /* FB_INSTALL_CDEV */
	162
	163	if (bootverbose)
	164	(*vidsw[sc->adp->va_index]->diag)(sc->adp, bootverbose);
	165
	166	#if experimental
	167	device_add_child(dev, "fb", -1);
	168	bus_generic_attach(dev);
	169	#endif
	170
	171	return 0;
	172	}
	173
b5f86e2f SW	174	static int
	175	isavga_suspend(device_t dev)
	176	{
	177	vga_softc_t *sc;
	178	int err, nbytes;
	179
	180	sc = device_get_softc(dev);
	181	err = bus_generic_suspend(dev);
	182	if (err)
	183	return (err);
	184
	185	/* Save the video state across the suspend. */
	186	if (sc->state_buf != NULL) {
efda3bd0	187	kfree(sc->state_buf, M_TEMP);
b5f86e2f SW	188	sc->state_buf = NULL;
	189	}
	190	nbytes = (*vidsw[sc->adp->va_index]->save_state)(sc->adp, NULL, 0);
	191	if (nbytes <= 0)
	192	return (0);
efda3bd0	193	sc->state_buf = kmalloc(nbytes, M_TEMP, M_NOWAIT \| M_ZERO);
b5f86e2f SW	194	if (sc->state_buf == NULL)
	195	return (0);
	196	if (bootverbose)
	197	device_printf(dev, "saving %d bytes of video state\n", nbytes);
	198	if ((*vidsw[sc->adp->va_index]->save_state)(sc->adp, sc->state_buf,
	199	nbytes) != 0) {
	200	device_printf(dev, "failed to save state (nbytes=%d)\n",
	201	nbytes);
efda3bd0	202	kfree(sc->state_buf, M_TEMP);
b5f86e2f SW	203	sc->state_buf = NULL;
	204	}
	205	return (0);
	206	}
	207
	208	static int
	209	isavga_resume(device_t dev)
	210	{
	211	vga_softc_t *sc;
	212
	213	sc = device_get_softc(dev);
	214	if (sc->state_buf != NULL) {
	215	if ((*vidsw[sc->adp->va_index]->load_state)(sc->adp,
	216	sc->state_buf) != 0)
	217	device_printf(dev, "failed to reload state\n");
efda3bd0	218	kfree(sc->state_buf, M_TEMP);
b5f86e2f SW	219	sc->state_buf = NULL;
	220	}
	221
	222	bus_generic_resume(dev);
	223	return 0;
	224	}
	225
984263bc MD	226	#ifdef FB_INSTALL_CDEV
	227
	228	static int
fef8985e	229	isavga_open(struct dev_open_args *ap)
984263bc	230	{
b13267a5	231	cdev_t dev = ap->a_head.a_dev;
fef8985e MD	232
	233	return vga_open(dev, VGA_SOFTC(VGA_UNIT(dev)), ap->a_oflags,
	234	ap->a_devtype, ap->a_cred);
984263bc MD	235	}
	236
	237	static int
fef8985e	238	isavga_close(struct dev_close_args *ap)
984263bc	239	{
b13267a5	240	cdev_t dev = ap->a_head.a_dev;
fef8985e MD	241
	242	return vga_close(dev, VGA_SOFTC(VGA_UNIT(dev)),
	243	ap->a_fflag, ap->a_devtype);
984263bc MD	244	}
	245
	246	static int
fef8985e	247	isavga_read(struct dev_read_args *ap)
984263bc	248	{
b13267a5	249	cdev_t dev = ap->a_head.a_dev;
fef8985e MD	250
fef8985e MD	251	return vga_read(dev, VGA_SOFTC(VGA_UNIT(dev)), ap->a_uio, ap->a_ioflag);
984263bc MD	252	}
	253
	254	static int
fef8985e	255	isavga_write(struct dev_write_args *ap)
984263bc	256	{
b13267a5	257	cdev_t dev = ap->a_head.a_dev;
fef8985e MD	258
fef8985e MD	259	return vga_write(dev, VGA_SOFTC(VGA_UNIT(dev)), ap->a_uio, ap->a_ioflag);
984263bc MD	260	}
	261
	262	static int
fef8985e	263	isavga_ioctl(struct dev_ioctl_args *ap)
984263bc	264	{
b13267a5	265	cdev_t dev = ap->a_head.a_dev;
fef8985e MD	266
fef8985e MD	267	return vga_ioctl(dev, VGA_SOFTC(VGA_UNIT(dev)), ap->a_cmd, ap->a_data, ap->a_fflag, ap->a_cred);
984263bc MD	268	}
	269
	270	static int
fef8985e	271	isavga_mmap(struct dev_mmap_args *ap)
984263bc	272	{
b13267a5	273	cdev_t dev = ap->a_head.a_dev;
fef8985e MD	274
	275	ap->a_result = vga_mmap(dev, VGA_SOFTC(VGA_UNIT(dev)), ap->a_offset, ap->a_nprot);
	276	return(0);
984263bc MD	277	}
	278
	279	#endif /* FB_INSTALL_CDEV */