xref: /freebsd/sys/dev/fb/s3_pci.c (revision b9c38d5be6f01799d63e6f94a1f16e58407d2c3f)
1c05aa33cSNicolas Souchu /*-
2718cf2ccSPedro F. Giffuni  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3718cf2ccSPedro F. Giffuni  *
4c05aa33cSNicolas Souchu  * Copyright (c) 2000 Alcove - Nicolas Souchu <nsouch@freebsd.org>
5c05aa33cSNicolas Souchu  * All rights reserved.
6c05aa33cSNicolas Souchu  *
7c05aa33cSNicolas Souchu  * Code based on Peter Horton <pdh@colonel-panic.com> patch.
8c05aa33cSNicolas Souchu  *
9c05aa33cSNicolas Souchu  * Redistribution and use in source and binary forms, with or without
10c05aa33cSNicolas Souchu  * modification, are permitted provided that the following conditions
11c05aa33cSNicolas Souchu  * are met:
12c05aa33cSNicolas Souchu  * 1. Redistributions of source code must retain the above copyright
13c05aa33cSNicolas Souchu  *    notice, this list of conditions and the following disclaimer.
14c05aa33cSNicolas Souchu  * 2. Redistributions in binary form must reproduce the above copyright
15c05aa33cSNicolas Souchu  *    notice, this list of conditions and the following disclaimer in the
16c05aa33cSNicolas Souchu  *    documentation and/or other materials provided with the distribution.
17c05aa33cSNicolas Souchu  *
18c05aa33cSNicolas Souchu  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
19c05aa33cSNicolas Souchu  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20c05aa33cSNicolas Souchu  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21c05aa33cSNicolas Souchu  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
22c05aa33cSNicolas Souchu  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
23c05aa33cSNicolas Souchu  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
24c05aa33cSNicolas Souchu  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
25c05aa33cSNicolas Souchu  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
26c05aa33cSNicolas Souchu  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
27c05aa33cSNicolas Souchu  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
28c05aa33cSNicolas Souchu  * SUCH DAMAGE.
29c05aa33cSNicolas Souchu  */
30c05aa33cSNicolas Souchu 
31aad970f1SDavid E. O'Brien #include <sys/cdefs.h>
32aad970f1SDavid E. O'Brien __FBSDID("$FreeBSD$");
33aad970f1SDavid E. O'Brien 
34c05aa33cSNicolas Souchu /* Enable LFB on S3 cards that has only VESA 1.2 BIOS */
35c05aa33cSNicolas Souchu 
36c05aa33cSNicolas Souchu #include <sys/param.h>
37c05aa33cSNicolas Souchu #include <sys/systm.h>
38c05aa33cSNicolas Souchu #include <sys/kernel.h>
39c05aa33cSNicolas Souchu #include <machine/bus.h>
40c05aa33cSNicolas Souchu 
41c05aa33cSNicolas Souchu #include <vm/vm.h>
42c05aa33cSNicolas Souchu #include <vm/vm_extern.h>
43c05aa33cSNicolas Souchu #include <vm/vm_kern.h>
44c05aa33cSNicolas Souchu #include <vm/pmap.h>
45c05aa33cSNicolas Souchu 
46c05aa33cSNicolas Souchu #include <sys/uio.h>
47c05aa33cSNicolas Souchu #include <sys/module.h>
48c05aa33cSNicolas Souchu #include <sys/bus.h>
49c05aa33cSNicolas Souchu #include <sys/rman.h>
50c05aa33cSNicolas Souchu #include <machine/resource.h>
51c05aa33cSNicolas Souchu 
52c05aa33cSNicolas Souchu #include <sys/malloc.h>
53c05aa33cSNicolas Souchu #include <sys/fbio.h>
54c05aa33cSNicolas Souchu 
554fbd232cSWarner Losh #include <dev/pci/pcireg.h>
564fbd232cSWarner Losh #include <dev/pci/pcivar.h>
57c05aa33cSNicolas Souchu 
58c05aa33cSNicolas Souchu #include <machine/md_var.h>
59c05aa33cSNicolas Souchu #include <machine/pc/bios.h>
60ee5e90daSXin LI #include <dev/fb/vesa.h>
61c05aa33cSNicolas Souchu 
62c05aa33cSNicolas Souchu #include <dev/fb/fbreg.h>
63c05aa33cSNicolas Souchu #include <dev/fb/vgareg.h>
64c05aa33cSNicolas Souchu 
65c05aa33cSNicolas Souchu #define S3PCI_DEBUG 1
66c05aa33cSNicolas Souchu 
67c05aa33cSNicolas Souchu #define PCI_S3_VENDOR_ID	0x5333
68c05aa33cSNicolas Souchu 
69c05aa33cSNicolas Souchu #define S3_CONFIG_IO		0x3c0	/* VGA standard config io ports */
70c05aa33cSNicolas Souchu #define S3_CONFIG_IO_SIZE	0x20
71c05aa33cSNicolas Souchu 
72c05aa33cSNicolas Souchu #define S3_ENHANCED_IO		0x4ae8	/* Extended config register */
73c05aa33cSNicolas Souchu #define S3_ENHANCED_IO_SIZE	1
74c05aa33cSNicolas Souchu 
75c05aa33cSNicolas Souchu #define S3_CRTC_ADDR		0x14
76c05aa33cSNicolas Souchu #define S3_CRTC_VALUE		0x15
77c05aa33cSNicolas Souchu 
78c05aa33cSNicolas Souchu #define PCI_BASE_MEMORY		0x10
79c05aa33cSNicolas Souchu 
80c05aa33cSNicolas Souchu #define outb_p(value, offset) bus_space_write_1(sc->st, sc->sh, offset, value)
81c05aa33cSNicolas Souchu #define inb_p(offset) (bus_space_read_1(sc->st, sc->sh, offset))
82c05aa33cSNicolas Souchu #define outb_enh(value, offset) bus_space_write_1(sc->enh_st, sc->enh_sh, \
83c05aa33cSNicolas Souchu 								offset, value)
84c05aa33cSNicolas Souchu #define inb_enh(offset) (bus_space_read_1(sc->enh_st, sc->enh_sh, offset))
85c05aa33cSNicolas Souchu 
86c05aa33cSNicolas Souchu struct s3pci_softc {
87c05aa33cSNicolas Souchu 	bus_space_tag_t st;
88c05aa33cSNicolas Souchu 	bus_space_handle_t sh;
89c05aa33cSNicolas Souchu 	bus_space_tag_t enh_st;
90c05aa33cSNicolas Souchu 	bus_space_handle_t enh_sh;
91c05aa33cSNicolas Souchu 	struct resource *port_res;
92c05aa33cSNicolas Souchu 	struct resource *enh_res;
93c05aa33cSNicolas Souchu 	struct resource *mem_res;
94c05aa33cSNicolas Souchu 	u_long mem_base;
95c05aa33cSNicolas Souchu 	u_long mem_size;
96c05aa33cSNicolas Souchu };
97c05aa33cSNicolas Souchu 
98c05aa33cSNicolas Souchu static int			s3lfb_error(void);
99c05aa33cSNicolas Souchu static vi_probe_t		s3lfb_probe;
100c05aa33cSNicolas Souchu static vi_init_t		s3lfb_init;
101c05aa33cSNicolas Souchu static vi_get_info_t		s3lfb_get_info;
102c05aa33cSNicolas Souchu static vi_query_mode_t		s3lfb_query_mode;
103c05aa33cSNicolas Souchu static vi_set_mode_t		s3lfb_set_mode;
104c05aa33cSNicolas Souchu static vi_save_font_t		s3lfb_save_font;
105c05aa33cSNicolas Souchu static vi_load_font_t		s3lfb_load_font;
106c05aa33cSNicolas Souchu static vi_show_font_t		s3lfb_show_font;
107c05aa33cSNicolas Souchu static vi_save_palette_t	s3lfb_save_palette;
108c05aa33cSNicolas Souchu static vi_load_palette_t	s3lfb_load_palette;
109c05aa33cSNicolas Souchu static vi_set_border_t		s3lfb_set_border;
110c05aa33cSNicolas Souchu static vi_save_state_t		s3lfb_save_state;
111c05aa33cSNicolas Souchu static vi_load_state_t		s3lfb_load_state;
112c05aa33cSNicolas Souchu static vi_set_win_org_t		s3lfb_set_origin;
113c05aa33cSNicolas Souchu static vi_read_hw_cursor_t	s3lfb_read_hw_cursor;
114c05aa33cSNicolas Souchu static vi_set_hw_cursor_t	s3lfb_set_hw_cursor;
115c05aa33cSNicolas Souchu static vi_set_hw_cursor_shape_t	s3lfb_set_hw_cursor_shape;
116c05aa33cSNicolas Souchu static vi_blank_display_t	s3lfb_blank_display;
117c05aa33cSNicolas Souchu static vi_mmap_t		s3lfb_mmap;
118c05aa33cSNicolas Souchu static vi_ioctl_t		s3lfb_ioctl;
119c05aa33cSNicolas Souchu static vi_clear_t		s3lfb_clear;
120c05aa33cSNicolas Souchu static vi_fill_rect_t		s3lfb_fill_rect;
121c05aa33cSNicolas Souchu static vi_bitblt_t		s3lfb_bitblt;
122c05aa33cSNicolas Souchu static vi_diag_t		s3lfb_diag;
123c05aa33cSNicolas Souchu 
124c05aa33cSNicolas Souchu static video_switch_t s3lfbvidsw = {
125c05aa33cSNicolas Souchu 	s3lfb_probe,
126c05aa33cSNicolas Souchu 	s3lfb_init,
127c05aa33cSNicolas Souchu 	s3lfb_get_info,
128c05aa33cSNicolas Souchu 	s3lfb_query_mode,
129c05aa33cSNicolas Souchu 	s3lfb_set_mode,
130c05aa33cSNicolas Souchu 	s3lfb_save_font,
131c05aa33cSNicolas Souchu 	s3lfb_load_font,
132c05aa33cSNicolas Souchu 	s3lfb_show_font,
133c05aa33cSNicolas Souchu 	s3lfb_save_palette,
134c05aa33cSNicolas Souchu 	s3lfb_load_palette,
135c05aa33cSNicolas Souchu 	s3lfb_set_border,
136c05aa33cSNicolas Souchu 	s3lfb_save_state,
137c05aa33cSNicolas Souchu 	s3lfb_load_state,
138c05aa33cSNicolas Souchu 	s3lfb_set_origin,
139c05aa33cSNicolas Souchu 	s3lfb_read_hw_cursor,
140c05aa33cSNicolas Souchu 	s3lfb_set_hw_cursor,
141c05aa33cSNicolas Souchu 	s3lfb_set_hw_cursor_shape,
142c05aa33cSNicolas Souchu 	s3lfb_blank_display,
143c05aa33cSNicolas Souchu 	s3lfb_mmap,
144c05aa33cSNicolas Souchu 	s3lfb_ioctl,
145c05aa33cSNicolas Souchu 	s3lfb_clear,
146c05aa33cSNicolas Souchu 	s3lfb_fill_rect,
147c05aa33cSNicolas Souchu 	s3lfb_bitblt,
148c05aa33cSNicolas Souchu 	s3lfb_error,
149c05aa33cSNicolas Souchu 	s3lfb_error,
150c05aa33cSNicolas Souchu 	s3lfb_diag,
151c05aa33cSNicolas Souchu };
152c05aa33cSNicolas Souchu 
153c05aa33cSNicolas Souchu static video_switch_t *prevvidsw;
154c05aa33cSNicolas Souchu static device_t s3pci_dev = NULL;
155c05aa33cSNicolas Souchu 
156c05aa33cSNicolas Souchu static int
157c05aa33cSNicolas Souchu s3lfb_probe(int unit, video_adapter_t **adpp, void *arg, int flags)
158c05aa33cSNicolas Souchu {
159c05aa33cSNicolas Souchu 	return (*prevvidsw->probe)(unit, adpp, arg, flags);
160c05aa33cSNicolas Souchu }
161c05aa33cSNicolas Souchu 
162c05aa33cSNicolas Souchu static int
163c05aa33cSNicolas Souchu s3lfb_init(int unit, video_adapter_t *adp, int flags)
164c05aa33cSNicolas Souchu {
165c05aa33cSNicolas Souchu 	return (*prevvidsw->init)(unit, adp, flags);
166c05aa33cSNicolas Souchu }
167c05aa33cSNicolas Souchu 
168c05aa33cSNicolas Souchu static int
169c05aa33cSNicolas Souchu s3lfb_get_info(video_adapter_t *adp, int mode, video_info_t *info)
170c05aa33cSNicolas Souchu {
1715928fa5cSJohn Baldwin #if 0
172c05aa33cSNicolas Souchu 	device_t dev = s3pci_dev;			/* XXX */
173c05aa33cSNicolas Souchu 	struct s3pci_softc *sc = (struct s3pci_softc *)device_get_softc(dev);
1745928fa5cSJohn Baldwin #endif
175c05aa33cSNicolas Souchu 	int error;
176c05aa33cSNicolas Souchu 
177c05aa33cSNicolas Souchu 	if ((error = (*prevvidsw->get_info)(adp, mode, info)))
178c05aa33cSNicolas Souchu 		return error;
179c05aa33cSNicolas Souchu 
180c05aa33cSNicolas Souchu #if 0
181c05aa33cSNicolas Souchu 	/* Don't use linear addressing with text modes
182c05aa33cSNicolas Souchu 	 */
183c05aa33cSNicolas Souchu 	if ((mode > M_VESA_BASE) &&
184c05aa33cSNicolas Souchu 		(info->vi_flags & V_INFO_GRAPHICS) &&
185c05aa33cSNicolas Souchu 		!(info->vi_flags & V_INFO_LINEAR)) {
186c05aa33cSNicolas Souchu 
187c05aa33cSNicolas Souchu 		info->vi_flags |= V_INFO_LINEAR;
188c05aa33cSNicolas Souchu 		info->vi_buffer = sc->mem_base;
189c05aa33cSNicolas Souchu 
190c05aa33cSNicolas Souchu 	} else {
191c05aa33cSNicolas Souchu 		info->vi_buffer = 0;
192c05aa33cSNicolas Souchu 	}
193c05aa33cSNicolas Souchu #endif
194c05aa33cSNicolas Souchu 
195c05aa33cSNicolas Souchu 	return 0;
196c05aa33cSNicolas Souchu }
197c05aa33cSNicolas Souchu 
198c05aa33cSNicolas Souchu static int
199c05aa33cSNicolas Souchu s3lfb_query_mode(video_adapter_t *adp, video_info_t *info)
200c05aa33cSNicolas Souchu {
201c05aa33cSNicolas Souchu 	return (*prevvidsw->query_mode)(adp, info);
202c05aa33cSNicolas Souchu }
203c05aa33cSNicolas Souchu 
204c05aa33cSNicolas Souchu static vm_offset_t
205c05aa33cSNicolas Souchu s3lfb_map_buffer(u_int paddr, size_t size)
206c05aa33cSNicolas Souchu {
207c05aa33cSNicolas Souchu 	vm_offset_t vaddr;
208c05aa33cSNicolas Souchu 	u_int off;
209c05aa33cSNicolas Souchu 
210c05aa33cSNicolas Souchu 	off = paddr - trunc_page(paddr);
211c05aa33cSNicolas Souchu 	vaddr = (vm_offset_t)pmap_mapdev(paddr - off, size + off);
212c05aa33cSNicolas Souchu 
213c05aa33cSNicolas Souchu 	return (vaddr + off);
214c05aa33cSNicolas Souchu }
215c05aa33cSNicolas Souchu 
216c05aa33cSNicolas Souchu static int
217c05aa33cSNicolas Souchu s3lfb_set_mode(video_adapter_t *adp, int mode)
218c05aa33cSNicolas Souchu {
219c05aa33cSNicolas Souchu 	device_t dev = s3pci_dev;			/* XXX */
220c05aa33cSNicolas Souchu 	struct s3pci_softc *sc = (struct s3pci_softc *)device_get_softc(dev);
2215928fa5cSJohn Baldwin #if 0
222c05aa33cSNicolas Souchu 	unsigned char tmp;
2235928fa5cSJohn Baldwin #endif
224c05aa33cSNicolas Souchu 	int error;
225c05aa33cSNicolas Souchu 
226c05aa33cSNicolas Souchu 	/* First, set the mode as if it was a classic VESA card
227c05aa33cSNicolas Souchu 	 */
228c05aa33cSNicolas Souchu 	if ((error = (*prevvidsw->set_mode)(adp, mode)))
229c05aa33cSNicolas Souchu 		return error;
230c05aa33cSNicolas Souchu 
231c05aa33cSNicolas Souchu 	/* If not in a linear mode (according to s3lfb_get_info() called
232c05aa33cSNicolas Souchu 	 * by vesa_set_mode in the (*vidsw[adp->va_index]->get_info)...
233c05aa33cSNicolas Souchu 	 * sequence, return with no error
234c05aa33cSNicolas Souchu 	 */
235c05aa33cSNicolas Souchu #if 0
236c05aa33cSNicolas Souchu 	if (!(adp->va_info.vi_flags & V_INFO_LINEAR))
237c05aa33cSNicolas Souchu 		return 0;
238c05aa33cSNicolas Souchu #endif
239c05aa33cSNicolas Souchu 
240c05aa33cSNicolas Souchu 	if ((mode <= M_VESA_BASE) ||
241c05aa33cSNicolas Souchu 		!(adp->va_info.vi_flags & V_INFO_GRAPHICS) ||
242c05aa33cSNicolas Souchu 		(adp->va_info.vi_flags & V_INFO_LINEAR))
243c05aa33cSNicolas Souchu 		return 0;
244c05aa33cSNicolas Souchu 
245c05aa33cSNicolas Souchu 	/* Ok, now apply the configuration to the card */
246c05aa33cSNicolas Souchu 
247c05aa33cSNicolas Souchu 	outb_p(0x38, S3_CRTC_ADDR); outb_p(0x48, S3_CRTC_VALUE);
248c05aa33cSNicolas Souchu 	outb_p(0x39, S3_CRTC_ADDR); outb_p(0xa5, S3_CRTC_VALUE);
249c05aa33cSNicolas Souchu 
250c05aa33cSNicolas Souchu        /* check that CR47 is read/write */
251c05aa33cSNicolas Souchu 
252c05aa33cSNicolas Souchu #if 0
253c05aa33cSNicolas Souchu 	outb_p(0x47, S3_CRTC_ADDR); outb_p(0xff, S3_CRTC_VALUE);
254c05aa33cSNicolas Souchu 	tmp = inb_p(S3_CRTC_VALUE);
255c05aa33cSNicolas Souchu 	outb_p(0x00, S3_CRTC_VALUE);
256c05aa33cSNicolas Souchu 	if ((tmp != 0xff) || (inb_p(S3_CRTC_VALUE)))
257c05aa33cSNicolas Souchu 	{
258c05aa33cSNicolas Souchu 		/* lock S3 registers */
259c05aa33cSNicolas Souchu 
260c05aa33cSNicolas Souchu 		outb_p(0x39, S3_CRTC_ADDR); outb_p(0x5a, S3_CRTC_VALUE);
261c05aa33cSNicolas Souchu 		outb_p(0x38, S3_CRTC_ADDR); outb_p(0x00, S3_CRTC_VALUE);
262c05aa33cSNicolas Souchu 
263c05aa33cSNicolas Souchu 		return ENXIO;
264c05aa33cSNicolas Souchu 	}
265c05aa33cSNicolas Souchu #endif
266c05aa33cSNicolas Souchu 
267c05aa33cSNicolas Souchu 	/* enable enhanced register access */
268c05aa33cSNicolas Souchu 
269c05aa33cSNicolas Souchu 	outb_p(0x40, S3_CRTC_ADDR);
270c05aa33cSNicolas Souchu 	outb_p(inb_p(S3_CRTC_VALUE) | 1, S3_CRTC_VALUE);
271c05aa33cSNicolas Souchu 
272c05aa33cSNicolas Souchu 	/* enable enhanced functions */
273c05aa33cSNicolas Souchu 
274c05aa33cSNicolas Souchu 	outb_enh(inb_enh(0) | 1, 0x0);
275c05aa33cSNicolas Souchu 
276c05aa33cSNicolas Souchu 	/* enable enhanced mode memory mapping */
277c05aa33cSNicolas Souchu 
278c05aa33cSNicolas Souchu 	outb_p(0x31, S3_CRTC_ADDR);
279c05aa33cSNicolas Souchu 	outb_p(inb_p(S3_CRTC_VALUE) | 8, S3_CRTC_VALUE);
280c05aa33cSNicolas Souchu 
281c05aa33cSNicolas Souchu 	/* enable linear frame buffer and set address window to max */
282c05aa33cSNicolas Souchu 
283c05aa33cSNicolas Souchu 	outb_p(0x58, S3_CRTC_ADDR);
284c05aa33cSNicolas Souchu 	outb_p(inb_p(S3_CRTC_VALUE) | 0x13, S3_CRTC_VALUE);
285c05aa33cSNicolas Souchu 
286c05aa33cSNicolas Souchu 	/* disabled enhanced register access */
287c05aa33cSNicolas Souchu 
288c05aa33cSNicolas Souchu 	outb_p(0x40, S3_CRTC_ADDR);
289c05aa33cSNicolas Souchu 	outb_p(inb_p(S3_CRTC_VALUE) & ~1, S3_CRTC_VALUE);
290c05aa33cSNicolas Souchu 
291c05aa33cSNicolas Souchu 	/* lock S3 registers */
292c05aa33cSNicolas Souchu 
293c05aa33cSNicolas Souchu 	outb_p(0x39, S3_CRTC_ADDR); outb_p(0x5a, S3_CRTC_VALUE);
294c05aa33cSNicolas Souchu 	outb_p(0x38, S3_CRTC_ADDR); outb_p(0x00, S3_CRTC_VALUE);
295c05aa33cSNicolas Souchu 
296c05aa33cSNicolas Souchu 	adp->va_info.vi_flags |= V_INFO_LINEAR;
297c05aa33cSNicolas Souchu 	adp->va_info.vi_buffer = sc->mem_base;
298c05aa33cSNicolas Souchu 	adp->va_buffer = s3lfb_map_buffer(adp->va_info.vi_buffer,
299c05aa33cSNicolas Souchu 				adp->va_info.vi_buffer_size);
300c05aa33cSNicolas Souchu 	adp->va_buffer_size = adp->va_info.vi_buffer_size;
301c05aa33cSNicolas Souchu 	adp->va_window = adp->va_buffer;
302c05aa33cSNicolas Souchu 	adp->va_window_size = adp->va_info.vi_buffer_size/adp->va_info.vi_planes;
303c05aa33cSNicolas Souchu 	adp->va_window_gran = adp->va_info.vi_buffer_size/adp->va_info.vi_planes;
304c05aa33cSNicolas Souchu 
305c05aa33cSNicolas Souchu 	return 0;
306c05aa33cSNicolas Souchu }
307c05aa33cSNicolas Souchu 
308c05aa33cSNicolas Souchu static int
309b7c96c0dSMarius Strobl s3lfb_save_font(video_adapter_t *adp, int page, int fontsize, int fontwidth,
310b7c96c0dSMarius Strobl 	       u_char *data, int ch, int count)
311c05aa33cSNicolas Souchu {
312b7c96c0dSMarius Strobl 	return (*prevvidsw->save_font)(adp, page, fontsize, fontwidth, data,
313b7c96c0dSMarius Strobl 		ch, count);
314c05aa33cSNicolas Souchu }
315c05aa33cSNicolas Souchu 
316c05aa33cSNicolas Souchu static int
317b7c96c0dSMarius Strobl s3lfb_load_font(video_adapter_t *adp, int page, int fontsize, int fontwidth,
318b7c96c0dSMarius Strobl 	       u_char *data, int ch, int count)
319c05aa33cSNicolas Souchu {
320b7c96c0dSMarius Strobl 	return (*prevvidsw->load_font)(adp, page, fontsize, fontwidth, data,
321b7c96c0dSMarius Strobl 		ch, count);
322c05aa33cSNicolas Souchu }
323c05aa33cSNicolas Souchu 
324c05aa33cSNicolas Souchu static int
325c05aa33cSNicolas Souchu s3lfb_show_font(video_adapter_t *adp, int page)
326c05aa33cSNicolas Souchu {
327c05aa33cSNicolas Souchu 	return (*prevvidsw->show_font)(adp, page);
328c05aa33cSNicolas Souchu }
329c05aa33cSNicolas Souchu 
330c05aa33cSNicolas Souchu static int
331c05aa33cSNicolas Souchu s3lfb_save_palette(video_adapter_t *adp, u_char *palette)
332c05aa33cSNicolas Souchu {
333c05aa33cSNicolas Souchu 	return (*prevvidsw->save_palette)(adp, palette);
334c05aa33cSNicolas Souchu }
335c05aa33cSNicolas Souchu 
336c05aa33cSNicolas Souchu static int
337c05aa33cSNicolas Souchu s3lfb_load_palette(video_adapter_t *adp, u_char *palette)
338c05aa33cSNicolas Souchu {
339c05aa33cSNicolas Souchu 	return (*prevvidsw->load_palette)(adp, palette);
340c05aa33cSNicolas Souchu }
341c05aa33cSNicolas Souchu 
342c05aa33cSNicolas Souchu static int
343c05aa33cSNicolas Souchu s3lfb_set_border(video_adapter_t *adp, int color)
344c05aa33cSNicolas Souchu {
345c05aa33cSNicolas Souchu 	return (*prevvidsw->set_border)(adp, color);
346c05aa33cSNicolas Souchu }
347c05aa33cSNicolas Souchu 
348c05aa33cSNicolas Souchu static int
349c05aa33cSNicolas Souchu s3lfb_save_state(video_adapter_t *adp, void *p, size_t size)
350c05aa33cSNicolas Souchu {
351c05aa33cSNicolas Souchu 	return (*prevvidsw->save_state)(adp, p, size);
352c05aa33cSNicolas Souchu }
353c05aa33cSNicolas Souchu 
354c05aa33cSNicolas Souchu static int
355c05aa33cSNicolas Souchu s3lfb_load_state(video_adapter_t *adp, void *p)
356c05aa33cSNicolas Souchu {
357c05aa33cSNicolas Souchu 	return (*prevvidsw->load_state)(adp, p);
358c05aa33cSNicolas Souchu }
359c05aa33cSNicolas Souchu 
360c05aa33cSNicolas Souchu static int
361c05aa33cSNicolas Souchu s3lfb_set_origin(video_adapter_t *adp, off_t offset)
362c05aa33cSNicolas Souchu {
363c05aa33cSNicolas Souchu 	return (*prevvidsw->set_win_org)(adp, offset);
364c05aa33cSNicolas Souchu }
365c05aa33cSNicolas Souchu 
366c05aa33cSNicolas Souchu static int
367c05aa33cSNicolas Souchu s3lfb_read_hw_cursor(video_adapter_t *adp, int *col, int *row)
368c05aa33cSNicolas Souchu {
369c05aa33cSNicolas Souchu 	return (*prevvidsw->read_hw_cursor)(adp, col, row);
370c05aa33cSNicolas Souchu }
371c05aa33cSNicolas Souchu 
372c05aa33cSNicolas Souchu static int
373c05aa33cSNicolas Souchu s3lfb_set_hw_cursor(video_adapter_t *adp, int col, int row)
374c05aa33cSNicolas Souchu {
375c05aa33cSNicolas Souchu 	return (*prevvidsw->set_hw_cursor)(adp, col, row);
376c05aa33cSNicolas Souchu }
377c05aa33cSNicolas Souchu 
378c05aa33cSNicolas Souchu static int
379c05aa33cSNicolas Souchu s3lfb_set_hw_cursor_shape(video_adapter_t *adp, int base, int height,
380c05aa33cSNicolas Souchu 			 int celsize, int blink)
381c05aa33cSNicolas Souchu {
382c05aa33cSNicolas Souchu 	return (*prevvidsw->set_hw_cursor_shape)(adp, base, height,
383c05aa33cSNicolas Souchu 			celsize, blink);
384c05aa33cSNicolas Souchu }
385c05aa33cSNicolas Souchu 
386c05aa33cSNicolas Souchu static int
387c05aa33cSNicolas Souchu s3lfb_blank_display(video_adapter_t *adp, int mode)
388c05aa33cSNicolas Souchu {
389c05aa33cSNicolas Souchu 	return (*prevvidsw->blank_display)(adp, mode);
390c05aa33cSNicolas Souchu }
391c05aa33cSNicolas Souchu 
392c05aa33cSNicolas Souchu static int
393cfd7baceSRobert Noland s3lfb_mmap(video_adapter_t *adp, vm_ooffset_t offset, vm_paddr_t *paddr,
394cfd7baceSRobert Noland 	  int prot, vm_memattr_t *memattr)
395c05aa33cSNicolas Souchu {
396cfd7baceSRobert Noland 	return (*prevvidsw->mmap)(adp, offset, paddr, prot, memattr);
397c05aa33cSNicolas Souchu }
398c05aa33cSNicolas Souchu 
399c05aa33cSNicolas Souchu static int
400c05aa33cSNicolas Souchu s3lfb_clear(video_adapter_t *adp)
401c05aa33cSNicolas Souchu {
402c05aa33cSNicolas Souchu 	return (*prevvidsw->clear)(adp);
403c05aa33cSNicolas Souchu }
404c05aa33cSNicolas Souchu 
405c05aa33cSNicolas Souchu static int
406c05aa33cSNicolas Souchu s3lfb_fill_rect(video_adapter_t *adp, int val, int x, int y, int cx, int cy)
407c05aa33cSNicolas Souchu {
408c05aa33cSNicolas Souchu 	return (*prevvidsw->fill_rect)(adp, val, x, y, cx, cy);
409c05aa33cSNicolas Souchu }
410c05aa33cSNicolas Souchu 
411c05aa33cSNicolas Souchu static int
412c05aa33cSNicolas Souchu s3lfb_bitblt(video_adapter_t *adp,...)
413c05aa33cSNicolas Souchu {
414c05aa33cSNicolas Souchu 	return (*prevvidsw->bitblt)(adp);		/* XXX */
415c05aa33cSNicolas Souchu }
416c05aa33cSNicolas Souchu 
417c05aa33cSNicolas Souchu static int
418c05aa33cSNicolas Souchu s3lfb_ioctl(video_adapter_t *adp, u_long cmd, caddr_t arg)
419c05aa33cSNicolas Souchu {
420c05aa33cSNicolas Souchu 	return (*prevvidsw->ioctl)(adp, cmd, arg);
421c05aa33cSNicolas Souchu }
422c05aa33cSNicolas Souchu 
423c05aa33cSNicolas Souchu static int
424c05aa33cSNicolas Souchu s3lfb_diag(video_adapter_t *adp, int level)
425c05aa33cSNicolas Souchu {
426c05aa33cSNicolas Souchu 	return (*prevvidsw->diag)(adp, level);
427c05aa33cSNicolas Souchu }
428c05aa33cSNicolas Souchu 
429c05aa33cSNicolas Souchu static int
430c05aa33cSNicolas Souchu s3lfb_error(void)
431c05aa33cSNicolas Souchu {
432c05aa33cSNicolas Souchu 	return 1;
433c05aa33cSNicolas Souchu }
434c05aa33cSNicolas Souchu 
435c05aa33cSNicolas Souchu /***********************************/
436c05aa33cSNicolas Souchu /* PCI detection/attachement stuff */
437c05aa33cSNicolas Souchu /***********************************/
438c05aa33cSNicolas Souchu 
439c05aa33cSNicolas Souchu static int
440c05aa33cSNicolas Souchu s3pci_probe(device_t dev)
441c05aa33cSNicolas Souchu {
442c05aa33cSNicolas Souchu 	u_int32_t vendor, class, subclass, device_id;
443c05aa33cSNicolas Souchu 
444c05aa33cSNicolas Souchu 	device_id = pci_get_devid(dev);
445c05aa33cSNicolas Souchu 	vendor = device_id & 0xffff;
446c05aa33cSNicolas Souchu 	class = pci_get_class(dev);
447c05aa33cSNicolas Souchu 	subclass = pci_get_subclass(dev);
448c05aa33cSNicolas Souchu 
449c05aa33cSNicolas Souchu 	if ((class != PCIC_DISPLAY) || (subclass != PCIS_DISPLAY_VGA) ||
450c05aa33cSNicolas Souchu 		(vendor != PCI_S3_VENDOR_ID))
451c05aa33cSNicolas Souchu 		return ENXIO;
452c05aa33cSNicolas Souchu 
453c05aa33cSNicolas Souchu 	device_set_desc(dev, "S3 graphic card");
454c05aa33cSNicolas Souchu 
455c05aa33cSNicolas Souchu 	bus_set_resource(dev, SYS_RES_IOPORT, 0,
456c05aa33cSNicolas Souchu 				S3_CONFIG_IO, S3_CONFIG_IO_SIZE);
457c05aa33cSNicolas Souchu 	bus_set_resource(dev, SYS_RES_IOPORT, 1,
458c05aa33cSNicolas Souchu 				S3_ENHANCED_IO, S3_ENHANCED_IO_SIZE);
459c05aa33cSNicolas Souchu 
460538565c4SWarner Losh 	return BUS_PROBE_DEFAULT;
461c05aa33cSNicolas Souchu 
462c05aa33cSNicolas Souchu };
463c05aa33cSNicolas Souchu 
464c05aa33cSNicolas Souchu static int
465c05aa33cSNicolas Souchu s3pci_attach(device_t dev)
466c05aa33cSNicolas Souchu {
467c05aa33cSNicolas Souchu 	struct s3pci_softc* sc = (struct s3pci_softc*)device_get_softc(dev);
468c05aa33cSNicolas Souchu 	video_adapter_t *adp;
469c05aa33cSNicolas Souchu 
470c05aa33cSNicolas Souchu #if 0
471c05aa33cSNicolas Souchu 	unsigned char tmp;
472c05aa33cSNicolas Souchu #endif
473c05aa33cSNicolas Souchu 	int rid, i;
474c05aa33cSNicolas Souchu 
475c05aa33cSNicolas Souchu 	if (s3pci_dev) {
4766e551fb6SDavid E. O'Brien 		printf("%s: driver already attached!\n", __func__);
477c05aa33cSNicolas Souchu 		goto error;
478c05aa33cSNicolas Souchu 	}
479c05aa33cSNicolas Souchu 
480c05aa33cSNicolas Souchu 	/* Allocate resources
481c05aa33cSNicolas Souchu 	 */
482c05aa33cSNicolas Souchu 	rid = 0;
48343cd6160SJustin Hibbits 	if (!(sc->port_res = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid,
48443cd6160SJustin Hibbits 				RF_ACTIVE | RF_SHAREABLE))) {
4856e551fb6SDavid E. O'Brien 		printf("%s: port resource allocation failed!\n", __func__);
486c05aa33cSNicolas Souchu 		goto error;
487c05aa33cSNicolas Souchu 	}
488c05aa33cSNicolas Souchu 	sc->st = rman_get_bustag(sc->port_res);
489c05aa33cSNicolas Souchu 	sc->sh = rman_get_bushandle(sc->port_res);
490c05aa33cSNicolas Souchu 
491c05aa33cSNicolas Souchu 	rid = 1;
49243cd6160SJustin Hibbits 	if (!(sc->enh_res = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid,
49343cd6160SJustin Hibbits 				RF_ACTIVE | RF_SHAREABLE))) {
494c05aa33cSNicolas Souchu 		printf("%s: enhanced port resource allocation failed!\n",
4956e551fb6SDavid E. O'Brien 			__func__);
496c05aa33cSNicolas Souchu 		goto error;
497c05aa33cSNicolas Souchu 	}
498c05aa33cSNicolas Souchu 	sc->enh_st = rman_get_bustag(sc->enh_res);
499c05aa33cSNicolas Souchu 	sc->enh_sh = rman_get_bushandle(sc->enh_res);
500c05aa33cSNicolas Souchu 
501c05aa33cSNicolas Souchu 	rid = PCI_BASE_MEMORY;
5025f96beb9SNate Lawson 	if (!(sc->mem_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid,
5035f96beb9SNate Lawson 				 RF_ACTIVE))) {
504c05aa33cSNicolas Souchu 
5056e551fb6SDavid E. O'Brien 		printf("%s: mem resource allocation failed!\n", __func__);
506c05aa33cSNicolas Souchu 		goto error;
507c05aa33cSNicolas Souchu 	}
508c05aa33cSNicolas Souchu 
509c05aa33cSNicolas Souchu 	/* The memory base address will be our LFB base address
510c05aa33cSNicolas Souchu 	 */
511c05aa33cSNicolas Souchu 	/* sc->mem_base = (u_long)rman_get_virtual(sc->mem_res); */
512c05aa33cSNicolas Souchu 	sc->mem_base = bus_get_resource_start(dev, SYS_RES_MEMORY, rid);
513c05aa33cSNicolas Souchu 	sc->mem_size = bus_get_resource_count(dev, SYS_RES_MEMORY, rid);
514c05aa33cSNicolas Souchu 
515c05aa33cSNicolas Souchu 	/* Attach the driver to the VGA/VESA framework
516c05aa33cSNicolas Souchu 	 */
517c05aa33cSNicolas Souchu 	for (i = 0; (adp = vid_get_adapter(i)) != NULL; ++i) {
5185cf2cbcaSJung-uk Kim 		if (adp->va_type == KD_VGA)
519c05aa33cSNicolas Souchu 			break;
520c05aa33cSNicolas Souchu 	}
521c05aa33cSNicolas Souchu 
522c05aa33cSNicolas Souchu 	/* If the VESA module hasn't been loaded, or VGA doesn't
523c05aa33cSNicolas Souchu 	 * exist, abort
524c05aa33cSNicolas Souchu 	 */
525c05aa33cSNicolas Souchu 	if ((adp == NULL) || !(adp->va_flags & V_ADP_VESA)) {
526c05aa33cSNicolas Souchu 		printf("%s: VGA adapter not found or VESA module not loaded!\n",
5276e551fb6SDavid E. O'Brien 			__func__);
528c05aa33cSNicolas Souchu 		goto error;
529c05aa33cSNicolas Souchu 	}
530c05aa33cSNicolas Souchu 
531c05aa33cSNicolas Souchu 	/* Replace the VESA video switch by owers
532c05aa33cSNicolas Souchu 	 */
533c05aa33cSNicolas Souchu 	prevvidsw = vidsw[adp->va_index];
534c05aa33cSNicolas Souchu 	vidsw[adp->va_index] = &s3lfbvidsw;
535c05aa33cSNicolas Souchu 
536c05aa33cSNicolas Souchu 	/* Remember who we are on the bus */
537c05aa33cSNicolas Souchu 	s3pci_dev = (void *)dev;			/* XXX */
538c05aa33cSNicolas Souchu 
539c05aa33cSNicolas Souchu 	return 0;
540c05aa33cSNicolas Souchu 
541c05aa33cSNicolas Souchu error:
542c05aa33cSNicolas Souchu 	if (sc->mem_res)
543c05aa33cSNicolas Souchu 		bus_release_resource(dev, SYS_RES_MEMORY, PCI_BASE_MEMORY, sc->mem_res);
544c05aa33cSNicolas Souchu 
545c05aa33cSNicolas Souchu 	if (sc->enh_res)
546c05aa33cSNicolas Souchu 		bus_release_resource(dev, SYS_RES_IOPORT, 1, sc->enh_res);
547c05aa33cSNicolas Souchu 
548c05aa33cSNicolas Souchu 	if (sc->port_res)
549c05aa33cSNicolas Souchu 		bus_release_resource(dev, SYS_RES_IOPORT, 0, sc->port_res);
550c05aa33cSNicolas Souchu 
551c05aa33cSNicolas Souchu 	return ENXIO;
552c05aa33cSNicolas Souchu };
553c05aa33cSNicolas Souchu 
554c05aa33cSNicolas Souchu static device_method_t s3pci_methods[] = {
555c05aa33cSNicolas Souchu 
556c05aa33cSNicolas Souchu         DEVMETHOD(device_probe, s3pci_probe),
557c05aa33cSNicolas Souchu         DEVMETHOD(device_attach, s3pci_attach),
558c05aa33cSNicolas Souchu         {0,0}
559c05aa33cSNicolas Souchu };
560c05aa33cSNicolas Souchu 
561c05aa33cSNicolas Souchu static driver_t s3pci_driver = {
562c05aa33cSNicolas Souchu 	"s3pci",
563c05aa33cSNicolas Souchu 	s3pci_methods,
564c05aa33cSNicolas Souchu 	sizeof(struct s3pci_softc),
565c05aa33cSNicolas Souchu };
566c05aa33cSNicolas Souchu 
567*b9c38d5bSJohn Baldwin DRIVER_MODULE(s3pci, pci, s3pci_driver, 0, 0);
568