142 	struct ibm561data *data;  in ibm561_register()  local
144 	data = kmem_zalloc(sizeof *data, KM_SLEEP);  in ibm561_register()
145 	data->cookie = v;  in ibm561_register()
146 	data->ramdac_sched_update = sched_update;  in ibm561_register()
147 	data->ramdac_wr = wr;  in ibm561_register()
148 	data->ramdac_rd = rd;  in ibm561_register()
149 	return (struct ramdac_cookie *)data;  in ibm561_register()
168 	struct ibm561data *data = &saved_console_data;  in ibm561_cninit()  local
169 	memset(data, 0x0, sizeof *data);  in ibm561_cninit()
170 	data->cookie = v;  in ibm561_cninit()
171 	data->ramdac_sched_update = sched_update;  in ibm561_cninit()
172 	data->ramdac_wr = wr;  in ibm561_cninit()
173 	data->ramdac_rd = rd;  in ibm561_cninit()
174 	ibm561_set_dotclock((struct ramdac_cookie *)data, dotclock);  in ibm561_cninit()
175 	ibm561_init((struct ramdac_cookie *)data);  in ibm561_cninit()
181 	struct	ibm561data *data = (struct ibm561data *)rc;  in ibm561_init()  local
186 	ibm561_load_dotclock(data);  in ibm561_init()
189 	ibm561_regwr(data, IBM561_CONFIG_REG1, 0x2a);  in ibm561_init()
190 	ibm561_regwr(data, IBM561_CONFIG_REG3, 0x41);  in ibm561_init()
191 	ibm561_regwr(data, IBM561_CONFIG_REG4, 0x20);  in ibm561_init()
194 	ibm561_regwr(data, IBM561_SYNC_CNTL, 0x1);  in ibm561_init()
195 	ibm561_regwr(data, IBM561_CONFIG_REG2, 0x19);  in ibm561_init()
197 	ibm561_regwr(data, IBM561_CONFIG_REG1, 0x2a);  in ibm561_init()
198 	ibm561_regwr(data, IBM561_CONFIG_REG4, 0x20);  in ibm561_init()
200 	ibm561_regbegin(data, IBM561_WAT_SEG_REG);  in ibm561_init()
201 	ibm561_regcont(data, IBM561_CMD, 0x00);  in ibm561_init()
202 	ibm561_regcont(data, IBM561_CMD, 0x00);  in ibm561_init()
203 	ibm561_regcont(data, IBM561_CMD, 0x00);  in ibm561_init()
204 	ibm561_regcont(data, IBM561_CMD, 0x00);  in ibm561_init()
205 	ibm561_regbegin(data, IBM561_CHROMAKEY0);  in ibm561_init()
206 	ibm561_regcont(data, IBM561_CMD, 0x00);  in ibm561_init()
207 	ibm561_regcont(data, IBM561_CMD, 0x00);  in ibm561_init()
208 	ibm561_regcont(data, IBM561_CMD, 0x00);  in ibm561_init()
209 	ibm561_regcont(data, IBM561_CMD, 0x00);  in ibm561_init()
211 	ibm561_regwr(data, IBM561_CURS_CNTL_REG, 0x00); /* XXX off? */  in ibm561_init()
214 	ibm561_regbegin(data, IBM561_HOTSPOT_REG);  in ibm561_init()
215 	ibm561_regcont(data, IBM561_CMD, 0x00);  in ibm561_init()
216 	ibm561_regcont(data, IBM561_CMD, 0x00);  in ibm561_init()
217 	ibm561_regcont(data, IBM561_CMD, 0xff);  in ibm561_init()
218 	ibm561_regcont(data, IBM561_CMD, 0x00);  in ibm561_init()
219 	ibm561_regcont(data, IBM561_CMD, 0xff);  in ibm561_init()
220 	ibm561_regcont(data, IBM561_CMD, 0x00);  in ibm561_init()
223 	ibm561_regbegin(data, IBM561_VRAM_MASK_REG);  in ibm561_init()
224 	ibm561_regcont(data, IBM561_CMD, 0xff);  in ibm561_init()
225 	ibm561_regcont(data, IBM561_CMD, 0xff);  in ibm561_init()
226 	ibm561_regcont(data, IBM561_CMD, 0xff);  in ibm561_init()
227 	ibm561_regcont(data, IBM561_CMD, 0xff);  in ibm561_init()
228 	ibm561_regcont(data, IBM561_CMD, 0xff);  in ibm561_init()
229 	ibm561_regcont(data, IBM561_CMD, 0xff);  in ibm561_init()
230 	ibm561_regcont(data, IBM561_CMD, 0xff);  in ibm561_init()
234 		data->cmap_r[i] = data->cmap_g[i] = data->cmap_b[i] = 0xff;  in ibm561_init()
235 	data->cmap_r[0]   = data->cmap_g[0]   = data->cmap_b[0]   = 0x00;  in ibm561_init()
236 	data->cmap_r[256] = data->cmap_g[256] = data->cmap_b[256] = 0x00;  in ibm561_init()
237 	data->cmap_r[512] = data->cmap_g[512] = data->cmap_b[512] = 0x00;  in ibm561_init()
238 	data->cmap_r[768] = data->cmap_g[768] = data->cmap_b[768] = 0x00;  in ibm561_init()
240 	data->gamma_r[0] = data->gamma_g[0] = data->gamma_b[0] = 0x00;  in ibm561_init()
242 		data->gamma_r[i] = data->gamma_g[i] = data->gamma_b[i] = 0xff;  in ibm561_init()
245 		data->wtype[i] = 0x0036;  in ibm561_init()
246 	data->wtype[1] = 0x0028;  in ibm561_init()
249 	data->changed = CHANGED_ALL;  in ibm561_init()
250 	data->ramdac_sched_update(data->cookie, ibm561_update);  in ibm561_init()
256 	struct ibm561data *data = (struct ibm561data *)rc;  in ibm561_set_cmap()  local
283 	memcpy(&data->cmap_r[index], &r[index], count);  in ibm561_set_cmap()
284 	memcpy(&data->cmap_g[index], &g[index], count);  in ibm561_set_cmap()
285 	memcpy(&data->cmap_b[index], &b[index], count);  in ibm561_set_cmap()
286 	data->changed |= CHANGED_CMAP;  in ibm561_set_cmap()
287 	data->ramdac_sched_update(data->cookie, ibm561_update);  in ibm561_set_cmap()
298 	struct ibm561data *data = (struct ibm561data *)rc;  in ibm561_get_cmap()  local
307 	error = copyout(&data->cmap_r[index], cmapp->red, count);  in ibm561_get_cmap()
310 	error = copyout(&data->cmap_g[index], cmapp->green, count);  in ibm561_get_cmap()
313 	error = copyout(&data->cmap_b[index], cmapp->blue, count);  in ibm561_get_cmap()
359 	struct ibm561data *data = (struct ibm561data *)rc;  in ibm561_set_dotclock()  local
365 	case  25175000: data->vco_div = 0x3e; data->pll_ref = 0x09; break;  in ibm561_set_dotclock()
366 	case  31500000: data->vco_div = 0x17; data->pll_ref = 0x05; break;  in ibm561_set_dotclock()
367 	case  40000000: data->vco_div = 0x42; data->pll_ref = 0x06; break;  in ibm561_set_dotclock()
368 	case  50000000: data->vco_div = 0x45; data->pll_ref = 0x05; break;  in ibm561_set_dotclock()
369 	case  65000000: data->vco_div = 0xac; data->pll_ref = 0x0c; break;  in ibm561_set_dotclock()
370 	case  69000000: data->vco_div = 0xa9; data->pll_ref = 0x0b; break;  in ibm561_set_dotclock()
371 	case  74000000: data->vco_div = 0x9c; data->pll_ref = 0x09; break;  in ibm561_set_dotclock()
372 	case  75000000: data->vco_div = 0x93; data->pll_ref = 0x08; break;  in ibm561_set_dotclock()
373 	case 103994000: data->vco_div = 0x96; data->pll_ref = 0x06; break;  in ibm561_set_dotclock()
374 	case 108180000: data->vco_div = 0xb8; data->pll_ref = 0x08; break;  in ibm561_set_dotclock()
375 	case 110000000: data->vco_div = 0xba; data->pll_ref = 0x08; break;  in ibm561_set_dotclock()
376 	case 119840000: data->vco_div = 0x82; data->pll_ref = 0x04; break;  in ibm561_set_dotclock()
377 	case 130808000: data->vco_div = 0xc8; data->pll_ref = 0x08; break;  in ibm561_set_dotclock()
378 	case 135000000: data->vco_div = 0xc1; data->pll_ref = 0x07; break;  in ibm561_set_dotclock()
379 	case 175000000: data->vco_div = 0xe2; data->pll_ref = 0x07; break;  in ibm561_set_dotclock()
380 	case 202500000: data->vco_div = 0xe2; data->pll_ref = 0x07; break;  in ibm561_set_dotclock()
385 	data->div_dotclock = 0xb0;  in ibm561_set_dotclock()
386 	data->changed |= CHANGED_DOTCLOCK;  in ibm561_set_dotclock()
397 	struct ibm561data *data = (struct ibm561data *)vp;  in ibm561_update()  local
401 	if (!data)  in ibm561_update()
402 		data = &saved_console_data;  in ibm561_update()
404 	if (data->changed & CHANGED_WTYPE) {  in ibm561_update()
405 		ibm561_regbegin(data, IBM561_FB_WINTYPE);  in ibm561_update()
407 			ibm561_regcont10bit(data, IBM561_CMD_FB_WAT, data->wtype[i]);  in ibm561_update()
410 		ibm561_regbegin(data, IBM561_AUXFB_WINTYPE);  in ibm561_update()
412 			ibm561_regcont(data, IBM561_CMD, 0x04);  in ibm561_update()
415 		ibm561_regbegin(data, IBM561_OL_WINTYPE);  in ibm561_update()
417 			ibm561_regcont10bit(data, IBM561_CMD_FB_WAT, 0x0231);  in ibm561_update()
420 		ibm561_regbegin(data, IBM561_AUXOL_WINTYPE);  in ibm561_update()
422 			ibm561_regcont(data, IBM561_CMD, 0x0c);  in ibm561_update()
425 	if (data->changed & CHANGED_CMAP)  in ibm561_update()
426 		ibm561_load_cmap(data);  in ibm561_update()
431 	if (data->changed & CHANGED_DOTCLOCK)  in ibm561_update()
432 		ibm561_load_dotclock(data);  in ibm561_update()
436 ibm561_load_cmap(struct ibm561data *data)  in ibm561_load_cmap()  argument
440 	ibm561_regbegin(data, IBM561_CMAP_TABLE);  in ibm561_load_cmap()
442 		ibm561_regcont(data, IBM561_CMD_CMAP, data->cmap_r[i]);  in ibm561_load_cmap()
443 		ibm561_regcont(data, IBM561_CMD_CMAP, data->cmap_g[i]);  in ibm561_load_cmap()
444 		ibm561_regcont(data, IBM561_CMD_CMAP, data->cmap_b[i]);  in ibm561_load_cmap()
447 	ibm561_regbegin(data, IBM561_RED_GAMMA_TABLE);  in ibm561_load_cmap()
449 		ibm561_regcont10bit(data, IBM561_CMD_GAMMA, data->gamma_r[i]);  in ibm561_load_cmap()
451 	ibm561_regbegin(data, IBM561_GREEN_GAMMA_TABLE);  in ibm561_load_cmap()
453 		ibm561_regcont10bit(data, IBM561_CMD_GAMMA, data->gamma_g[i]);  in ibm561_load_cmap()
455 	ibm561_regbegin(data, IBM561_BLUE_GAMMA_TABLE);  in ibm561_load_cmap()
457 		ibm561_regcont10bit(data, IBM561_CMD_GAMMA, data->gamma_b[i]);  in ibm561_load_cmap()
462 ibm561_load_dotclock(struct ibm561data *data)  in ibm561_load_dotclock()  argument
468 	if (!data->vco_div || !data->pll_ref || ! data->div_dotclock) {  in ibm561_load_dotclock()
472 	ibm561_regwr(data, IBM561_PLL_VCO_DIV,  data->vco_div);  in ibm561_load_dotclock()
473 	ibm561_regwr(data, IBM561_PLL_REF_REG, data->pll_ref);  in ibm561_load_dotclock()
474 	ibm561_regwr(data, IBM561_DIV_DOTCLCK, data->div_dotclock);  in ibm561_load_dotclock()
478 ibm561_regcont10bit(struct ibm561data *data, u_int16_t reg, u_int16_t val)  in ibm561_regcont10bit()  argument
480 	data->ramdac_wr(data->cookie, IBM561_CMD_GAMMA, (val >> 2) & 0xff);  in ibm561_regcont10bit()
481 	data->ramdac_wr(data->cookie, IBM561_CMD_GAMMA, (val & 0x3) << 6);  in ibm561_regcont10bit()
485 ibm561_regbegin(struct ibm561data *data, u_int16_t reg)  in ibm561_regbegin()  argument
487 	data->ramdac_wr(data->cookie, IBM561_ADDR_LOW, reg & 0xff);  in ibm561_regbegin()
488 	data->ramdac_wr(data->cookie, IBM561_ADDR_HIGH, (reg >> 8) & 0xff);  in ibm561_regbegin()
492 ibm561_regcont(struct ibm561data *data, u_int16_t reg, u_int8_t val)  in ibm561_regcont()  argument
494 	data->ramdac_wr(data->cookie, reg, val);  in ibm561_regcont()
498 ibm561_regwr(struct ibm561data *data, u_int16_t reg, u_int8_t val)  in ibm561_regwr()  argument
500 	ibm561_regbegin(data, reg);  in ibm561_regwr()
501 	ibm561_regcont(data, IBM561_CMD, val);  in ibm561_regwr()