FreeBSD/Linux Kernel Cross Reference
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);
Cache object: 997eaff6355812730b00b7a103d036c2
|