xref: /netbsd-src/sys/arch/atari/dev/grfabs_fal.c (revision 3816d47b2c42fcd6e549e3407f842a5b1a1d23ad)
1 /*	$NetBSD: grfabs_fal.c,v 1.26 2009/10/21 21:50:14 snj Exp $	*/
2 
3 /*
4  * Copyright (c) 1995 Thomas Gerner.
5  * Copyright (c) 1995 Leo Weppelman.
6  * All rights reserved.
7  *
8  * Redistribution and use in source and binary forms, with or without
9  * modification, are permitted provided that the following conditions
10  * are met:
11  * 1. Redistributions of source code must retain the above copyright
12  *    notice, this list of conditions and the following disclaimer.
13  * 2. Redistributions in binary form must reproduce the above copyright
14  *    notice, this list of conditions and the following disclaimer in the
15  *    documentation and/or other materials provided with the distribution.
16  *
17  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27  */
28 
29 #include <sys/cdefs.h>
30 __KERNEL_RCSID(0, "$NetBSD: grfabs_fal.c,v 1.26 2009/10/21 21:50:14 snj Exp $");
31 
32 #ifdef FALCON_VIDEO
33 /*
34  *  atari abstract graphics driver: Falcon-interface
35  */
36 #include <sys/param.h>
37 #include <sys/queue.h>
38 #include <sys/malloc.h>
39 #include <sys/device.h>
40 #include <sys/systm.h>
41 
42 #include <uvm/uvm_extern.h>
43 
44 #include <machine/iomap.h>
45 #include <machine/video.h>
46 #include <machine/mfp.h>
47 #include <atari/atari/device.h>
48 #include <atari/atari/stalloc.h>
49 #include <atari/dev/grfabs_reg.h>
50 #include <atari/dev/grfabs_fal.h>
51 
52 /*
53  * Function decls
54  */
55 static void       init_view(view_t *, bmap_t *, dmode_t *, box_t *);
56 static bmap_t	  *alloc_bitmap(u_long, u_long, u_char);
57 static colormap_t *alloc_colormap(dmode_t *);
58 static void 	  free_bitmap(bmap_t *);
59 static void	  falcon_display_view(view_t *);
60 static view_t	  *falcon_alloc_view(dmode_t *, dimen_t *, u_char);
61 static void	  falcon_free_view(view_t *);
62 static void	  falcon_remove_view(view_t *);
63 static void	  falcon_save_view(view_t *);
64 static int	  falcon_use_colormap(view_t *, colormap_t *);
65 static void	  falcon_detect(dmode_t *);
66 static struct videl *falcon_getreg(u_short);
67 
68 /*
69  * Our function switch table
70  */
71 struct grfabs_sw fal_vid_sw = {
72 	falcon_display_view,
73 	falcon_alloc_view,
74 	falcon_free_view,
75 	falcon_remove_view,
76 	falcon_save_view,
77 	falcon_use_colormap
78 };
79 
80 struct falcon_hwregs {
81 	u_short		fal_mode;	/* falcon mode		  */
82 	struct videl	*fal_regs;	/* videl register values  */
83 };
84 #define vm_mode(dm)	(((struct falcon_hwregs*)(dm->data))->fal_mode)
85 #define vm_regs(dm)	(((struct falcon_hwregs*)(dm->data))->fal_regs)
86 
87 /*
88  * Note that the order of this table *must* match the order of
89  * the table below!
90  */
91 static struct falcon_hwregs fal_hwregs[] = {
92 	{ RES_FALAUTO    },
93 	{ RES_FAL_STHIGH },
94 	{ RES_FAL_STMID  },
95 	{ RES_FAL_STLOW  },
96 	{ RES_FAL_TTLOW  },
97 	{ RES_VGA2       },
98 	{ RES_VGA4       },
99 	{ RES_VGA16      },
100 	{ RES_VGA256     },
101 	{ RES_DIRECT     }
102 };
103 
104 
105 static dmode_t vid_modes[] = {
106     { {NULL,NULL}, "falauto", {   0,  0 },  0, NULL, &fal_vid_sw},
107     { {NULL,NULL}, "sthigh",  { 640,400 },  1, NULL, &fal_vid_sw},
108     { {NULL,NULL}, "stmid",   { 640,200 },  2, NULL, &fal_vid_sw},
109     { {NULL,NULL}, "stlow",   { 320,200 },  4, NULL, &fal_vid_sw},
110     { {NULL,NULL}, "ttlow",   { 320,480 },  8, NULL, &fal_vid_sw},
111     { {NULL,NULL}, "vga2",    { 640,480 },  1, NULL, &fal_vid_sw},
112     { {NULL,NULL}, "vga4",    { 640,480 },  2, NULL, &fal_vid_sw},
113     { {NULL,NULL}, "vga16",   { 640,480 },  4, NULL, &fal_vid_sw},
114     { {NULL,NULL}, "vga256",  { 640,480 },  8, NULL, &fal_vid_sw},
115     { {NULL,NULL}, "highcol", { 320,200 }, 16, NULL, &fal_vid_sw},
116     { {NULL,NULL},  NULL,  }
117 };
118 
119 /*
120  * The following table contains timing values for the various video modes.
121  * I have only a multisync display, therefore I can not say if this values
122  * are useful at other displays.
123  * Use other video modes at YOUR OWN RISK.
124  * THERE IS NO WARRENTY ABOUT THIS VALUES TO WORK WITH A PARTICULAR
125  * DISPLAY. -- Thomas
126  */
127 static struct videl videlinit[] = {
128 	{ RES_FALAUTO,		    /* autodedect			    */
129 	0x0, 0x0, 0x0,   0x0, 0x0,   0x0,  0x0,  0x0,  0x0,   0x0,  0x0,  0x0,
130 	0x0, 0x0,   0x0,   0x0,  0x0,  0x0,   0x0,   0x0,   0x0 },
131 
132 	{ FAL_VGA | RES_FAL_STHIGH, /* sthigh, 640x400, 2 colors	    */
133 	0x2, 0x0, 0x28,  0x0, 0x400, 0xc6, 0x8d, 0x15, 0x273, 0x50, 0x96, 0x0,
134 	0x0, 0x419, 0x3af, 0x8f, 0x8f, 0x3af, 0x415, 0x186, 0x8 },
135 
136 #if 0 /* not yet */
137 	{ FAL_SM | RES_FAL_STHIGH,  /* sthigh, 640x400, 2 colors	    */
138 	0x0, 0x0, 0x28,  0x2, 0x0,   0x1a, 0x0,  0x0,  0x20f, 0xc,  0x14, 0x0,
139 	0x0, 0x3e9, 0x0,   0x0,  0x43, 0x363, 0x3e7, 0x80,  0x8 },
140 #endif
141 
142 	{ FAL_VGA | RES_FAL_STMID,  /* stmid, 640x200, 4 colors		    */
143 	0x2, 0x0, 0x50,  0x1, 0x0,   0x17, 0x12, 0x1,  0x20e, 0xd,  0x11, 0x0,
144 	0x0, 0x419, 0x3af, 0x8f, 0x8f, 0x3af, 0x415, 0x186, 0x9 },
145 
146 	{ FAL_VGA | RES_FAL_STLOW,  /* stlow, 320x200, 16 colors	    */
147 	0x2, 0x0, 0x50,  0x0, 0x0,   0x17, 0x12, 0x1,  0x20e, 0xd,  0x11, 0x0,
148 	0x0, 0x419, 0x3af, 0x8f, 0x8f, 0x3af, 0x415, 0x186, 0x5 },
149 
150 	{ FAL_VGA | RES_FAL_TTLOW,  /* ttlow, 320x480, 256 colors	    */
151 	0x2, 0x0, 0xa0,  0x0, 0x10,  0xc6, 0x8d, 0x15, 0x29a, 0x7b, 0x96, 0x0,
152 	0x0, 0x419, 0x3ff, 0x3f, 0x3f, 0x3ff, 0x415, 0x186, 0x4 },
153 
154 	{ FAL_VGA | RES_VGA2,	    /* vga, 640x480, 2 colors		    */
155 	0x2, 0x0, 0x28,  0x0, 0x400, 0xc6, 0x8d, 0x15, 0x273, 0x50, 0x96, 0x0,
156 	0x0, 0x419, 0x3ff, 0x3f, 0x3f, 0x3ff, 0x415, 0x186, 0x8 },
157 
158 	{ FAL_VGA | RES_VGA4,	    /* vga, 640x480, 4 colors		    */
159 	0x2, 0x0, 0x50,  0x1, 0x0,   0x17, 0x12, 0x1,  0x20e, 0xd,  0x11, 0x0,
160 	0x0, 0x419, 0x3ff, 0x3f, 0x3f, 0x3ff, 0x415, 0x186, 0x8 },
161 
162 	{ FAL_VGA | RES_VGA16,	    /* vga, 640x480, 16 colors		    */
163 	0x2, 0x0, 0xa0,  0x1, 0x0,   0xc6, 0x8d, 0x15, 0x2a3, 0x7c, 0x96, 0x0,
164 	0x0, 0x419, 0x3ff, 0x3f, 0x3f, 0x3ff, 0x415, 0x186, 0x8 },
165 
166 	{ FAL_VGA | RES_VGA256,	    /* vga, 640x480, 256 colors		    */
167 	0x2, 0x0, 0x140, 0x1, 0x10,  0xc6, 0x8d, 0x15, 0x2ab, 0x84, 0x96, 0x0,
168 	0x0, 0x419, 0x3ff, 0x3f, 0x3f, 0x3ff, 0x415, 0x186, 0x8 },
169 
170 	{ FAL_VGA | RES_DIRECT,	    /* direct video, 320x200, 65536 colors  */
171 	0x2, 0x0, 0x140, 0x0, 0x100, 0xc6, 0x8d, 0x15, 0x2ac, 0x91, 0x96, 0x0,
172 	0x0, 0x419, 0x3ff, 0x3f, 0x3f, 0x3ff, 0x415, 0x186, 0x4 },
173 
174 	{ 0xffff }		    /* end of list			    */
175 };
176 
177 static u_short mon_type;
178 /*
179  * XXX: called from ite console init routine.
180  * Initialize list of possible video modes.
181  */
182 void
183 falcon_probe_video(MODES *modelp)
184 {
185 	dmode_t	*dm;
186 	struct videl *vregs;
187 	int	i;
188 
189 	mon_type = *(volatile unsigned char *)(AD_FAL_MON_TYPE);
190 	mon_type = (mon_type & 0xc0) << 2;
191 
192 	/*
193 	 * get all possible modes
194 	 */
195 
196 	for (i = 0; (dm = &vid_modes[i])->name != NULL; i++) {
197 		dm->data = (void *)&fal_hwregs[i];
198 		if (vm_mode(dm) == RES_FALAUTO) {
199 			vm_regs(dm) = falcon_getreg(RES_FALAUTO);
200 			falcon_detect(dm);
201 			LIST_INSERT_HEAD(modelp, dm, link);
202 		} else {
203 			vregs = falcon_getreg(vm_mode(dm) | mon_type);
204 			if (vregs) {
205 				vm_regs(dm) = vregs;
206 				LIST_INSERT_HEAD(modelp, dm, link);
207 			}
208 		}
209 	}
210 
211 	/*
212 	 * This seems to prevent bordered screens.
213 	 */
214 	for (i=0; i < 16; i++)
215 		VIDEO->vd_fal_rgb[i] = CM_L2FAL(gra_def_color16[i]);
216 }
217 
218 static struct videl *
219 falcon_getreg(u_short mode)
220 {
221 	int i;
222 	struct videl *vregs;
223 
224 	for (i = 0; (vregs = &videlinit[i])->video_mode != 0xffff; i++)
225 		if ((vregs->video_mode) == mode)
226 			return vregs;
227 
228 	return NULL; /* mode not found */
229 }
230 
231 static void
232 falcon_detect(dmode_t *dm)
233 {
234 	u_short	falshift, stshift;
235 	struct videl *vregs = vm_regs(dm);
236 
237 	/*
238 	 * First get the videl register values
239 	 */
240 
241 	vregs->vd_syncmode	= VIDEO->vd_sync;
242 	vregs->vd_line_wide	= VIDEO->vd_line_wide;
243 	vregs->vd_vert_wrap	= VIDEO->vd_vert_wrap;
244 	vregs->vd_st_res	= VIDEO->vd_st_res;
245 	vregs->vd_fal_res	= VIDEO->vd_fal_res;
246 	vregs->vd_h_hold_tim	= VIDEO->vd_h_hold_tim;
247 	vregs->vd_h_bord_beg	= VIDEO->vd_h_bord_beg;
248 	vregs->vd_h_bord_end	= VIDEO->vd_h_bord_end;
249 	vregs->vd_h_dis_beg	= VIDEO->vd_h_dis_beg;
250 	vregs->vd_h_dis_end	= VIDEO->vd_h_dis_end;
251 	vregs->vd_h_ss		= VIDEO->vd_h_ss;
252 	vregs->vd_h_fs		= VIDEO->vd_h_fs;
253 	vregs->vd_h_hh		= VIDEO->vd_h_hh;
254 	vregs->vd_v_freq_tim	= VIDEO->vd_v_freq_tim;
255 	vregs->vd_v_bord_beg	= VIDEO->vd_v_bord_beg;
256 	vregs->vd_v_bord_end	= VIDEO->vd_v_bord_end;
257 	vregs->vd_v_dis_beg	= VIDEO->vd_v_dis_beg;
258 	vregs->vd_v_dis_end	= VIDEO->vd_v_dis_end;
259 	vregs->vd_v_ss		= VIDEO->vd_v_ss;
260 	vregs->vd_fal_ctrl	= VIDEO->vd_fal_ctrl;
261 	vregs->vd_fal_mode	= VIDEO->vd_fal_mode;
262 
263 
264 	/*
265 	 * Calculate the depth of the screen
266 	 */
267 
268 	falshift = vregs->vd_fal_res;
269 	stshift = vregs->vd_st_res;
270 
271 	if (falshift & 0x400)		/* 2 color */
272 		dm->depth = 1;
273 	else if (falshift & 0x100)	/* high color, direct */
274 		dm->depth = 16;
275 	else if (falshift & 0x10)	/* 256 color */
276 		dm->depth = 8;
277 	else if (stshift == 0)		/* 16 color */
278 		dm->depth = 4;
279 	else if (stshift == 1)		/* 4 color */
280 		dm->depth = 2;
281 	else dm->depth = 1;		/* 2 color */
282 
283 	/*
284 	 * Now calculate the screen hight
285 	 */
286 
287 	dm->size.height = vregs->vd_v_dis_end - vregs->vd_v_dis_beg;
288 	if (!((vregs->vd_fal_mode & 0x2) >> 1)) /* if not interlaced */
289 		dm->size.height >>=1;
290 	if (vregs->vd_fal_mode & 0x1)		/* if doublescan */
291 		dm->size.height >>=1;
292 
293 	/*
294 	 * And the width
295 	 */
296 
297 	dm->size.width = vregs->vd_vert_wrap * 16 / dm->depth;
298 
299 }
300 
301 u_long	falcon_needs_vbl;
302 void falcon_display_switch(void);
303 
304 static void
305 falcon_display_view(view_t *v)
306 {
307 	dmode_t	*dm = v->mode;
308 	bmap_t		*bm;
309 	struct videl	*vregs;
310 	static u_short last_mode = 0xffff;
311 
312 	if (dm->current_view) {
313 		/*
314 		 * Mark current view for this mode as no longer displayed
315 		 */
316 		dm->current_view->flags &= ~VF_DISPLAY;
317 	}
318 	dm->current_view = v;
319 	v->flags |= VF_DISPLAY;
320 	vregs = vm_regs(v->mode);
321 
322 	falcon_use_colormap(v, v->colormap);
323 
324 	bm = v->bitmap;
325 	VIDEO->vd_ramh   = ((u_long)bm->hw_address >> 16) & 0xff;
326 	VIDEO->vd_ramm   = ((u_long)bm->hw_address >>  8) & 0xff;
327 	VIDEO->vd_raml   =  (u_long)bm->hw_address & 0xff;
328 
329 	if (last_mode != vregs->video_mode) {
330 		last_mode = vregs->video_mode;
331 
332 		if (dm->depth == 1) {
333 			/*
334 			 * Set the resolution registers to a mode, which guarantee
335 			 * no shifting when the register are written during vbl.
336 			 */
337 			VIDEO->vd_fal_res = 0;
338 			VIDEO->vd_st_res = 0;
339 		}
340 
341 		/*
342 		 * Arrange for them to be activated
343 		 * at the second vbl interrupt.
344 		 */
345 		falcon_needs_vbl = (u_long)v;
346 	}
347 }
348 
349 void
350 falcon_display_switch(void)
351 {
352 	view_t		*v;
353 	struct videl	*vregs;
354 	static int vbl_count = 1;
355 
356 	if(vbl_count--) return;
357 
358 	v = (view_t*)falcon_needs_vbl;
359 
360 	vbl_count = 1;
361 	falcon_needs_vbl = 0;
362 
363 	/*
364 	 * Write to videl registers only on VGA displays
365 	 * This is only a hack. Must be fixed soon. XXX -- Thomas
366 	 */
367 	if(mon_type != FAL_VGA) return;
368 
369 	vregs = vm_regs(v->mode);
370 
371 	VIDEO->vd_v_freq_tim    = vregs->vd_v_freq_tim;
372 	VIDEO->vd_v_ss          = vregs->vd_v_ss;
373 	VIDEO->vd_v_bord_beg    = vregs->vd_v_bord_beg;
374 	VIDEO->vd_v_bord_end    = vregs->vd_v_bord_end;
375 	VIDEO->vd_v_dis_beg     = vregs->vd_v_dis_beg;
376 	VIDEO->vd_v_dis_end     = vregs->vd_v_dis_end;
377 	VIDEO->vd_h_hold_tim    = vregs->vd_h_hold_tim;
378 	VIDEO->vd_h_ss          = vregs->vd_h_ss;
379 	VIDEO->vd_h_bord_beg    = vregs->vd_h_bord_beg;
380 	VIDEO->vd_h_bord_end    = vregs->vd_h_bord_end;
381 	VIDEO->vd_h_dis_beg     = vregs->vd_h_dis_beg;
382 	VIDEO->vd_h_dis_end     = vregs->vd_h_dis_end;
383 #if 0 /* This seems not to be necessary -- Thomas */
384 	VIDEO->vd_h_fs		= vregs->vd_h_fs;
385 	VIDEO->vd_h_hh		= vregs->vd_h_hh;
386 #endif
387 	VIDEO->vd_sync          = vregs->vd_syncmode;
388 	VIDEO->vd_fal_res       = 0;
389 	if (v->mode->depth == 2)
390 		VIDEO->vd_st_res        = vregs->vd_st_res;
391 	else {
392 		VIDEO->vd_st_res        = 0;
393 		VIDEO->vd_fal_res       = vregs->vd_fal_res;
394 	}
395 	VIDEO->vd_vert_wrap     = vregs->vd_vert_wrap;
396 	VIDEO->vd_line_wide     = vregs->vd_line_wide;
397 	VIDEO->vd_fal_ctrl      = vregs->vd_fal_ctrl;
398 	VIDEO->vd_fal_mode      = vregs->vd_fal_mode;
399 }
400 
401 static void
402 falcon_remove_view(view_t *v)
403 {
404 	dmode_t *mode = v->mode;
405 
406 	if (mode->current_view == v) {
407 #if 0
408 		if (v->flags & VF_DISPLAY)
409 			panic("Cannot shutdown display"); /* XXX */
410 #endif
411 		mode->current_view = NULL;
412 	}
413 	v->flags &= ~VF_DISPLAY;
414 }
415 
416 void
417 falcon_save_view(view_t *v)
418 {
419 }
420 
421 static void
422 falcon_free_view(view_t *v)
423 {
424 	if (v) {
425 		falcon_remove_view(v);
426 		if (v->colormap != &gra_con_cmap)
427 			free(v->colormap, M_DEVBUF);
428 		free_bitmap(v->bitmap);
429 		if (v != &gra_con_view)
430 			free(v, M_DEVBUF);
431 	}
432 }
433 
434 static int
435 falcon_use_colormap(view_t *v, colormap_t *cm)
436 {
437 	dmode_t			*dm;
438 	volatile u_short	*creg;
439 	volatile u_long		*fcreg;
440 	u_long			*src;
441 	colormap_t		*vcm;
442 	u_long			*vcreg;
443 	u_short			ncreg;
444 	int			last_streg;
445 	int			i;
446 
447 	dm  = v->mode;
448 	vcm = v->colormap;
449 
450 	/*
451 	 * I guess it seems reasonable to require the maps to be
452 	 * of the same type...
453 	 */
454 	if (cm->type != vcm->type)
455 		return (EINVAL);
456 
457 	/*
458 	 * First get the colormap addresses an calculate
459 	 * howmany colors are in it.
460 	 */
461 	if (dm->depth == 16) /* direct color, no colormap;
462 				but also not (yet) supported */
463 		return(0);
464 	fcreg = &VIDEO->vd_fal_rgb[0];
465 	creg  = &VIDEO->vd_st_rgb[0];
466 	ncreg = 1 << dm->depth;
467 
468 	/* If first entry specified beyond capabilities -> error */
469 	if (cm->first >= ncreg)
470 		return (EINVAL);
471 
472 	/*
473 	 * A little tricky, the actual colormap pointer will be NULL
474 	 * when view is not displaying, valid otherwise.
475 	 */
476 	if (v->flags & VF_DISPLAY) {
477 		creg = &creg[cm->first];
478 		fcreg = &fcreg[cm->first];
479 	} else {
480 		creg = NULL;
481 		fcreg = NULL;
482 	}
483 
484 	vcreg  = &vcm->entry[cm->first];
485 	ncreg -= cm->first;
486 	last_streg = 16 - cm->first;
487 	if (cm->size > ncreg)
488 		return (EINVAL);
489 	ncreg = cm->size;
490 
491 	for (i = 0, src = cm->entry; i < ncreg; i++, vcreg++) {
492 		*vcreg = *src++;
493 
494 		/*
495 		 * If displaying, also update actual color register.
496 		 */
497 		if (fcreg != NULL) {
498 			*fcreg++ = CM_L2FAL(*vcreg);
499 			if (i < last_streg)
500 				*creg++ = CM_L2ST(*vcreg);
501 		}
502 	}
503 	return (0);
504 }
505 
506 static view_t *
507 falcon_alloc_view(dmode_t *mode, dimen_t *dim, u_char depth)
508 {
509 	view_t *v;
510 	bmap_t *bm;
511 
512 	if (!atari_realconfig)
513 		v = &gra_con_view;
514 	else v = malloc(sizeof(*v), M_DEVBUF, M_NOWAIT);
515 	if (v == NULL)
516 		return(NULL);
517 
518 	bm = alloc_bitmap(mode->size.width, mode->size.height, mode->depth);
519 	if (bm) {
520 		box_t   box;
521 
522 		v->colormap = alloc_colormap(mode);
523 		if (v->colormap) {
524 			INIT_BOX(&box,0,0,mode->size.width,mode->size.height);
525 			init_view(v, bm, mode, &box);
526 			return(v);
527 		}
528 		free_bitmap(bm);
529 	}
530 	if (v != &gra_con_view)
531 		free(v, M_DEVBUF);
532 	return (NULL);
533 }
534 
535 static void
536 init_view(view_t *v, bmap_t *bm, dmode_t *mode, box_t *dbox)
537 {
538 	v->bitmap = bm;
539 	v->mode   = mode;
540 	v->flags  = 0;
541 	memcpy(&v->display, dbox, sizeof(box_t));
542 }
543 
544 /* bitmap functions */
545 
546 static bmap_t *
547 alloc_bitmap(u_long width, u_long height, u_char depth)
548 {
549 	u_long  total_size, bm_size;
550 	void	*hw_address;
551 	bmap_t	*bm;
552 
553 	/*
554 	 * Sigh, it seems for mapping to work we need the bitplane data to
555 	 *  1: be aligned on a page boundry.
556 	 *  2: be n pages large.
557 	 *
558 	 * why? because the user gets a page aligned address, if this is before
559 	 * your allocation, too bad.  Also it seems that the mapping routines
560 	 * do not watch to closely to the allowable length. so if you go over
561 	 * n pages by less than another page, the user gets to write all over
562 	 * the entire page. Since you did not allocate up to a page boundry
563 	 * (or more) the user writes into someone elses memory. -ch
564 	 */
565 	bm_size    = m68k_round_page((width * height * depth) / NBBY);
566 	total_size = bm_size + sizeof(bmap_t) + PAGE_SIZE;
567 
568 	if ((bm = (bmap_t*)alloc_stmem(total_size, &hw_address)) == NULL)
569 		return(NULL);
570 
571 	bm->plane         = (u_char*)bm + sizeof(bmap_t);
572 	bm->plane         = (u_char*)m68k_round_page(bm->plane);
573 	bm->hw_address    = (u_char*)hw_address + sizeof(bmap_t);
574 	bm->hw_address    = (u_char*)m68k_round_page(bm->hw_address);
575 	bm->bytes_per_row = (width * depth) / NBBY;
576 	bm->rows          = height;
577 	bm->depth         = depth;
578 	bm->phys_mappable = (depth * width * height) / NBBY;
579 	bm->regs          = NULL;
580 	bm->hw_regs       = NULL;
581 	bm->reg_size      = 0;
582 	bm->vga_address   = NULL;
583 	bm->vga_mappable  = 0;
584 	bm->lin_base      = 0;
585 	bm->vga_base      = 0;
586 
587 	memset(bm->plane, 0, bm_size);
588 	return (bm);
589 }
590 
591 static void
592 free_bitmap(bmap_t *bm)
593 {
594 	if (bm)
595 		free_stmem(bm);
596 }
597 
598 static colormap_t *
599 alloc_colormap(dmode_t *dm)
600 {
601 	int		nentries, i;
602 	colormap_t	*cm;
603 	u_char		type = CM_COLOR;
604 
605 	if (dm->depth == 16) /* direct color, no colormap;
606 				not (yet) supported */
607 		nentries = 0;
608 	else
609 		nentries = 1 << dm->depth;
610 
611 	if (!atari_realconfig) {
612 		cm = &gra_con_cmap;
613 		cm->entry = gra_con_colors;
614 	}
615 	else {
616 		int size;
617 
618 		size = sizeof(*cm) + (nentries * sizeof(cm->entry[0]));
619 		cm   = malloc(size, M_DEVBUF, M_NOWAIT);
620 		if (cm == NULL)
621 			return(NULL);
622 		cm->entry = (long *)&cm[1];
623 
624 	}
625 
626 	if ((cm->type = type) == CM_COLOR)
627 		cm->red_mask = cm->green_mask = cm->blue_mask = 0x3f;
628 
629 	cm->first = 0;
630 	cm->size  = nentries;
631 
632 	for (i = 0; i < nentries; i++)
633 		cm->entry[i] = gra_def_color16[i % 16];
634 	return (cm);
635 }
636 #endif /* FALCON_VIDEO */
637