Home | History | Annotate | Line # | Download | only in ic
ibm561.c revision 1.10.12.1
      1  1.10.12.1      mrg /* $NetBSD: ibm561.c,v 1.10.12.1 2012/02/18 07:34:19 mrg 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.10.12.1      mrg __KERNEL_RCSID(0, "$NetBSD: ibm561.c,v 1.10.12.1 2012/02/18 07:34:19 mrg 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.1    elric #include <sys/malloc.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.10.12.1      mrg ibm561_register(
    137  1.10.12.1      mrg 	void *v,
    138  1.10.12.1      mrg 	int (*sched_update)(void *, void (*)(void *)),
    139  1.10.12.1      mrg 	void (*wr)(void *, u_int, u_int8_t),
    140  1.10.12.1      mrg 	u_int8_t (*rd)(void *, u_int))
    141        1.1    elric {
    142        1.1    elric 	struct ibm561data *data;
    143        1.1    elric 
    144        1.2  tsutsui 	data = malloc(sizeof *data, M_DEVBUF, M_WAITOK|M_ZERO);
    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.1    elric struct ibm561data *saved_console_data;
    159        1.1    elric 
    160        1.1    elric void
    161  1.10.12.1      mrg ibm561_cninit(
    162  1.10.12.1      mrg 	void *v,
    163  1.10.12.1      mrg 	int (*sched_update)(void *, void (*)(void *)),
    164  1.10.12.1      mrg 	void (*wr)(void *, u_int, u_int8_t),
    165  1.10.12.1      mrg 	u_int8_t (*rd)(void *, u_int),
    166  1.10.12.1      mrg 	u_int dotclock)
    167        1.1    elric {
    168        1.1    elric 	struct ibm561data tmp, *data = &tmp;
    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 	saved_console_data = data;
    176        1.1    elric 	ibm561_init((struct ramdac_cookie *)data);
    177        1.1    elric 	saved_console_data = NULL;
    178        1.1    elric }
    179        1.1    elric 
    180        1.1    elric void
    181        1.9      dsl ibm561_init(struct ramdac_cookie *rc)
    182        1.1    elric {
    183        1.1    elric 	struct	ibm561data *data = (struct ibm561data *)rc;
    184        1.1    elric 	int	i;
    185        1.1    elric 
    186        1.1    elric 	/* XXX this is _essential_ */
    187        1.1    elric 
    188        1.1    elric 	ibm561_load_dotclock(data);
    189        1.1    elric 
    190        1.1    elric 	/* XXXrcd: bunch of magic of which I have no current clue */
    191        1.1    elric 	ibm561_regwr(data, IBM561_CONFIG_REG1, 0x2a);
    192        1.1    elric 	ibm561_regwr(data, IBM561_CONFIG_REG3, 0x41);
    193        1.1    elric 	ibm561_regwr(data, IBM561_CONFIG_REG4, 0x20);
    194        1.1    elric 
    195        1.1    elric 	/* initialize the card a bit */
    196        1.1    elric 	ibm561_regwr(data, IBM561_SYNC_CNTL, 0x1);
    197        1.1    elric 	ibm561_regwr(data, IBM561_CONFIG_REG2, 0x19);
    198        1.1    elric 
    199        1.1    elric 	ibm561_regwr(data, IBM561_CONFIG_REG1, 0x2a);
    200        1.1    elric 	ibm561_regwr(data, IBM561_CONFIG_REG4, 0x20);
    201        1.1    elric 
    202        1.1    elric 	ibm561_regbegin(data, IBM561_WAT_SEG_REG);
    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_regcont(data, IBM561_CMD, 0x00);
    206        1.1    elric 	ibm561_regcont(data, IBM561_CMD, 0x00);
    207        1.1    elric 	ibm561_regbegin(data, IBM561_CHROMAKEY0);
    208        1.1    elric 	ibm561_regcont(data, IBM561_CMD, 0x00);
    209        1.1    elric 	ibm561_regcont(data, IBM561_CMD, 0x00);
    210        1.1    elric 	ibm561_regcont(data, IBM561_CMD, 0x00);
    211        1.1    elric 	ibm561_regcont(data, IBM561_CMD, 0x00);
    212        1.1    elric 
    213        1.1    elric 	ibm561_regwr(data, IBM561_CURS_CNTL_REG, 0x00); /* XXX off? */
    214        1.1    elric 
    215        1.1    elric 	/* cursor `hot spot' registers */
    216        1.1    elric 	ibm561_regbegin(data, IBM561_HOTSPOT_REG);
    217        1.1    elric 	ibm561_regcont(data, IBM561_CMD, 0x00);
    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 	ibm561_regcont(data, IBM561_CMD, 0xff);
    222        1.1    elric 	ibm561_regcont(data, IBM561_CMD, 0x00);
    223        1.1    elric 
    224        1.1    elric 	/* VRAM Mask Registers (diagnostics) */
    225        1.1    elric 	ibm561_regbegin(data, IBM561_VRAM_MASK_REG);
    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 	ibm561_regcont(data, IBM561_CMD, 0xff);
    232        1.1    elric 	ibm561_regcont(data, IBM561_CMD, 0xff);
    233        1.1    elric 
    234        1.1    elric 	/* let's set up some decent default colour maps and gammas */
    235        1.1    elric 	for (i=0; i < IBM561_NCMAP_ENTRIES; i++)
    236        1.1    elric 		data->cmap_r[i] = data->cmap_g[i] = data->cmap_b[i] = 0xff;
    237        1.1    elric 	data->cmap_r[0]   = data->cmap_g[0]   = data->cmap_b[0]   = 0x00;
    238        1.1    elric 	data->cmap_r[256] = data->cmap_g[256] = data->cmap_b[256] = 0x00;
    239        1.1    elric 	data->cmap_r[512] = data->cmap_g[512] = data->cmap_b[512] = 0x00;
    240        1.1    elric 	data->cmap_r[768] = data->cmap_g[768] = data->cmap_b[768] = 0x00;
    241        1.1    elric 
    242        1.1    elric 	data->gamma_r[0] = data->gamma_g[0] = data->gamma_b[0] = 0x00;
    243        1.1    elric 	for (i=0; i < IBM561_NGAMMA_ENTRIES; i++)
    244        1.1    elric 		data->gamma_r[i] = data->gamma_g[i] = data->gamma_b[i] = 0xff;
    245        1.1    elric 
    246        1.1    elric 	for (i=0; i < IBM561_NWTYPES; i++)
    247        1.1    elric 		data->wtype[i] = 0x0036;
    248        1.1    elric 	data->wtype[1] = 0x0028;
    249        1.1    elric 
    250        1.1    elric 	/* the last step: */
    251        1.1    elric 	data->changed = CHANGED_ALL;
    252        1.1    elric 	data->ramdac_sched_update(data->cookie, ibm561_update);
    253        1.1    elric }
    254        1.1    elric 
    255        1.1    elric int
    256        1.9      dsl ibm561_set_cmap(struct ramdac_cookie *rc, struct wsdisplay_cmap *cmapp)
    257        1.1    elric {
    258        1.1    elric 	struct ibm561data *data = (struct ibm561data *)rc;
    259        1.3   itojun 	u_int count, index;
    260        1.5      chs 	uint8_t r[IBM561_NCMAP_ENTRIES];
    261        1.5      chs 	uint8_t g[IBM561_NCMAP_ENTRIES];
    262        1.5      chs 	uint8_t b[IBM561_NCMAP_ENTRIES];
    263        1.5      chs 	int s, error;
    264        1.1    elric 
    265        1.3   itojun 	if (cmapp->index >= IBM561_NCMAP_ENTRIES ||
    266        1.3   itojun 	    cmapp->count > IBM561_NCMAP_ENTRIES - cmapp->index)
    267        1.1    elric 		return (EINVAL);
    268        1.1    elric 
    269        1.1    elric 	index = cmapp->index;
    270        1.1    elric 	count = cmapp->count;
    271        1.5      chs 	error = copyin(cmapp->red, &r[index], count);
    272        1.5      chs 	if (error)
    273        1.5      chs 		return error;
    274        1.5      chs 	error = copyin(cmapp->green, &g[index], count);
    275        1.5      chs 	if (error)
    276        1.5      chs 		return error;
    277        1.5      chs 	error = copyin(cmapp->blue, &b[index], count);
    278        1.5      chs 	if (error)
    279        1.5      chs 		return error;
    280        1.5      chs 	s = spltty();
    281        1.5      chs 	memcpy(&data->cmap_r[index], &r[index], count);
    282        1.5      chs 	memcpy(&data->cmap_g[index], &g[index], count);
    283        1.5      chs 	memcpy(&data->cmap_b[index], &b[index], count);
    284        1.1    elric 	data->changed |= CHANGED_CMAP;
    285        1.1    elric 	data->ramdac_sched_update(data->cookie, ibm561_update);
    286        1.1    elric 	splx(s);
    287        1.1    elric 	return (0);
    288        1.1    elric }
    289        1.1    elric 
    290        1.1    elric int
    291        1.9      dsl ibm561_get_cmap(struct ramdac_cookie *rc, struct wsdisplay_cmap *cmapp)
    292        1.1    elric {
    293        1.1    elric 	struct ibm561data *data = (struct ibm561data *)rc;
    294        1.3   itojun 	u_int count, index;
    295        1.1    elric 	int error;
    296        1.1    elric 
    297        1.3   itojun 	if (cmapp->index >= IBM561_NCMAP_ENTRIES ||
    298        1.3   itojun 	    cmapp->count > IBM561_NCMAP_ENTRIES - cmapp->index)
    299        1.1    elric 		return (EINVAL);
    300        1.1    elric 	count = cmapp->count;
    301        1.1    elric 	index = cmapp->index;
    302        1.1    elric 	error = copyout(&data->cmap_r[index], cmapp->red, count);
    303        1.1    elric 	if (error)
    304        1.1    elric 		return (error);
    305        1.1    elric 	error = copyout(&data->cmap_g[index], cmapp->green, count);
    306        1.1    elric 	if (error)
    307        1.1    elric 		return (error);
    308        1.1    elric 	error = copyout(&data->cmap_b[index], cmapp->blue, count);
    309        1.1    elric 	return (error);
    310        1.1    elric }
    311        1.1    elric 
    312        1.1    elric /*
    313        1.1    elric  * XXX:
    314        1.1    elric  *  I am leaving these functions returning EINVAL, as they are
    315        1.1    elric  *  not strictly necessary for the correct functioning of the
    316        1.1    elric  *  card and in fact are not used on the other TGA variants, except
    317        1.1    elric  *  they are exported via ioctl(2) to userland, which does not in
    318        1.1    elric  *  fact use them.
    319        1.1    elric  */
    320        1.1    elric 
    321        1.1    elric int
    322        1.9      dsl ibm561_set_cursor(struct ramdac_cookie *rc, struct wsdisplay_cursor *cursorp)
    323        1.1    elric {
    324        1.1    elric 	return EINVAL;
    325        1.1    elric }
    326        1.1    elric 
    327        1.1    elric int
    328        1.9      dsl ibm561_get_cursor(struct ramdac_cookie *rc, struct wsdisplay_cursor *cursorp)
    329        1.1    elric {
    330        1.1    elric 	return EINVAL;
    331        1.1    elric }
    332        1.1    elric 
    333        1.1    elric int
    334        1.9      dsl ibm561_set_curpos(struct ramdac_cookie *rc, struct wsdisplay_curpos *curposp)
    335        1.1    elric {
    336        1.1    elric 	return EINVAL;
    337        1.1    elric }
    338        1.1    elric 
    339        1.1    elric int
    340        1.9      dsl ibm561_get_curpos(struct ramdac_cookie *rc, struct wsdisplay_curpos *curposp)
    341        1.1    elric {
    342        1.1    elric 	return EINVAL;
    343        1.1    elric }
    344        1.1    elric 
    345        1.1    elric int
    346        1.9      dsl ibm561_get_curmax(struct ramdac_cookie *rc, struct wsdisplay_curpos *curposp)
    347        1.1    elric {
    348        1.1    elric 	return EINVAL;
    349        1.1    elric }
    350        1.1    elric 
    351        1.1    elric int
    352        1.9      dsl ibm561_set_dotclock(struct ramdac_cookie *rc, unsigned dotclock)
    353        1.1    elric {
    354        1.1    elric 	struct ibm561data *data = (struct ibm561data *)rc;
    355        1.1    elric 
    356        1.1    elric 	/* XXXrcd:  a couple of these are a little hazy, vis a vis
    357        1.1    elric 	 *          check 175MHz and 202MHz, which are wrong...
    358        1.1    elric 	 */
    359        1.1    elric 	switch (dotclock) {
    360        1.1    elric 	case  25175000: data->vco_div = 0x3e; data->pll_ref = 0x09; break;
    361        1.1    elric 	case  31500000: data->vco_div = 0x17; data->pll_ref = 0x05; break;
    362        1.1    elric 	case  40000000: data->vco_div = 0x42; data->pll_ref = 0x06; break;
    363        1.1    elric 	case  50000000: data->vco_div = 0x45; data->pll_ref = 0x05; break;
    364        1.1    elric 	case  65000000: data->vco_div = 0xac; data->pll_ref = 0x0c; break;
    365        1.1    elric 	case  69000000: data->vco_div = 0xa9; data->pll_ref = 0x0b; break;
    366        1.1    elric 	case  74000000: data->vco_div = 0x9c; data->pll_ref = 0x09; break;
    367        1.1    elric 	case  75000000: data->vco_div = 0x93; data->pll_ref = 0x08; break;
    368        1.1    elric 	case 103994000: data->vco_div = 0x96; data->pll_ref = 0x06; break;
    369        1.1    elric 	case 108180000: data->vco_div = 0xb8; data->pll_ref = 0x08; break;
    370        1.1    elric 	case 110000000: data->vco_div = 0xba; data->pll_ref = 0x08; break;
    371        1.1    elric 	case 119840000: data->vco_div = 0x82; data->pll_ref = 0x04; break;
    372        1.1    elric 	case 130808000: data->vco_div = 0xc8; data->pll_ref = 0x08; break;
    373        1.1    elric 	case 135000000: data->vco_div = 0xc1; data->pll_ref = 0x07; break;
    374        1.1    elric 	case 175000000: data->vco_div = 0xe2; data->pll_ref = 0x07; break;
    375        1.1    elric 	case 202500000: data->vco_div = 0xe2; data->pll_ref = 0x07; break;
    376        1.1    elric 	default:
    377        1.1    elric 		return EINVAL;
    378        1.1    elric 	}
    379        1.1    elric 
    380        1.1    elric 	data->div_dotclock = 0xb0;
    381        1.1    elric 	data->changed |= CHANGED_DOTCLOCK;
    382        1.1    elric 	return 0;
    383        1.1    elric }
    384        1.1    elric 
    385        1.1    elric /*
    386        1.1    elric  * Internal Functions
    387        1.1    elric  */
    388        1.1    elric 
    389        1.1    elric void
    390        1.9      dsl ibm561_update(void *vp)
    391        1.1    elric {
    392        1.1    elric 	struct ibm561data *data = (struct ibm561data *)vp;
    393        1.1    elric 	int	i;
    394        1.1    elric 
    395        1.1    elric 	/* XXX see comment above ibm561_cninit() */
    396        1.1    elric 	if (!data)
    397        1.1    elric 		data = saved_console_data;
    398        1.1    elric 
    399        1.1    elric 	if (data->changed & CHANGED_WTYPE) {
    400        1.1    elric 		ibm561_regbegin(data, IBM561_FB_WINTYPE);
    401        1.1    elric 		for (i=0; i < IBM561_NWTYPES; i++)
    402        1.1    elric 			ibm561_regcont10bit(data, IBM561_CMD_FB_WAT, data->wtype[i]);
    403        1.1    elric 
    404        1.1    elric 		/* XXXrcd:  quick hack here for AUX FB table */
    405        1.1    elric 		ibm561_regbegin(data, IBM561_AUXFB_WINTYPE);
    406        1.1    elric 		for (i=0; i < IBM561_NWTYPES; i++)
    407        1.1    elric 			ibm561_regcont(data, IBM561_CMD, 0x04);
    408        1.1    elric 
    409        1.1    elric 		/* XXXrcd:  quick hack here for OL WAT table */
    410        1.1    elric 		ibm561_regbegin(data, IBM561_OL_WINTYPE);
    411        1.1    elric 		for (i=0; i < IBM561_NWTYPES; i++)
    412        1.1    elric 			ibm561_regcont10bit(data, IBM561_CMD_FB_WAT, 0x0231);
    413        1.1    elric 
    414        1.1    elric 		/* XXXrcd:  quick hack here for AUX OL WAT table */
    415        1.1    elric 		ibm561_regbegin(data, IBM561_AUXOL_WINTYPE);
    416        1.1    elric 		for (i=0; i < IBM561_NWTYPES; i++)
    417        1.1    elric 			ibm561_regcont(data, IBM561_CMD, 0x0c);
    418        1.1    elric 	}
    419        1.1    elric 
    420        1.1    elric 	if (data->changed & CHANGED_CMAP)
    421        1.1    elric 		ibm561_load_cmap(data);
    422        1.1    elric 
    423        1.1    elric 	/* XXX:  I am not sure in what situations it is safe to
    424        1.1    elric 	 *       change the dotclock---hope this is good.
    425        1.1    elric 	 */
    426        1.1    elric 	if (data->changed & CHANGED_DOTCLOCK)
    427        1.1    elric 		ibm561_load_dotclock(data);
    428        1.1    elric }
    429        1.1    elric 
    430        1.1    elric static void
    431        1.1    elric ibm561_load_cmap(struct ibm561data *data)
    432        1.1    elric {
    433        1.1    elric 	int	i;
    434        1.1    elric 
    435        1.1    elric 	ibm561_regbegin(data, IBM561_CMAP_TABLE);
    436        1.1    elric 	for (i=0; i < IBM561_NCMAP_ENTRIES; i++) {
    437        1.1    elric 		ibm561_regcont(data, IBM561_CMD_CMAP, data->cmap_r[i]);
    438        1.1    elric 		ibm561_regcont(data, IBM561_CMD_CMAP, data->cmap_g[i]);
    439        1.1    elric 		ibm561_regcont(data, IBM561_CMD_CMAP, data->cmap_b[i]);
    440        1.1    elric 	}
    441        1.1    elric 
    442        1.1    elric 	ibm561_regbegin(data, IBM561_RED_GAMMA_TABLE);
    443        1.1    elric 	for (i=0; i < 256; i++)
    444        1.1    elric 		ibm561_regcont10bit(data, IBM561_CMD_GAMMA, data->gamma_r[i]);
    445        1.1    elric 
    446        1.1    elric 	ibm561_regbegin(data, IBM561_GREEN_GAMMA_TABLE);
    447        1.1    elric 	for (i=1; i < 256; i++)
    448        1.1    elric 		ibm561_regcont10bit(data, IBM561_CMD_GAMMA, data->gamma_g[i]);
    449        1.1    elric 
    450        1.1    elric 	ibm561_regbegin(data, IBM561_BLUE_GAMMA_TABLE);
    451        1.1    elric 	for (i=1; i < 256; i++)
    452        1.1    elric 		ibm561_regcont10bit(data, IBM561_CMD_GAMMA, data->gamma_b[i]);
    453        1.1    elric 
    454        1.1    elric }
    455        1.1    elric 
    456        1.1    elric static void
    457        1.1    elric ibm561_load_dotclock(struct ibm561data *data)
    458        1.1    elric {
    459        1.1    elric 	/* XXX
    460        1.1    elric 	 * we should probably be more pro-active here, but it shouldn't
    461        1.1    elric 	 * actually happen...
    462        1.1    elric 	 */
    463        1.1    elric 	if (!data->vco_div || !data->pll_ref || ! data->div_dotclock) {
    464        1.1    elric 		panic("ibm561_load_dotclock: called uninitialized");
    465        1.1    elric 	}
    466        1.1    elric 
    467        1.1    elric 	ibm561_regwr(data, IBM561_PLL_VCO_DIV,  data->vco_div);
    468        1.1    elric 	ibm561_regwr(data, IBM561_PLL_REF_REG, data->pll_ref);
    469        1.1    elric 	ibm561_regwr(data, IBM561_DIV_DOTCLCK, data->div_dotclock);
    470        1.1    elric }
    471        1.1    elric 
    472        1.1    elric static void
    473        1.1    elric ibm561_regcont10bit(struct ibm561data *data, u_int16_t reg, u_int16_t val)
    474        1.1    elric {
    475        1.1    elric 	data->ramdac_wr(data->cookie, IBM561_CMD_GAMMA, (val >> 2) & 0xff);
    476        1.1    elric 	data->ramdac_wr(data->cookie, IBM561_CMD_GAMMA, (val & 0x3) << 6);
    477        1.1    elric }
    478        1.1    elric 
    479        1.1    elric static void
    480        1.1    elric ibm561_regbegin(struct ibm561data *data, u_int16_t reg)
    481        1.1    elric {
    482        1.1    elric 	data->ramdac_wr(data->cookie, IBM561_ADDR_LOW, reg & 0xff);
    483        1.1    elric 	data->ramdac_wr(data->cookie, IBM561_ADDR_HIGH, (reg >> 8) & 0xff);
    484        1.1    elric }
    485        1.1    elric 
    486        1.1    elric static void
    487        1.1    elric ibm561_regcont(struct ibm561data *data, u_int16_t reg, u_int8_t val)
    488        1.1    elric {
    489        1.1    elric 	data->ramdac_wr(data->cookie, reg, val);
    490        1.1    elric }
    491        1.1    elric 
    492        1.1    elric static void
    493        1.1    elric ibm561_regwr(struct ibm561data *data, u_int16_t reg, u_int8_t val)
    494        1.1    elric {
    495        1.1    elric 	ibm561_regbegin(data, reg);
    496        1.1    elric 	ibm561_regcont(data, IBM561_CMD, val);
    497        1.1    elric }
    498