xref: /openbsd-src/sys/dev/ic/ibm561.c (revision e6c6495d62998a12dd778aed8d40dc250167a61c)
1e00d3f43Smatthieu /* $NetBSD: ibm561.c,v 1.1 2001/12/12 07:46:48 elric Exp $ */
2*e6c6495dSderaadt /* $OpenBSD: ibm561.c,v 1.7 2014/07/08 17:19:25 deraadt Exp $ */
3e00d3f43Smatthieu 
4e00d3f43Smatthieu /*-
5e00d3f43Smatthieu  * Copyright (c) 2001 The NetBSD Foundation, Inc.
6e00d3f43Smatthieu  * All rights reserved.
7e00d3f43Smatthieu  *
8e00d3f43Smatthieu  * This code is derived from software contributed to The NetBSD Foundation
9e00d3f43Smatthieu  * by Roland C. Dowdeswell of Ponte, Inc.
10e00d3f43Smatthieu  *
11e00d3f43Smatthieu  * Redistribution and use in source and binary forms, with or without
12e00d3f43Smatthieu  * modification, are permitted provided that the following conditions
13e00d3f43Smatthieu  * are met:
14e00d3f43Smatthieu  * 1. Redistributions of source code must retain the above copyright
15e00d3f43Smatthieu  *    notice, this list of conditions and the following disclaimer.
16e00d3f43Smatthieu  * 2. Redistributions in binary form must reproduce the above copyright
17e00d3f43Smatthieu  *    notice, this list of conditions and the following disclaimer in the
18e00d3f43Smatthieu  *    documentation and/or other materials provided with the distribution.
19e00d3f43Smatthieu  *
20e00d3f43Smatthieu  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
21e00d3f43Smatthieu  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
22e00d3f43Smatthieu  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
23e00d3f43Smatthieu  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
24e00d3f43Smatthieu  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
25e00d3f43Smatthieu  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
26e00d3f43Smatthieu  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
27e00d3f43Smatthieu  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
28e00d3f43Smatthieu  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
29e00d3f43Smatthieu  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
30e00d3f43Smatthieu  * POSSIBILITY OF SUCH DAMAGE.
31e00d3f43Smatthieu  */
32e00d3f43Smatthieu 
33e00d3f43Smatthieu #include <sys/param.h>
34e00d3f43Smatthieu #include <sys/systm.h>
35e00d3f43Smatthieu #include <sys/device.h>
36e00d3f43Smatthieu #include <sys/buf.h>
37e00d3f43Smatthieu #include <sys/kernel.h>
38e00d3f43Smatthieu #include <sys/malloc.h>
39e00d3f43Smatthieu 
40e00d3f43Smatthieu #include <dev/pci/pcivar.h>
41e00d3f43Smatthieu #include <dev/ic/ibm561reg.h>
42e00d3f43Smatthieu #include <dev/ic/ibm561var.h>
43e00d3f43Smatthieu #include <dev/ic/ramdac.h>
44e00d3f43Smatthieu 
45e00d3f43Smatthieu #include <dev/wscons/wsconsio.h>
46e00d3f43Smatthieu 
47e00d3f43Smatthieu /*
48e00d3f43Smatthieu  * Functions exported via the RAMDAC configuration table.
49e00d3f43Smatthieu  */
50e00d3f43Smatthieu void	ibm561_init(struct ramdac_cookie *);
51e00d3f43Smatthieu int	ibm561_set_cmap(struct ramdac_cookie *,
52e00d3f43Smatthieu 	    struct wsdisplay_cmap *);
53e00d3f43Smatthieu int	ibm561_get_cmap(struct ramdac_cookie *,
54e00d3f43Smatthieu 	    struct wsdisplay_cmap *);
55e00d3f43Smatthieu int	ibm561_set_cursor(struct ramdac_cookie *,
56e00d3f43Smatthieu 	    struct wsdisplay_cursor *);
57e00d3f43Smatthieu int	ibm561_get_cursor(struct ramdac_cookie *,
58e00d3f43Smatthieu 	    struct wsdisplay_cursor *);
59e00d3f43Smatthieu int	ibm561_set_curpos(struct ramdac_cookie *,
60e00d3f43Smatthieu 	    struct wsdisplay_curpos *);
61e00d3f43Smatthieu int	ibm561_get_curpos(struct ramdac_cookie *,
62e00d3f43Smatthieu 	    struct wsdisplay_curpos *);
63e00d3f43Smatthieu int	ibm561_get_curmax(struct ramdac_cookie *,
64e00d3f43Smatthieu 	    struct wsdisplay_curpos *);
65e00d3f43Smatthieu int	ibm561_set_dotclock(struct ramdac_cookie *,
66e00d3f43Smatthieu 	    unsigned);
67e00d3f43Smatthieu 
68e00d3f43Smatthieu /* XXX const */
69e00d3f43Smatthieu struct ramdac_funcs ibm561_funcsstruct = {
70e00d3f43Smatthieu 	"IBM561",
71e00d3f43Smatthieu 	ibm561_register,
72e00d3f43Smatthieu 	ibm561_init,
73e00d3f43Smatthieu 	ibm561_set_cmap,
74e00d3f43Smatthieu 	ibm561_get_cmap,
75e00d3f43Smatthieu 	ibm561_set_cursor,
76e00d3f43Smatthieu 	ibm561_get_cursor,
77e00d3f43Smatthieu 	ibm561_set_curpos,
78e00d3f43Smatthieu 	ibm561_get_curpos,
79e00d3f43Smatthieu 	ibm561_get_curmax,
80e00d3f43Smatthieu 	NULL,			/* check_curcmap; not needed */
81e00d3f43Smatthieu 	NULL,			/* set_curcmap; not needed */
82e00d3f43Smatthieu 	NULL,			/* get_curcmap; not needed */
83e00d3f43Smatthieu 	ibm561_set_dotclock,
84e00d3f43Smatthieu };
85e00d3f43Smatthieu 
86e00d3f43Smatthieu /*
87e00d3f43Smatthieu  * Private data.
88e00d3f43Smatthieu  */
89e00d3f43Smatthieu struct ibm561data {
90e00d3f43Smatthieu 	void            *cookie;
91e00d3f43Smatthieu 
92e00d3f43Smatthieu 	int             (*ramdac_sched_update)(void *, void (*)(void *));
93e00d3f43Smatthieu 	void            (*ramdac_wr)(void *, u_int, u_int8_t);
94e00d3f43Smatthieu 	u_int8_t        (*ramdac_rd)(void *, u_int);
95e00d3f43Smatthieu 
96e00d3f43Smatthieu #define CHANGED_CURCMAP		0x0001	/* cursor cmap */
97e00d3f43Smatthieu #define CHANGED_CMAP		0x0002	/* color map */
98e00d3f43Smatthieu #define CHANGED_WTYPE		0x0004	/* window types */
99e00d3f43Smatthieu #define CHANGED_DOTCLOCK	0x0008	/* dot clock */
100e00d3f43Smatthieu #define CHANGED_ALL		0x000f	/* or of all above */
101e00d3f43Smatthieu 	u_int8_t	changed;
102e00d3f43Smatthieu 
103e00d3f43Smatthieu 	/* dotclock parameters */
104e00d3f43Smatthieu 	u_int8_t	vco_div;
105e00d3f43Smatthieu 	u_int8_t	pll_ref;
106e00d3f43Smatthieu 	u_int8_t	div_dotclock;
107e00d3f43Smatthieu 
108e00d3f43Smatthieu 	/* colormaps et al. */
109e00d3f43Smatthieu 	u_int8_t	curcmap_r[2];
110e00d3f43Smatthieu 	u_int8_t	curcmap_g[2];
111e00d3f43Smatthieu 	u_int8_t	curcmap_b[2];
112e00d3f43Smatthieu 
113e00d3f43Smatthieu 	u_int8_t	cmap_r[IBM561_NCMAP_ENTRIES];
114e00d3f43Smatthieu 	u_int8_t	cmap_g[IBM561_NCMAP_ENTRIES];
115e00d3f43Smatthieu 	u_int8_t	cmap_b[IBM561_NCMAP_ENTRIES];
116e00d3f43Smatthieu 
117e00d3f43Smatthieu 	u_int16_t	gamma_r[IBM561_NGAMMA_ENTRIES];
118e00d3f43Smatthieu 	u_int16_t	gamma_g[IBM561_NGAMMA_ENTRIES];
119e00d3f43Smatthieu 	u_int16_t	gamma_b[IBM561_NGAMMA_ENTRIES];
120e00d3f43Smatthieu 
121e00d3f43Smatthieu 	u_int16_t	wtype[IBM561_NWTYPES];
122e00d3f43Smatthieu };
123e00d3f43Smatthieu 
124e00d3f43Smatthieu /*
125e00d3f43Smatthieu  * private functions
126e00d3f43Smatthieu  */
127e00d3f43Smatthieu void	ibm561_update(void *);
128e00d3f43Smatthieu static void ibm561_load_cmap(struct ibm561data *);
129e00d3f43Smatthieu static void ibm561_load_dotclock(struct ibm561data *);
130e00d3f43Smatthieu static void ibm561_regbegin(struct ibm561data *, u_int16_t);
131e00d3f43Smatthieu static void ibm561_regcont(struct ibm561data *, u_int16_t, u_int8_t);
132e00d3f43Smatthieu static void ibm561_regcont10bit(struct ibm561data *, u_int16_t, u_int16_t);
133e00d3f43Smatthieu static void ibm561_regwr(struct ibm561data *, u_int16_t, u_int8_t);
134e00d3f43Smatthieu 
135e00d3f43Smatthieu struct ramdac_funcs *
ibm561_funcs(void)136e00d3f43Smatthieu ibm561_funcs(void)
137e00d3f43Smatthieu {
138e00d3f43Smatthieu 	return &ibm561_funcsstruct;
139e00d3f43Smatthieu }
140e00d3f43Smatthieu 
1412d8e2195Smiod struct ibm561data ibm561_console_data;
1422d8e2195Smiod 
143e00d3f43Smatthieu struct ramdac_cookie *
ibm561_register(v,sched_update,wr,rd)144e00d3f43Smatthieu ibm561_register(v, sched_update, wr, rd)
145e00d3f43Smatthieu 	void *v;
146e00d3f43Smatthieu 	int (*sched_update)(void *, void (*)(void *));
147e00d3f43Smatthieu 	void (*wr)(void *, u_int, u_int8_t);
148e00d3f43Smatthieu 	u_int8_t (*rd)(void *, u_int);
149e00d3f43Smatthieu {
150e00d3f43Smatthieu 	struct ibm561data *data;
151e00d3f43Smatthieu 
152745a6159Smiod 	if (ibm561_console_data.cookie == NULL)
153745a6159Smiod 		data = malloc(sizeof *data, M_DEVBUF, M_WAITOK | M_ZERO);
154745a6159Smiod 	else
1552d8e2195Smiod 		data = &ibm561_console_data;
156e00d3f43Smatthieu 	data->cookie = v;
157e00d3f43Smatthieu 	data->ramdac_sched_update = sched_update;
158e00d3f43Smatthieu 	data->ramdac_wr = wr;
159e00d3f43Smatthieu 	data->ramdac_rd = rd;
160e00d3f43Smatthieu 	return (struct ramdac_cookie *)data;
161e00d3f43Smatthieu }
162e00d3f43Smatthieu 
163e00d3f43Smatthieu /*
164e00d3f43Smatthieu  * This function exists solely to provide a means to init
165e00d3f43Smatthieu  * the RAMDAC without first registering.  It is useful for
166e00d3f43Smatthieu  * initializing the console early on.
167e00d3f43Smatthieu  */
168e00d3f43Smatthieu 
169e00d3f43Smatthieu void
ibm561_cninit(v,sched_update,wr,rd,dotclock)170e00d3f43Smatthieu ibm561_cninit(v, sched_update, wr, rd, dotclock)
171e00d3f43Smatthieu 	void *v;
172e00d3f43Smatthieu 	int (*sched_update)(void *, void (*)(void *));
173e00d3f43Smatthieu 	void (*wr)(void *, u_int, u_int8_t);
174e00d3f43Smatthieu 	u_int8_t (*rd)(void *, u_int);
175e00d3f43Smatthieu 	u_int dotclock;
176e00d3f43Smatthieu {
1772d8e2195Smiod 	struct ibm561data *data = &ibm561_console_data;
178e00d3f43Smatthieu 	data->cookie = v;
179e00d3f43Smatthieu 	data->ramdac_sched_update = sched_update;
180e00d3f43Smatthieu 	data->ramdac_wr = wr;
181e00d3f43Smatthieu 	data->ramdac_rd = rd;
182e00d3f43Smatthieu 	ibm561_set_dotclock((struct ramdac_cookie *)data, dotclock);
183e00d3f43Smatthieu 	ibm561_init((struct ramdac_cookie *)data);
184e00d3f43Smatthieu }
185e00d3f43Smatthieu 
186e00d3f43Smatthieu void
ibm561_init(rc)187e00d3f43Smatthieu ibm561_init(rc)
188e00d3f43Smatthieu 	struct ramdac_cookie *rc;
189e00d3f43Smatthieu {
190e00d3f43Smatthieu 	struct	ibm561data *data = (struct ibm561data *)rc;
191e00d3f43Smatthieu 	int	i;
192e00d3f43Smatthieu 
193e00d3f43Smatthieu 	/* XXX this is _essential_ */
194e00d3f43Smatthieu 
195e00d3f43Smatthieu 	ibm561_load_dotclock(data);
196e00d3f43Smatthieu 
197e00d3f43Smatthieu 	/* XXXrcd: bunch of magic of which I have no current clue */
198e00d3f43Smatthieu 	ibm561_regwr(data, IBM561_CONFIG_REG1, 0x2a);
199e00d3f43Smatthieu 	ibm561_regwr(data, IBM561_CONFIG_REG3, 0x41);
200e00d3f43Smatthieu 	ibm561_regwr(data, IBM561_CONFIG_REG4, 0x20);
201e00d3f43Smatthieu 
202e00d3f43Smatthieu 	/* initialize the card a bit */
203e00d3f43Smatthieu 	ibm561_regwr(data, IBM561_SYNC_CNTL, 0x1);
204e00d3f43Smatthieu 	ibm561_regwr(data, IBM561_CONFIG_REG2, 0x19);
205e00d3f43Smatthieu 
206e00d3f43Smatthieu 	ibm561_regwr(data, IBM561_CONFIG_REG1, 0x2a);
207e00d3f43Smatthieu 	ibm561_regwr(data, IBM561_CONFIG_REG4, 0x20);
208e00d3f43Smatthieu 
209e00d3f43Smatthieu 	ibm561_regbegin(data, IBM561_WAT_SEG_REG);
210e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, 0x00);
211e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, 0x00);
212e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, 0x00);
213e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, 0x00);
214e00d3f43Smatthieu 	ibm561_regbegin(data, IBM561_CHROMAKEY0);
215e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, 0x00);
216e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, 0x00);
217e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, 0x00);
218e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, 0x00);
219e00d3f43Smatthieu 
220e00d3f43Smatthieu 	ibm561_regwr(data, IBM561_CURS_CNTL_REG, 0x00); /* XXX off? */
221e00d3f43Smatthieu 
222e00d3f43Smatthieu 	/* cursor `hot spot' registers */
223e00d3f43Smatthieu 	ibm561_regbegin(data, IBM561_HOTSPOT_REG);
224e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, 0x00);
225e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, 0x00);
226e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, 0xff);
227e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, 0x00);
228e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, 0xff);
229e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, 0x00);
230e00d3f43Smatthieu 
231e00d3f43Smatthieu 	/* VRAM Mask Registers (diagnostics) */
232e00d3f43Smatthieu 	ibm561_regbegin(data, IBM561_VRAM_MASK_REG);
233e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, 0xff);
234e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, 0xff);
235e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, 0xff);
236e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, 0xff);
237e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, 0xff);
238e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, 0xff);
239e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, 0xff);
240e00d3f43Smatthieu 
241e00d3f43Smatthieu 	/* let's set up some decent default colour maps and gammas */
242e00d3f43Smatthieu 	for (i=0; i < IBM561_NCMAP_ENTRIES; i++)
243e00d3f43Smatthieu 		data->cmap_r[i] = data->cmap_g[i] = data->cmap_b[i] = 0xff;
244e00d3f43Smatthieu 	data->cmap_r[0]   = data->cmap_g[0]   = data->cmap_b[0]   = 0x00;
245e00d3f43Smatthieu 	data->cmap_r[256] = data->cmap_g[256] = data->cmap_b[256] = 0x00;
246e00d3f43Smatthieu 	data->cmap_r[512] = data->cmap_g[512] = data->cmap_b[512] = 0x00;
247e00d3f43Smatthieu 	data->cmap_r[768] = data->cmap_g[768] = data->cmap_b[768] = 0x00;
248e00d3f43Smatthieu 
249e00d3f43Smatthieu 	data->gamma_r[0] = data->gamma_g[0] = data->gamma_b[0] = 0x00;
250e00d3f43Smatthieu 	for (i=0; i < IBM561_NGAMMA_ENTRIES; i++)
251e00d3f43Smatthieu 		data->gamma_r[i] = data->gamma_g[i] = data->gamma_b[i] = 0xff;
252e00d3f43Smatthieu 
253e00d3f43Smatthieu 	for (i=0; i < IBM561_NWTYPES; i++)
254e00d3f43Smatthieu 		data->wtype[i] = 0x0036;
255e00d3f43Smatthieu 	data->wtype[1] = 0x0028;
256e00d3f43Smatthieu 
257e00d3f43Smatthieu 	/* the last step: */
258e00d3f43Smatthieu 	data->changed = CHANGED_ALL;
259e00d3f43Smatthieu 	data->ramdac_sched_update(data->cookie, ibm561_update);
260e00d3f43Smatthieu }
261e00d3f43Smatthieu 
262e00d3f43Smatthieu int
ibm561_set_cmap(rc,cmapp)263e00d3f43Smatthieu ibm561_set_cmap(rc, cmapp)
264e00d3f43Smatthieu 	struct ramdac_cookie *rc;
265e00d3f43Smatthieu 	struct wsdisplay_cmap *cmapp;
266e00d3f43Smatthieu {
267e00d3f43Smatthieu 	struct ibm561data *data = (struct ibm561data *)rc;
268773f5b9dSmillert 	u_int count, index;
26947844783Smiod 	int error;
270e00d3f43Smatthieu 	int s;
271e00d3f43Smatthieu 
272e00d3f43Smatthieu 	index = cmapp->index;
273e00d3f43Smatthieu 	count = cmapp->count;
27447844783Smiod 
27547844783Smiod 	if (index >= IBM561_NCMAP_ENTRIES ||
27647844783Smiod 	    count > IBM561_NCMAP_ENTRIES - index)
27747844783Smiod 		return (EINVAL);
27847844783Smiod 
27947844783Smiod 	s = spltty();
28047844783Smiod 	if ((error = copyin(cmapp->red, &data->cmap_r[index], count)) != 0) {
28147844783Smiod 		splx(s);
28247844783Smiod 		return (error);
28347844783Smiod 	}
28447844783Smiod 	if ((error = copyin(cmapp->green, &data->cmap_g[index], count)) != 0) {
28547844783Smiod 		splx(s);
28647844783Smiod 		return (error);
28747844783Smiod 	}
28847844783Smiod 	if ((error = copyin(cmapp->blue, &data->cmap_b[index], count)) != 0) {
28947844783Smiod 		splx(s);
29047844783Smiod 		return (error);
29147844783Smiod 	}
292e00d3f43Smatthieu 	data->changed |= CHANGED_CMAP;
293e00d3f43Smatthieu 	data->ramdac_sched_update(data->cookie, ibm561_update);
294e00d3f43Smatthieu 	splx(s);
295e00d3f43Smatthieu 	return (0);
296e00d3f43Smatthieu }
297e00d3f43Smatthieu 
298e00d3f43Smatthieu int
ibm561_get_cmap(rc,cmapp)299e00d3f43Smatthieu ibm561_get_cmap(rc, cmapp)
300e00d3f43Smatthieu 	struct ramdac_cookie *rc;
301e00d3f43Smatthieu 	struct wsdisplay_cmap *cmapp;
302e00d3f43Smatthieu {
303e00d3f43Smatthieu 	struct ibm561data *data = (struct ibm561data *)rc;
304773f5b9dSmillert 	u_int count, index;
305e00d3f43Smatthieu 	int error;
306e00d3f43Smatthieu 
307773f5b9dSmillert 	if (cmapp->index >= IBM561_NCMAP_ENTRIES ||
308773f5b9dSmillert 	    cmapp->count > IBM561_NCMAP_ENTRIES - cmapp->index)
309e00d3f43Smatthieu 		return (EINVAL);
310e00d3f43Smatthieu 	count = cmapp->count;
311e00d3f43Smatthieu 	index = cmapp->index;
312e00d3f43Smatthieu 	error = copyout(&data->cmap_r[index], cmapp->red, count);
313e00d3f43Smatthieu 	if (error)
314e00d3f43Smatthieu 		return (error);
315e00d3f43Smatthieu 	error = copyout(&data->cmap_g[index], cmapp->green, count);
316e00d3f43Smatthieu 	if (error)
317e00d3f43Smatthieu 		return (error);
318e00d3f43Smatthieu 	error = copyout(&data->cmap_b[index], cmapp->blue, count);
319e00d3f43Smatthieu 	return (error);
320e00d3f43Smatthieu }
321e00d3f43Smatthieu 
322e00d3f43Smatthieu /*
323e00d3f43Smatthieu  * XXX:
324e00d3f43Smatthieu  *  I am leaving these functions returning EINVAL, as they are
325e00d3f43Smatthieu  *  not strictly necessary for the correct functioning of the
326e00d3f43Smatthieu  *  card and in fact are not used on the other TGA variants, except
327e00d3f43Smatthieu  *  they are exported via ioctl(2) to userland, which does not in
328e00d3f43Smatthieu  *  fact use them.
329e00d3f43Smatthieu  */
330e00d3f43Smatthieu 
331e00d3f43Smatthieu int
ibm561_set_cursor(rc,cursorp)332e00d3f43Smatthieu ibm561_set_cursor(rc, cursorp)
333e00d3f43Smatthieu 	struct ramdac_cookie *rc;
334e00d3f43Smatthieu 	struct wsdisplay_cursor *cursorp;
335e00d3f43Smatthieu {
336e00d3f43Smatthieu 	return EINVAL;
337e00d3f43Smatthieu }
338e00d3f43Smatthieu 
339e00d3f43Smatthieu int
ibm561_get_cursor(rc,cursorp)340e00d3f43Smatthieu ibm561_get_cursor(rc, cursorp)
341e00d3f43Smatthieu 	struct ramdac_cookie *rc;
342e00d3f43Smatthieu 	struct wsdisplay_cursor *cursorp;
343e00d3f43Smatthieu {
344e00d3f43Smatthieu 	return EINVAL;
345e00d3f43Smatthieu }
346e00d3f43Smatthieu 
347e00d3f43Smatthieu int
ibm561_set_curpos(rc,curposp)348e00d3f43Smatthieu ibm561_set_curpos(rc, curposp)
349e00d3f43Smatthieu 	struct ramdac_cookie *rc;
350e00d3f43Smatthieu 	struct wsdisplay_curpos *curposp;
351e00d3f43Smatthieu {
352e00d3f43Smatthieu 	return EINVAL;
353e00d3f43Smatthieu }
354e00d3f43Smatthieu 
355e00d3f43Smatthieu int
ibm561_get_curpos(rc,curposp)356e00d3f43Smatthieu ibm561_get_curpos(rc, curposp)
357e00d3f43Smatthieu 	struct ramdac_cookie *rc;
358e00d3f43Smatthieu 	struct wsdisplay_curpos *curposp;
359e00d3f43Smatthieu {
360e00d3f43Smatthieu 	return EINVAL;
361e00d3f43Smatthieu }
362e00d3f43Smatthieu 
363e00d3f43Smatthieu int
ibm561_get_curmax(rc,curposp)364e00d3f43Smatthieu ibm561_get_curmax(rc, curposp)
365e00d3f43Smatthieu 	struct ramdac_cookie *rc;
366e00d3f43Smatthieu 	struct wsdisplay_curpos *curposp;
367e00d3f43Smatthieu {
368e00d3f43Smatthieu 	return EINVAL;
369e00d3f43Smatthieu }
370e00d3f43Smatthieu 
371e00d3f43Smatthieu int
ibm561_set_dotclock(rc,dotclock)372e00d3f43Smatthieu ibm561_set_dotclock(rc, dotclock)
373e00d3f43Smatthieu 	struct ramdac_cookie *rc;
374e00d3f43Smatthieu 	unsigned dotclock;
375e00d3f43Smatthieu {
376e00d3f43Smatthieu 	struct ibm561data *data = (struct ibm561data *)rc;
377e00d3f43Smatthieu 
378e00d3f43Smatthieu 	/* XXXrcd:  a couple of these are a little hazy, vis a vis
379e00d3f43Smatthieu 	 *          check 175MHz and 202MHz, which are wrong...
380e00d3f43Smatthieu 	 */
381e00d3f43Smatthieu 	switch (dotclock) {
382e00d3f43Smatthieu 	case  25175000: data->vco_div = 0x3e; data->pll_ref = 0x09; break;
383e00d3f43Smatthieu 	case  31500000: data->vco_div = 0x17; data->pll_ref = 0x05; break;
384e00d3f43Smatthieu 	case  40000000: data->vco_div = 0x42; data->pll_ref = 0x06; break;
385e00d3f43Smatthieu 	case  50000000: data->vco_div = 0x45; data->pll_ref = 0x05; break;
386e00d3f43Smatthieu 	case  65000000: data->vco_div = 0xac; data->pll_ref = 0x0c; break;
387e00d3f43Smatthieu 	case  69000000: data->vco_div = 0xa9; data->pll_ref = 0x0b; break;
388e00d3f43Smatthieu 	case  74000000: data->vco_div = 0x9c; data->pll_ref = 0x09; break;
389e00d3f43Smatthieu 	case  75000000: data->vco_div = 0x93; data->pll_ref = 0x08; break;
390e00d3f43Smatthieu 	case 103994000: data->vco_div = 0x96; data->pll_ref = 0x06; break;
391e00d3f43Smatthieu 	case 108180000: data->vco_div = 0xb8; data->pll_ref = 0x08; break;
392e00d3f43Smatthieu 	case 110000000: data->vco_div = 0xba; data->pll_ref = 0x08; break;
393e00d3f43Smatthieu 	case 119840000: data->vco_div = 0x82; data->pll_ref = 0x04; break;
394e00d3f43Smatthieu 	case 130808000: data->vco_div = 0xc8; data->pll_ref = 0x08; break;
395e00d3f43Smatthieu 	case 135000000: data->vco_div = 0xc1; data->pll_ref = 0x07; break;
396e00d3f43Smatthieu 	case 175000000: data->vco_div = 0xe2; data->pll_ref = 0x07; break;
397e00d3f43Smatthieu 	case 202500000: data->vco_div = 0xe2; data->pll_ref = 0x07; break;
398e00d3f43Smatthieu 	default:
399e00d3f43Smatthieu 		return EINVAL;
400e00d3f43Smatthieu 	}
401e00d3f43Smatthieu 
402e00d3f43Smatthieu 	data->div_dotclock = 0xb0;
403e00d3f43Smatthieu 	data->changed |= CHANGED_DOTCLOCK;
404e00d3f43Smatthieu 	return 0;
405e00d3f43Smatthieu }
406e00d3f43Smatthieu 
407e00d3f43Smatthieu /*
408e00d3f43Smatthieu  * Internal Functions
409e00d3f43Smatthieu  */
410e00d3f43Smatthieu 
411e00d3f43Smatthieu void
ibm561_update(vp)412e00d3f43Smatthieu ibm561_update(vp)
413e00d3f43Smatthieu 	void *vp;
414e00d3f43Smatthieu {
415e00d3f43Smatthieu 	struct ibm561data *data = (struct ibm561data *)vp;
416e00d3f43Smatthieu 	int	i;
417e00d3f43Smatthieu 
418e00d3f43Smatthieu 	/* XXX see comment above ibm561_cninit() */
419e00d3f43Smatthieu 	if (!data)
4202d8e2195Smiod 		data = &ibm561_console_data;
421e00d3f43Smatthieu 
422e00d3f43Smatthieu 	if (data->changed & CHANGED_WTYPE) {
423e00d3f43Smatthieu 		ibm561_regbegin(data, IBM561_FB_WINTYPE);
424e00d3f43Smatthieu 		for (i=0; i < IBM561_NWTYPES; i++)
425e00d3f43Smatthieu 			ibm561_regcont10bit(data, IBM561_CMD_FB_WAT, data->wtype[i]);
426e00d3f43Smatthieu 
427e00d3f43Smatthieu 		/* XXXrcd:  quick hack here for AUX FB table */
428e00d3f43Smatthieu 		ibm561_regbegin(data, IBM561_AUXFB_WINTYPE);
429e00d3f43Smatthieu 		for (i=0; i < IBM561_NWTYPES; i++)
430e00d3f43Smatthieu 			ibm561_regcont(data, IBM561_CMD, 0x04);
431e00d3f43Smatthieu 
432e00d3f43Smatthieu 		/* XXXrcd:  quick hack here for OL WAT table */
433e00d3f43Smatthieu 		ibm561_regbegin(data, IBM561_OL_WINTYPE);
434e00d3f43Smatthieu 		for (i=0; i < IBM561_NWTYPES; i++)
435e00d3f43Smatthieu 			ibm561_regcont10bit(data, IBM561_CMD_FB_WAT, 0x0231);
436e00d3f43Smatthieu 
437e00d3f43Smatthieu 		/* XXXrcd:  quick hack here for AUX OL WAT table */
438e00d3f43Smatthieu 		ibm561_regbegin(data, IBM561_AUXOL_WINTYPE);
439e00d3f43Smatthieu 		for (i=0; i < IBM561_NWTYPES; i++)
440e00d3f43Smatthieu 			ibm561_regcont(data, IBM561_CMD, 0x0c);
441e00d3f43Smatthieu 	}
442e00d3f43Smatthieu 
443e00d3f43Smatthieu 	if (data->changed & CHANGED_CMAP)
444e00d3f43Smatthieu 		ibm561_load_cmap(data);
445e00d3f43Smatthieu 
446e00d3f43Smatthieu 	/* XXX:  I am not sure in what situations it is safe to
447e00d3f43Smatthieu 	 *       change the dotclock---hope this is good.
448e00d3f43Smatthieu 	 */
449e00d3f43Smatthieu 	if (data->changed & CHANGED_DOTCLOCK)
450e00d3f43Smatthieu 		ibm561_load_dotclock(data);
451e00d3f43Smatthieu }
452e00d3f43Smatthieu 
453e00d3f43Smatthieu static void
ibm561_load_cmap(struct ibm561data * data)454e00d3f43Smatthieu ibm561_load_cmap(struct ibm561data *data)
455e00d3f43Smatthieu {
456e00d3f43Smatthieu 	int	i;
457e00d3f43Smatthieu 
458e00d3f43Smatthieu 	ibm561_regbegin(data, IBM561_CMAP_TABLE);
459e00d3f43Smatthieu 	for (i=0; i < IBM561_NCMAP_ENTRIES; i++) {
460e00d3f43Smatthieu 		ibm561_regcont(data, IBM561_CMD_CMAP, data->cmap_r[i]);
461e00d3f43Smatthieu 		ibm561_regcont(data, IBM561_CMD_CMAP, data->cmap_g[i]);
462e00d3f43Smatthieu 		ibm561_regcont(data, IBM561_CMD_CMAP, data->cmap_b[i]);
463e00d3f43Smatthieu 	}
464e00d3f43Smatthieu 
465e00d3f43Smatthieu 	ibm561_regbegin(data, IBM561_RED_GAMMA_TABLE);
466e00d3f43Smatthieu 	for (i=0; i < 256; i++)
467e00d3f43Smatthieu 		ibm561_regcont10bit(data, IBM561_CMD_GAMMA, data->gamma_r[i]);
468e00d3f43Smatthieu 
469e00d3f43Smatthieu 	ibm561_regbegin(data, IBM561_GREEN_GAMMA_TABLE);
470e00d3f43Smatthieu 	for (i=1; i < 256; i++)
471e00d3f43Smatthieu 		ibm561_regcont10bit(data, IBM561_CMD_GAMMA, data->gamma_g[i]);
472e00d3f43Smatthieu 
473e00d3f43Smatthieu 	ibm561_regbegin(data, IBM561_BLUE_GAMMA_TABLE);
474e00d3f43Smatthieu 	for (i=1; i < 256; i++)
475e00d3f43Smatthieu 		ibm561_regcont10bit(data, IBM561_CMD_GAMMA, data->gamma_b[i]);
476e00d3f43Smatthieu 
477e00d3f43Smatthieu }
478e00d3f43Smatthieu 
479e00d3f43Smatthieu static void
ibm561_load_dotclock(struct ibm561data * data)480e00d3f43Smatthieu ibm561_load_dotclock(struct ibm561data *data)
481e00d3f43Smatthieu {
482e00d3f43Smatthieu 	/* XXX
483e00d3f43Smatthieu 	 * we should probably be more pro-active here, but it shouldn't
484e00d3f43Smatthieu 	 * actually happen...
485e00d3f43Smatthieu 	 */
486e00d3f43Smatthieu 	if (!data->vco_div || !data->pll_ref || ! data->div_dotclock) {
487e00d3f43Smatthieu 		panic("ibm561_load_dotclock: called uninitialized");
488e00d3f43Smatthieu 	}
489e00d3f43Smatthieu 
490e00d3f43Smatthieu 	ibm561_regwr(data, IBM561_PLL_VCO_DIV,  data->vco_div);
491e00d3f43Smatthieu 	ibm561_regwr(data, IBM561_PLL_REF_REG, data->pll_ref);
492e00d3f43Smatthieu 	ibm561_regwr(data, IBM561_DIV_DOTCLCK, data->div_dotclock);
493e00d3f43Smatthieu }
494e00d3f43Smatthieu 
495e00d3f43Smatthieu static void
ibm561_regcont10bit(struct ibm561data * data,u_int16_t reg,u_int16_t val)496e00d3f43Smatthieu ibm561_regcont10bit(struct ibm561data *data, u_int16_t reg, u_int16_t val)
497e00d3f43Smatthieu {
498e00d3f43Smatthieu 	data->ramdac_wr(data->cookie, IBM561_CMD_GAMMA, (val >> 2) & 0xff);
499e00d3f43Smatthieu 	data->ramdac_wr(data->cookie, IBM561_CMD_GAMMA, (val & 0x3) << 6);
500e00d3f43Smatthieu }
501e00d3f43Smatthieu 
502e00d3f43Smatthieu static void
ibm561_regbegin(struct ibm561data * data,u_int16_t reg)503e00d3f43Smatthieu ibm561_regbegin(struct ibm561data *data, u_int16_t reg)
504e00d3f43Smatthieu {
505e00d3f43Smatthieu 	data->ramdac_wr(data->cookie, IBM561_ADDR_LOW, reg & 0xff);
506e00d3f43Smatthieu 	data->ramdac_wr(data->cookie, IBM561_ADDR_HIGH, (reg >> 8) & 0xff);
507e00d3f43Smatthieu }
508e00d3f43Smatthieu 
509e00d3f43Smatthieu static void
ibm561_regcont(struct ibm561data * data,u_int16_t reg,u_int8_t val)510e00d3f43Smatthieu ibm561_regcont(struct ibm561data *data, u_int16_t reg, u_int8_t val)
511e00d3f43Smatthieu {
512e00d3f43Smatthieu 	data->ramdac_wr(data->cookie, reg, val);
513e00d3f43Smatthieu }
514e00d3f43Smatthieu 
515e00d3f43Smatthieu static void
ibm561_regwr(struct ibm561data * data,u_int16_t reg,u_int8_t val)516e00d3f43Smatthieu ibm561_regwr(struct ibm561data *data, u_int16_t reg, u_int8_t val)
517e00d3f43Smatthieu {
518e00d3f43Smatthieu 	ibm561_regbegin(data, reg);
519e00d3f43Smatthieu 	ibm561_regcont(data, IBM561_CMD, val);
520e00d3f43Smatthieu }
521