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