2 * Copyright (c) 2000 Alcove - Nicolas Souchu <nsouch@freebsd.org>
5 * Code based on Peter Horton <pdh@colonel-panic.com> patch.
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 #include <sys/cdefs.h>
30 __FBSDID("$FreeBSD$");
32 /* Enable LFB on S3 cards that has only VESA 1.2 BIOS */
34 #include <sys/param.h>
35 #include <sys/systm.h>
36 #include <sys/kernel.h>
37 #include <machine/bus.h>
40 #include <vm/vm_extern.h>
41 #include <vm/vm_kern.h>
45 #include <sys/module.h>
48 #include <machine/resource.h>
50 #include <sys/malloc.h>
53 #include <dev/pci/pcireg.h>
54 #include <dev/pci/pcivar.h>
56 #include <machine/md_var.h>
57 #include <machine/vm86.h>
58 #include <machine/pc/bios.h>
59 #include <machine/pc/vesa.h>
61 #include <dev/fb/fbreg.h>
62 #include <dev/fb/vgareg.h>
66 #define PCI_S3_VENDOR_ID 0x5333
68 #define S3_CONFIG_IO 0x3c0 /* VGA standard config io ports */
69 #define S3_CONFIG_IO_SIZE 0x20
71 #define S3_ENHANCED_IO 0x4ae8 /* Extended config register */
72 #define S3_ENHANCED_IO_SIZE 1
74 #define S3_CRTC_ADDR 0x14
75 #define S3_CRTC_VALUE 0x15
77 #define PCI_BASE_MEMORY 0x10
79 #define outb_p(value, offset) bus_space_write_1(sc->st, sc->sh, offset, value)
80 #define inb_p(offset) (bus_space_read_1(sc->st, sc->sh, offset))
81 #define outb_enh(value, offset) bus_space_write_1(sc->enh_st, sc->enh_sh, \
83 #define inb_enh(offset) (bus_space_read_1(sc->enh_st, sc->enh_sh, offset))
87 bus_space_handle_t sh;
88 bus_space_tag_t enh_st;
89 bus_space_handle_t enh_sh;
90 struct resource *port_res;
91 struct resource *enh_res;
92 struct resource *mem_res;
97 static int s3lfb_error(void);
98 static vi_probe_t s3lfb_probe;
99 static vi_init_t s3lfb_init;
100 static vi_get_info_t s3lfb_get_info;
101 static vi_query_mode_t s3lfb_query_mode;
102 static vi_set_mode_t s3lfb_set_mode;
103 static vi_save_font_t s3lfb_save_font;
104 static vi_load_font_t s3lfb_load_font;
105 static vi_show_font_t s3lfb_show_font;
106 static vi_save_palette_t s3lfb_save_palette;
107 static vi_load_palette_t s3lfb_load_palette;
108 static vi_set_border_t s3lfb_set_border;
109 static vi_save_state_t s3lfb_save_state;
110 static vi_load_state_t s3lfb_load_state;
111 static vi_set_win_org_t s3lfb_set_origin;
112 static vi_read_hw_cursor_t s3lfb_read_hw_cursor;
113 static vi_set_hw_cursor_t s3lfb_set_hw_cursor;
114 static vi_set_hw_cursor_shape_t s3lfb_set_hw_cursor_shape;
115 static vi_blank_display_t s3lfb_blank_display;
116 static vi_mmap_t s3lfb_mmap;
117 static vi_ioctl_t s3lfb_ioctl;
118 static vi_clear_t s3lfb_clear;
119 static vi_fill_rect_t s3lfb_fill_rect;
120 static vi_bitblt_t s3lfb_bitblt;
121 static vi_diag_t s3lfb_diag;
123 static video_switch_t s3lfbvidsw = {
138 s3lfb_read_hw_cursor,
140 s3lfb_set_hw_cursor_shape,
152 static video_switch_t *prevvidsw;
153 static device_t s3pci_dev = NULL;
156 s3lfb_probe(int unit, video_adapter_t **adpp, void *arg, int flags)
158 return (*prevvidsw->probe)(unit, adpp, arg, flags);
162 s3lfb_init(int unit, video_adapter_t *adp, int flags)
164 return (*prevvidsw->init)(unit, adp, flags);
168 s3lfb_get_info(video_adapter_t *adp, int mode, video_info_t *info)
171 device_t dev = s3pci_dev; /* XXX */
172 struct s3pci_softc *sc = (struct s3pci_softc *)device_get_softc(dev);
176 if ((error = (*prevvidsw->get_info)(adp, mode, info)))
180 /* Don't use linear addressing with text modes
182 if ((mode > M_VESA_BASE) &&
183 (info->vi_flags & V_INFO_GRAPHICS) &&
184 !(info->vi_flags & V_INFO_LINEAR)) {
186 info->vi_flags |= V_INFO_LINEAR;
187 info->vi_buffer = sc->mem_base;
198 s3lfb_query_mode(video_adapter_t *adp, video_info_t *info)
200 return (*prevvidsw->query_mode)(adp, info);
204 s3lfb_map_buffer(u_int paddr, size_t size)
209 off = paddr - trunc_page(paddr);
210 vaddr = (vm_offset_t)pmap_mapdev(paddr - off, size + off);
212 return (vaddr + off);
216 s3lfb_set_mode(video_adapter_t *adp, int mode)
218 device_t dev = s3pci_dev; /* XXX */
219 struct s3pci_softc *sc = (struct s3pci_softc *)device_get_softc(dev);
225 /* First, set the mode as if it was a classic VESA card
227 if ((error = (*prevvidsw->set_mode)(adp, mode)))
230 /* If not in a linear mode (according to s3lfb_get_info() called
231 * by vesa_set_mode in the (*vidsw[adp->va_index]->get_info)...
232 * sequence, return with no error
235 if (!(adp->va_info.vi_flags & V_INFO_LINEAR))
239 if ((mode <= M_VESA_BASE) ||
240 !(adp->va_info.vi_flags & V_INFO_GRAPHICS) ||
241 (adp->va_info.vi_flags & V_INFO_LINEAR))
244 /* Ok, now apply the configuration to the card */
246 outb_p(0x38, S3_CRTC_ADDR); outb_p(0x48, S3_CRTC_VALUE);
247 outb_p(0x39, S3_CRTC_ADDR); outb_p(0xa5, S3_CRTC_VALUE);
249 /* check that CR47 is read/write */
252 outb_p(0x47, S3_CRTC_ADDR); outb_p(0xff, S3_CRTC_VALUE);
253 tmp = inb_p(S3_CRTC_VALUE);
254 outb_p(0x00, S3_CRTC_VALUE);
255 if ((tmp != 0xff) || (inb_p(S3_CRTC_VALUE)))
257 /* lock S3 registers */
259 outb_p(0x39, S3_CRTC_ADDR); outb_p(0x5a, S3_CRTC_VALUE);
260 outb_p(0x38, S3_CRTC_ADDR); outb_p(0x00, S3_CRTC_VALUE);
266 /* enable enhanced register access */
268 outb_p(0x40, S3_CRTC_ADDR);
269 outb_p(inb_p(S3_CRTC_VALUE) | 1, S3_CRTC_VALUE);
271 /* enable enhanced functions */
273 outb_enh(inb_enh(0) | 1, 0x0);
275 /* enable enhanced mode memory mapping */
277 outb_p(0x31, S3_CRTC_ADDR);
278 outb_p(inb_p(S3_CRTC_VALUE) | 8, S3_CRTC_VALUE);
280 /* enable linear frame buffer and set address window to max */
282 outb_p(0x58, S3_CRTC_ADDR);
283 outb_p(inb_p(S3_CRTC_VALUE) | 0x13, S3_CRTC_VALUE);
285 /* disabled enhanced register access */
287 outb_p(0x40, S3_CRTC_ADDR);
288 outb_p(inb_p(S3_CRTC_VALUE) & ~1, S3_CRTC_VALUE);
290 /* lock S3 registers */
292 outb_p(0x39, S3_CRTC_ADDR); outb_p(0x5a, S3_CRTC_VALUE);
293 outb_p(0x38, S3_CRTC_ADDR); outb_p(0x00, S3_CRTC_VALUE);
295 adp->va_info.vi_flags |= V_INFO_LINEAR;
296 adp->va_info.vi_buffer = sc->mem_base;
297 adp->va_buffer = s3lfb_map_buffer(adp->va_info.vi_buffer,
298 adp->va_info.vi_buffer_size);
299 adp->va_buffer_size = adp->va_info.vi_buffer_size;
300 adp->va_window = adp->va_buffer;
301 adp->va_window_size = adp->va_info.vi_buffer_size/adp->va_info.vi_planes;
302 adp->va_window_gran = adp->va_info.vi_buffer_size/adp->va_info.vi_planes;
308 s3lfb_save_font(video_adapter_t *adp, int page, int fontsize, int fontwidth,
309 u_char *data, int ch, int count)
311 return (*prevvidsw->save_font)(adp, page, fontsize, fontwidth, data,
316 s3lfb_load_font(video_adapter_t *adp, int page, int fontsize, int fontwidth,
317 u_char *data, int ch, int count)
319 return (*prevvidsw->load_font)(adp, page, fontsize, fontwidth, data,
324 s3lfb_show_font(video_adapter_t *adp, int page)
326 return (*prevvidsw->show_font)(adp, page);
330 s3lfb_save_palette(video_adapter_t *adp, u_char *palette)
332 return (*prevvidsw->save_palette)(adp, palette);
336 s3lfb_load_palette(video_adapter_t *adp, u_char *palette)
338 return (*prevvidsw->load_palette)(adp, palette);
342 s3lfb_set_border(video_adapter_t *adp, int color)
344 return (*prevvidsw->set_border)(adp, color);
348 s3lfb_save_state(video_adapter_t *adp, void *p, size_t size)
350 return (*prevvidsw->save_state)(adp, p, size);
354 s3lfb_load_state(video_adapter_t *adp, void *p)
356 return (*prevvidsw->load_state)(adp, p);
360 s3lfb_set_origin(video_adapter_t *adp, off_t offset)
362 return (*prevvidsw->set_win_org)(adp, offset);
366 s3lfb_read_hw_cursor(video_adapter_t *adp, int *col, int *row)
368 return (*prevvidsw->read_hw_cursor)(adp, col, row);
372 s3lfb_set_hw_cursor(video_adapter_t *adp, int col, int row)
374 return (*prevvidsw->set_hw_cursor)(adp, col, row);
378 s3lfb_set_hw_cursor_shape(video_adapter_t *adp, int base, int height,
379 int celsize, int blink)
381 return (*prevvidsw->set_hw_cursor_shape)(adp, base, height,
386 s3lfb_blank_display(video_adapter_t *adp, int mode)
388 return (*prevvidsw->blank_display)(adp, mode);
392 s3lfb_mmap(video_adapter_t *adp, vm_offset_t offset, vm_paddr_t *paddr,
395 return (*prevvidsw->mmap)(adp, offset, paddr, prot);
399 s3lfb_clear(video_adapter_t *adp)
401 return (*prevvidsw->clear)(adp);
405 s3lfb_fill_rect(video_adapter_t *adp, int val, int x, int y, int cx, int cy)
407 return (*prevvidsw->fill_rect)(adp, val, x, y, cx, cy);
411 s3lfb_bitblt(video_adapter_t *adp,...)
413 return (*prevvidsw->bitblt)(adp); /* XXX */
417 s3lfb_ioctl(video_adapter_t *adp, u_long cmd, caddr_t arg)
419 return (*prevvidsw->ioctl)(adp, cmd, arg);
423 s3lfb_diag(video_adapter_t *adp, int level)
425 return (*prevvidsw->diag)(adp, level);
434 /***********************************/
435 /* PCI detection/attachement stuff */
436 /***********************************/
439 s3pci_probe(device_t dev)
441 u_int32_t vendor, class, subclass, device_id;
443 device_id = pci_get_devid(dev);
444 vendor = device_id & 0xffff;
445 class = pci_get_class(dev);
446 subclass = pci_get_subclass(dev);
448 if ((class != PCIC_DISPLAY) || (subclass != PCIS_DISPLAY_VGA) ||
449 (vendor != PCI_S3_VENDOR_ID))
452 device_set_desc(dev, "S3 graphic card");
454 bus_set_resource(dev, SYS_RES_IOPORT, 0,
455 S3_CONFIG_IO, S3_CONFIG_IO_SIZE);
456 bus_set_resource(dev, SYS_RES_IOPORT, 1,
457 S3_ENHANCED_IO, S3_ENHANCED_IO_SIZE);
459 return BUS_PROBE_DEFAULT;
464 s3pci_attach(device_t dev)
466 struct s3pci_softc* sc = (struct s3pci_softc*)device_get_softc(dev);
467 video_adapter_t *adp;
475 printf("%s: driver already attached!\n", __func__);
479 /* Allocate resources
482 if (!(sc->port_res = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid,
483 0ul, ~0ul, 0, RF_ACTIVE | RF_SHAREABLE))) {
484 printf("%s: port resource allocation failed!\n", __func__);
487 sc->st = rman_get_bustag(sc->port_res);
488 sc->sh = rman_get_bushandle(sc->port_res);
491 if (!(sc->enh_res = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid,
492 0ul, ~0ul, 0, RF_ACTIVE | RF_SHAREABLE))) {
493 printf("%s: enhanced port resource allocation failed!\n",
497 sc->enh_st = rman_get_bustag(sc->enh_res);
498 sc->enh_sh = rman_get_bushandle(sc->enh_res);
500 rid = PCI_BASE_MEMORY;
501 if (!(sc->mem_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid,
504 printf("%s: mem resource allocation failed!\n", __func__);
508 /* The memory base address will be our LFB base address
510 /* sc->mem_base = (u_long)rman_get_virtual(sc->mem_res); */
511 sc->mem_base = bus_get_resource_start(dev, SYS_RES_MEMORY, rid);
512 sc->mem_size = bus_get_resource_count(dev, SYS_RES_MEMORY, rid);
514 /* Attach the driver to the VGA/VESA framework
516 for (i = 0; (adp = vid_get_adapter(i)) != NULL; ++i) {
517 if ((adp->va_type == KD_VGA))
521 /* If the VESA module hasn't been loaded, or VGA doesn't
524 if ((adp == NULL) || !(adp->va_flags & V_ADP_VESA)) {
525 printf("%s: VGA adapter not found or VESA module not loaded!\n",
530 /* Replace the VESA video switch by owers
532 prevvidsw = vidsw[adp->va_index];
533 vidsw[adp->va_index] = &s3lfbvidsw;
535 /* Remember who we are on the bus */
536 s3pci_dev = (void *)dev; /* XXX */
542 bus_release_resource(dev, SYS_RES_MEMORY, PCI_BASE_MEMORY, sc->mem_res);
545 bus_release_resource(dev, SYS_RES_IOPORT, 1, sc->enh_res);
548 bus_release_resource(dev, SYS_RES_IOPORT, 0, sc->port_res);
553 static device_method_t s3pci_methods[] = {
555 DEVMETHOD(device_probe, s3pci_probe),
556 DEVMETHOD(device_attach, s3pci_attach),
560 static driver_t s3pci_driver = {
563 sizeof(struct s3pci_softc),
566 static devclass_t s3pci_devclass;
568 DRIVER_MODULE(s3pci, pci, s3pci_driver, s3pci_devclass, 0, 0);