vga_isa.c revision 199002 
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: head/sys/isa/vga_isa.c 199002 2009-11-06 20:32:26Z jkim $");
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
65static devclass_t	isavga_devclass;
66
67#ifdef FB_INSTALL_CDEV
68
69static d_open_t		isavga_open;
70static d_close_t	isavga_close;
71static d_read_t		isavga_read;
72static d_write_t	isavga_write;
73static d_ioctl_t	isavga_ioctl;
74static d_mmap_t		isavga_mmap;
75
76static 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
90static void
91isavga_identify(driver_t *driver, device_t parent)
92{
93	BUS_ADD_CHILD(parent, ISA_ORDER_SPECULATIVE, VGA_DRIVER_NAME, 0);
94}
95
96static int
97isavga_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
123static int
124isavga_attach(device_t dev)
125{
126	vga_softc_t *sc;
127	devclass_t dc;
128	device_t *devs;
129	void *vgapci_sc;
130	int count, i;
131	int unit;
132	int rid;
133	int error;
134
135	unit = device_get_unit(dev);
136	sc = device_get_softc(dev);
137
138	rid = 0;
139	bus_alloc_resource(dev, SYS_RES_IOPORT, &rid,
140				  0, ~0, 0, RF_ACTIVE | RF_SHAREABLE);
141	rid = 0;
142	bus_alloc_resource(dev, SYS_RES_MEMORY, &rid,
143				 0, ~0, 0, RF_ACTIVE | RF_SHAREABLE);
144
145	error = vga_attach_unit(unit, sc, device_get_flags(dev));
146	if (error)
147		return (error);
148
149#ifdef FB_INSTALL_CDEV
150	/* attach a virtual frame buffer device */
151	error = fb_attach(VGA_MKMINOR(unit), sc->adp, &isavga_cdevsw);
152	if (error)
153		return (error);
154#endif /* FB_INSTALL_CDEV */
155
156	if (0 && bootverbose)
157		vidd_diag(sc->adp, bootverbose);
158
159#if 0 /* experimental */
160	device_add_child(dev, "fb", -1);
161	bus_generic_attach(dev);
162#endif
163
164	/* Find the matching PCI video controller. */
165	if (unit == 0) {
166		dc = devclass_find("vgapci");
167		if (dc != NULL &&
168		    devclass_get_devices(dc, &devs, &count) == 0) {
169			for (i = 0; i < count; i++)
170				if (device_get_flags(devs[i]) != 0) {
171					sc->pci_dev = devs[i];
172					break;
173				}
174			free(devs, M_TEMP);
175		}
176		if (sc->pci_dev != NULL) {
177			vgapci_sc = device_get_softc(sc->pci_dev);
178			*(device_t *)vgapci_sc = dev;
179			device_printf(dev, "associated with %s\n",
180			    device_get_nameunit(sc->pci_dev));
181		}
182	}
183
184	return (0);
185}
186
187static int
188isavga_suspend(device_t dev)
189{
190	vga_softc_t *sc;
191	device_t isa_dev;
192	int err, nbytes;
193
194	err = 0;
195	isa_dev = dev;
196	sc = device_get_softc(isa_dev);
197	if (sc->pci_dev != NULL)
198		dev = sc->pci_dev;
199	else
200		err = bus_generic_suspend(isa_dev);
201
202	/* Save the video state across the suspend. */
203	if (sc->state_buf != NULL)
204		goto save_palette;
205	nbytes = vidd_save_state(sc->adp, NULL, 0);
206	if (nbytes <= 0)
207		goto save_palette;
208	sc->state_buf = malloc(nbytes, M_TEMP, M_NOWAIT);
209	if (sc->state_buf == NULL)
210		goto save_palette;
211	if (bootverbose)
212		device_printf(dev, "saving %d bytes of video state\n", nbytes);
213	if (vidd_save_state(sc->adp, sc->state_buf, nbytes) != 0) {
214		device_printf(dev, "failed to save state (nbytes=%d)\n",
215		    nbytes);
216		free(sc->state_buf, M_TEMP);
217		sc->state_buf = NULL;
218	}
219
220save_palette:
221	/* Save the color palette across the suspend. */
222	if (sc->pal_buf != NULL)
223		return (err);
224	sc->pal_buf = malloc(256 * 3, M_TEMP, M_NOWAIT);
225	if (sc->pal_buf != NULL) {
226		if (bootverbose)
227			device_printf(dev, "saving color palette\n");
228		if (vidd_save_palette(sc->adp, sc->pal_buf) != 0) {
229			device_printf(dev, "failed to save palette\n");
230			free(sc->pal_buf, M_TEMP);
231			sc->pal_buf = NULL;
232		}
233	}
234
235	return (err);
236}
237
238static int
239isavga_resume(device_t dev)
240{
241	vga_softc_t *sc;
242	device_t isa_dev;
243
244	isa_dev = dev;
245	sc = device_get_softc(isa_dev);
246	if (sc->pci_dev != NULL)
247		dev = sc->pci_dev;
248
249	if (sc->state_buf != NULL) {
250		if (vidd_load_state(sc->adp, sc->state_buf) != 0)
251			device_printf(dev, "failed to reload state\n");
252		free(sc->state_buf, M_TEMP);
253		sc->state_buf = NULL;
254	}
255	if (sc->pal_buf != NULL) {
256		if (vidd_load_palette(sc->adp, sc->pal_buf) != 0)
257			device_printf(dev, "failed to reload palette\n");
258		free(sc->pal_buf, M_TEMP);
259		sc->pal_buf = NULL;
260	}
261
262	if (isa_dev != dev)
263		return (0);
264
265	return (bus_generic_resume(isa_dev));
266}
267
268#ifdef FB_INSTALL_CDEV
269
270static int
271isavga_open(struct cdev *dev, int flag, int mode, struct thread *td)
272{
273	return (vga_open(dev, VGA_SOFTC(VGA_UNIT(dev)), flag, mode, td));
274}
275
276static int
277isavga_close(struct cdev *dev, int flag, int mode, struct thread *td)
278{
279	return (vga_close(dev, VGA_SOFTC(VGA_UNIT(dev)), flag, mode, td));
280}
281
282static int
283isavga_read(struct cdev *dev, struct uio *uio, int flag)
284{
285	return (vga_read(dev, VGA_SOFTC(VGA_UNIT(dev)), uio, flag));
286}
287
288static int
289isavga_write(struct cdev *dev, struct uio *uio, int flag)
290{
291	return (vga_write(dev, VGA_SOFTC(VGA_UNIT(dev)), uio, flag));
292}
293
294static int
295isavga_ioctl(struct cdev *dev, u_long cmd, caddr_t arg, int flag, struct thread *td)
296{
297	return (vga_ioctl(dev, VGA_SOFTC(VGA_UNIT(dev)), cmd, arg, flag, td));
298}
299
300static int
301isavga_mmap(struct cdev *dev, vm_offset_t offset, vm_paddr_t *paddr, int prot)
302{
303	return (vga_mmap(dev, VGA_SOFTC(VGA_UNIT(dev)), offset, paddr, prot));
304}
305
306#endif /* FB_INSTALL_CDEV */
307
308static device_method_t isavga_methods[] = {
309	DEVMETHOD(device_identify,	isavga_identify),
310	DEVMETHOD(device_probe,		isavga_probe),
311	DEVMETHOD(device_attach,	isavga_attach),
312	DEVMETHOD(device_suspend,	isavga_suspend),
313	DEVMETHOD(device_resume,	isavga_resume),
314
315	DEVMETHOD(bus_print_child,	bus_generic_print_child),
316	{ 0, 0 }
317};
318
319static driver_t isavga_driver = {
320	VGA_DRIVER_NAME,
321	isavga_methods,
322	sizeof(vga_softc_t),
323};
324
325DRIVER_MODULE(vga, isa, isavga_driver, isavga_devclass, 0, 0);
326