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