1/*-
2 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3 *
4 * Copyright (c) 1999 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp>
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 *    notice, this list of conditions and the following disclaimer as
12 *    the first lines of this file unmodified.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 *    notice, this list of conditions and the following disclaimer in the
15 *    documentation and/or other materials provided with the distribution.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 */
28
29#include <sys/cdefs.h>
30__FBSDID("$FreeBSD$");
31
32#include "opt_vga.h"
33#include "opt_fb.h"
34#include "opt_syscons.h"	/* should be removed in the future, XXX */
35
36#include <sys/param.h>
37#include <sys/systm.h>
38#include <sys/kernel.h>
39#include <sys/malloc.h>
40#include <sys/module.h>
41#include <sys/conf.h>
42#include <sys/bus.h>
43#include <sys/fbio.h>
44
45#include <machine/bus.h>
46#include <machine/resource.h>
47
48#include <sys/rman.h>
49
50#include <vm/vm.h>
51#include <vm/pmap.h>
52
53#include <machine/md_var.h>
54#ifdef __i386__
55#include <machine/pc/bios.h>
56#endif
57
58#include <dev/fb/fbreg.h>
59#include <dev/fb/vgareg.h>
60
61#include <isa/isareg.h>
62#include <isa/isavar.h>
63
64#define VGA_ID		0x0009d041	/* PNP0900 */
65
66static struct isa_pnp_id vga_ids[] = {
67	{ VGA_ID,	NULL },		/* PNP0900 */
68	{ 0,		NULL },
69};
70
71static void
72vga_suspend(device_t dev)
73{
74	vga_softc_t *sc;
75	int nbytes;
76
77	sc = device_get_softc(dev);
78
79	/* Save the video state across the suspend. */
80	if (sc->state_buf != NULL)
81		goto save_palette;
82	nbytes = vidd_save_state(sc->adp, NULL, 0);
83	if (nbytes <= 0)
84		goto save_palette;
85	sc->state_buf = malloc(nbytes, M_TEMP, M_NOWAIT);
86	if (sc->state_buf == NULL)
87		goto save_palette;
88	if (bootverbose)
89		device_printf(dev, "saving %d bytes of video state\n", nbytes);
90	if (vidd_save_state(sc->adp, sc->state_buf, nbytes) != 0) {
91		device_printf(dev, "failed to save state (nbytes=%d)\n",
92		    nbytes);
93		free(sc->state_buf, M_TEMP);
94		sc->state_buf = NULL;
95	}
96
97save_palette:
98	/* Save the color palette across the suspend. */
99	if (sc->pal_buf != NULL)
100		return;
101	sc->pal_buf = malloc(256 * 3, M_TEMP, M_NOWAIT);
102	if (sc->pal_buf == NULL)
103		return;
104	if (bootverbose)
105		device_printf(dev, "saving color palette\n");
106	if (vidd_save_palette(sc->adp, sc->pal_buf) != 0) {
107		device_printf(dev, "failed to save palette\n");
108		free(sc->pal_buf, M_TEMP);
109		sc->pal_buf = NULL;
110	}
111}
112
113static void
114vga_resume(device_t dev)
115{
116	vga_softc_t *sc;
117
118	sc = device_get_softc(dev);
119
120	if (sc->state_buf != NULL) {
121		if (vidd_load_state(sc->adp, sc->state_buf) != 0)
122			device_printf(dev, "failed to reload state\n");
123		free(sc->state_buf, M_TEMP);
124		sc->state_buf = NULL;
125	}
126	if (sc->pal_buf != NULL) {
127		if (vidd_load_palette(sc->adp, sc->pal_buf) != 0)
128			device_printf(dev, "failed to reload palette\n");
129		free(sc->pal_buf, M_TEMP);
130		sc->pal_buf = NULL;
131	}
132}
133
134#define VGA_SOFTC(unit)		\
135	((vga_softc_t *)devclass_get_softc(isavga_devclass, unit))
136
137static devclass_t	isavga_devclass;
138
139#ifdef FB_INSTALL_CDEV
140
141static d_open_t		isavga_open;
142static d_close_t	isavga_close;
143static d_read_t		isavga_read;
144static d_write_t	isavga_write;
145static d_ioctl_t	isavga_ioctl;
146static d_mmap_t		isavga_mmap;
147
148static struct cdevsw isavga_cdevsw = {
149	.d_version =	D_VERSION,
150	.d_flags =	D_NEEDGIANT,
151	.d_open =	isavga_open,
152	.d_close =	isavga_close,
153	.d_read =	isavga_read,
154	.d_write =	isavga_write,
155	.d_ioctl =	isavga_ioctl,
156	.d_mmap =	isavga_mmap,
157	.d_name =	VGA_DRIVER_NAME,
158};
159
160#endif /* FB_INSTALL_CDEV */
161
162static void
163isavga_identify(driver_t *driver, device_t parent)
164{
165	BUS_ADD_CHILD(parent, ISA_ORDER_SPECULATIVE, VGA_DRIVER_NAME, 0);
166}
167
168static int
169isavga_probe(device_t dev)
170{
171	video_adapter_t adp;
172	int error;
173
174	/* No pnp support */
175	if (isa_get_vendorid(dev))
176		return (ENXIO);
177
178	error = vga_probe_unit(device_get_unit(dev), &adp, device_get_flags(dev));
179	if (error == 0) {
180		device_set_desc(dev, "Generic ISA VGA");
181		bus_set_resource(dev, SYS_RES_IOPORT, 0,
182				 adp.va_io_base, adp.va_io_size);
183		bus_set_resource(dev, SYS_RES_MEMORY, 0,
184				 adp.va_mem_base, adp.va_mem_size);
185		isa_set_vendorid(dev, VGA_ID);
186		isa_set_logicalid(dev, VGA_ID);
187#if 0
188		isa_set_port(dev, adp.va_io_base);
189		isa_set_portsize(dev, adp.va_io_size);
190		isa_set_maddr(dev, adp.va_mem_base);
191		isa_set_msize(dev, adp.va_mem_size);
192#endif
193	}
194	return (error);
195}
196
197static int
198isavga_attach(device_t dev)
199{
200	vga_softc_t *sc;
201	int unit;
202	int rid;
203	int error;
204
205	unit = device_get_unit(dev);
206	sc = device_get_softc(dev);
207
208	rid = 0;
209	bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid,
210				  RF_ACTIVE | RF_SHAREABLE);
211	rid = 0;
212	bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid,
213				 RF_ACTIVE | RF_SHAREABLE);
214
215	error = vga_attach_unit(unit, sc, device_get_flags(dev));
216	if (error)
217		return (error);
218
219#ifdef FB_INSTALL_CDEV
220	/* attach a virtual frame buffer device */
221	error = fb_attach(VGA_MKMINOR(unit), sc->adp, &isavga_cdevsw);
222	if (error)
223		return (error);
224#endif /* FB_INSTALL_CDEV */
225
226	if (0 && bootverbose)
227		vidd_diag(sc->adp, bootverbose);
228
229#if 0 /* experimental */
230	device_add_child(dev, "fb", -1);
231	bus_generic_attach(dev);
232#endif
233
234	return (0);
235}
236
237static int
238isavga_suspend(device_t dev)
239{
240	int error;
241
242	error = bus_generic_suspend(dev);
243	if (error != 0)
244		return (error);
245	vga_suspend(dev);
246
247	return (error);
248}
249
250static int
251isavga_resume(device_t dev)
252{
253
254	vga_resume(dev);
255
256	return (bus_generic_resume(dev));
257}
258
259#ifdef FB_INSTALL_CDEV
260
261static int
262isavga_open(struct cdev *dev, int flag, int mode, struct thread *td)
263{
264	return (vga_open(dev, VGA_SOFTC(VGA_UNIT(dev)), flag, mode, td));
265}
266
267static int
268isavga_close(struct cdev *dev, int flag, int mode, struct thread *td)
269{
270	return (vga_close(dev, VGA_SOFTC(VGA_UNIT(dev)), flag, mode, td));
271}
272
273static int
274isavga_read(struct cdev *dev, struct uio *uio, int flag)
275{
276	return (vga_read(dev, VGA_SOFTC(VGA_UNIT(dev)), uio, flag));
277}
278
279static int
280isavga_write(struct cdev *dev, struct uio *uio, int flag)
281{
282	return (vga_write(dev, VGA_SOFTC(VGA_UNIT(dev)), uio, flag));
283}
284
285static int
286isavga_ioctl(struct cdev *dev, u_long cmd, caddr_t arg, int flag, struct thread *td)
287{
288	return (vga_ioctl(dev, VGA_SOFTC(VGA_UNIT(dev)), cmd, arg, flag, td));
289}
290
291static int
292isavga_mmap(struct cdev *dev, vm_ooffset_t offset, vm_paddr_t *paddr,
293    int prot, vm_memattr_t *memattr)
294{
295	return (vga_mmap(dev, VGA_SOFTC(VGA_UNIT(dev)), offset, paddr, prot,
296	    memattr));
297}
298
299#endif /* FB_INSTALL_CDEV */
300
301static device_method_t isavga_methods[] = {
302	DEVMETHOD(device_identify,	isavga_identify),
303	DEVMETHOD(device_probe,		isavga_probe),
304	DEVMETHOD(device_attach,	isavga_attach),
305	DEVMETHOD(device_suspend,	isavga_suspend),
306	DEVMETHOD(device_resume,	isavga_resume),
307
308	DEVMETHOD_END
309};
310
311static driver_t isavga_driver = {
312	VGA_DRIVER_NAME,
313	isavga_methods,
314	sizeof(vga_softc_t),
315};
316
317DRIVER_MODULE(vga, isa, isavga_driver, isavga_devclass, 0, 0);
318
319static devclass_t	vgapm_devclass;
320
321static void
322vgapm_identify(driver_t *driver, device_t parent)
323{
324
325	if (device_get_flags(parent) != 0)
326		device_add_child(parent, "vgapm", 0);
327}
328
329static int
330vgapm_probe(device_t dev)
331{
332
333	device_set_desc(dev, "VGA suspend/resume");
334	device_quiet(dev);
335
336	return (BUS_PROBE_DEFAULT);
337}
338
339static int
340vgapm_attach(device_t dev)
341{
342
343	bus_generic_probe(dev);
344	bus_generic_attach(dev);
345
346	return (0);
347}
348
349static int
350vgapm_suspend(device_t dev)
351{
352	device_t vga_dev;
353	int error;
354
355	error = bus_generic_suspend(dev);
356	if (error != 0)
357		return (error);
358	vga_dev = devclass_get_device(isavga_devclass, 0);
359	if (vga_dev == NULL)
360		return (0);
361	vga_suspend(vga_dev);
362
363	return (0);
364}
365
366static int
367vgapm_resume(device_t dev)
368{
369	device_t vga_dev;
370
371	vga_dev = devclass_get_device(isavga_devclass, 0);
372	if (vga_dev != NULL)
373		vga_resume(vga_dev);
374
375	return (bus_generic_resume(dev));
376}
377
378static device_method_t vgapm_methods[] = {
379	DEVMETHOD(device_identify,	vgapm_identify),
380	DEVMETHOD(device_probe,		vgapm_probe),
381	DEVMETHOD(device_attach,	vgapm_attach),
382	DEVMETHOD(device_suspend,	vgapm_suspend),
383	DEVMETHOD(device_resume,	vgapm_resume),
384	{ 0, 0 }
385};
386
387static driver_t vgapm_driver = {
388	"vgapm",
389	vgapm_methods,
390	0
391};
392
393DRIVER_MODULE(vgapm, vgapci, vgapm_driver, vgapm_devclass, 0, 0);
394ISA_PNP_INFO(vga_ids);
395