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