path: root/xc/programs/Xserver/hw/omron/omron88kBm.c

/*
 * $XConsortium: omron88kBm.c,v 1.1 91/06/29 13:48:52 xguest Exp $
 *
 * Copyright 1991 by OMRON Corporation
 * 
 * Permission to use, copy, modify, distribute, and sell this software and its
 * documentation for any purpose is hereby granted without fee, provided that
 * the above copyright notice appear in all copies and that both that
 * copyright notice and this permission notice appear in supporting
 * documentation, and that the name of OMRON not be used in advertising or
 * publicity pertaining to distribution of the software without specific,
 * written prior permission.  OMRON makes no representations about the
 * suitability of this software for any purpose.  It is provided "as is"
 * without express or implied warranty.
 *
 * OMRON DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE, INCLUDING ALL
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS, IN NO EVENT SHALL OMRON
 * BE LIABLE FOR ANY SPECIAL, INDIRECT OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
 * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN 
 * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 */

#ifdef	luna88k
#include "omron.h"

#include "omronFb.h"

/*
**	color palette 
*/
struct pal{
	unsigned char red;
	unsigned char green;
	unsigned char blue;
};

static struct pal paldata[256] = {
	{~0,~0,~0}, {0,0,0},
	{~0,~0,~0}, {0,0,0},
	{~0,~0,~0}, {0,0,0},
	{~0,~0,~0}, {0,0,0},
	{~0,~0,~0}, {0,0,0},
	{~0,~0,~0}, {0,0,0},
	{~0,~0,~0}, {0,0,0},
	{~0,~0,~0}, {0,0,0}
};

static struct pal palinit[256] = {
	{~0,~0,~0}, {0,0,0},
	{~0,~0,~0}, {0,0,0},
	{~0,~0,~0}, {0,0,0},
	{~0,~0,~0}, {0,0,0},
	{~0,~0,~0}, {0,0,0},
	{~0,~0,~0}, {0,0,0},
	{~0,~0,~0}, {0,0,0},
	{~0,~0,~0}, {0,0,0}
};

static struct pal palsave[256];

static int	  pagesize;

static Bool omron88kBmPalCreate();
static void omron88kBmFbClose();
static void omron88kBmPalInit();
static void omron88kBmGetPal();
static void omron88kBmSetPal();

Bool
omron88kBmCreate(omron_fb_info)
OmronFbInfoPtr omron_fb_info;
{
	R88kBmRegPtr r88k_bm_reg;
	caddr_t      map_ptr = (caddr_t)0xb1080000;	/* frame buffer i/o port */

	pagesize = getpagesize();

	/* map fb memoery */
	if ((omron_fb_info->fbfd1 = open("/dev/fb",2)) < 0) {
		Error("Can't open /dev/fb");
		return FALSE;
	}

	if ( ioctl(omron_fb_info->fbfd1,FBIOCBATC,(caddr_t *)&map_ptr) < 0 ) {
		Error("ioctl FBIOCBATC error.");
		return FALSE;
	}

	omron_fb_info->plane = (char *)0xb10c0008;	

	/* map fb control regs */
	if ((omron_fb_info->fbfd2 = open("/dev/allmapfb",2)) < 0) { 
		Error("Can't allocate 88k_bm_reg.");
		return FALSE;
	}

	omron_fb_info->fbmapsize =
		 (sizeof(struct R88k_bm_fbreg) + (pagesize - 1)) & ~(pagesize- 1);
	r88k_bm_reg = ( R88kBmRegPtr )valloc(omron_fb_info->fbmapsize);
	if(r88k_bm_reg  == ( R88kBmRegPtr ) NULL) {
		Error("Can't allocate 88k_bm_reg.");
		return FALSE;
	}

	if(mmap(r88k_bm_reg, omron_fb_info->fbmapsize, PROT_WRITE, MAP_SHARED,
		    omron_fb_info->fbfd2,0) < 0 ) {
		Error("Can't mmap /dev/allmapfb");
		free(r88k_bm_reg);
		return FALSE;
	}

	omron_fb_info->fbmap = (char *)r88k_bm_reg;
	omron_fb_info->refresh_reg = &(r88k_bm_reg->refresh.reg);

	if (!omron88kBmPalCreate(omron_fb_info)) {
		omron88kBmFbClose(omron_fb_info);
		return FALSE;
	}

	if (omron_fb_info->fb_type == DT_PLASMA)
		*(omron_fb_info->refresh_reg) = 0x100000;
	else if (omron_fb_info->fb_type == DT_BM8)
		*(omron_fb_info->refresh_reg) = 0xff07f7e6;
	else
		*(omron_fb_info->refresh_reg) = 0xff07f7e5;

	return TRUE;
}


static Bool
omron88kBmSaveScreen(pScreen, on)
ScreenPtr     pScreen;
Bool          on;
{
static int omronScreenIsSaved = FALSE;
	struct pal savepal[256]; 	
	OmronFbInfoPtr pFbInfo =
		(OmronFbInfoPtr)pScreen->devPrivates[omronScreenIndex].ptr;

	if (on != SCREEN_SAVER_ON) {
		omronSetLastEventTime();
		if(omronScreenIsSaved == TRUE) {
			omron88kBmSetPal(pFbInfo, palsave);
			omronScreenIsSaved = FALSE;
		}
		return TRUE;
	}

	bzero(savepal, sizeof(savepal));
	omron88kBmSetPal(pFbInfo, savepal);
	omronScreenIsSaved = TRUE;
	return TRUE;
}

Bool
omron88kBmInit(index, pScreen, argc, argv)
    int           index;
    ScreenPtr     pScreen;
    int           argc;
    char          **argv;
{
	OmronFbInfoPtr pFbInfo;
	extern miPointerScreenFuncRec  omronPointerScreenFuncs;
	
	pFbInfo = (OmronFbInfoPtr) pScreen->devPrivates[omronScreenIndex].ptr;

	omron88kBmPalInit(pFbInfo);

	if (!monitorResolution) {
		if (pFbInfo->fb_type == DT_PLASMA)
			monitorResolution = PLASMA_TV_RESOLUTION;
		else
			monitorResolution = MONO_TV_RESOLUTION; 
	}

	if(!mfbScreenInit(pScreen,(pointer)pFbInfo->plane,
			pFbInfo->scr_width,pFbInfo->scr_height,
			monitorResolution,monitorResolution,pFbInfo->fb_width)){
		ErrorF("mfbScreenInit error.\n");
		return FALSE;
	}

   	pScreen->whitePixel = 0;
   	pScreen->blackPixel = 1;

	miDCInitialize (pScreen, &omronPointerScreenFuncs);

	mfbCreateDefColormap(pScreen);

	pScreen->SaveScreen = omron88kBmSaveScreen;

	omron88kBmSaveScreen(pScreen, SCREEN_SAVER_FORCER);

	return TRUE;

}

static void
omron88kBmFbClose(omron_fb_info)
OmronFbInfoPtr omron_fb_info;
{
	if(munmap(omron_fb_info->fbmap,omron_fb_info->fbmapsize) < 0) {
		Error("Can't munmap bm_reg.");
	}
	free(omron_fb_info->fbmap);

	(void)close(omron_fb_info->fbfd1);
	(void)close(omron_fb_info->fbfd2);
}

static void
omron88kBmPalClose(omron_fb_info)
OmronFbInfoPtr omron_fb_info;
{
	union palette_bm8 *r88k_bm8_pal;

	omron88kBmSetPal(omron_fb_info, paldata);

	if(omron_fb_info->fb_type == DT_BM8) {
		r88k_bm8_pal = (union palette_bm8 *)(omron_fb_info->palmap);
		r88k_bm8_pal->reg.addr = 0x4L;
		r88k_bm8_pal->reg.command = 0x1L;
	} else if(omron_fb_info->fb_type == DT_PLASMA) {
		*(omron_fb_info->refresh_reg) = 0;
	}

	if (munmap(omron_fb_info->palmap, omron_fb_info->palmapsize) < 0) {
		Error("Can't munmap palette.");
	}

	free(omron_fb_info->palmap);
	(void)close(omron_fb_info->palfd);
}


static Bool
omron88kBmPalCreate(omron_fb_info)
OmronFbInfoPtr omron_fb_info;
{
	union palette_bm8 *r88k_bm8_pal;

	if ((omron_fb_info->palfd = open("/dev/palette",2)) < 0) {
		Error("Can't open /dev/palette");
		return FALSE;
	}

	if(omron_fb_info->fb_type == DT_BM8) {	/* BM8 */
		omron_fb_info->palmapsize =
			(sizeof(union palette_bm8) + (pagesize - 1)) & ~(pagesize - 1);
	} else {	/* BM */
		omron_fb_info->palmapsize =
			(sizeof(union palette) + (pagesize - 1)) & ~(pagesize - 1);
	}

	omron_fb_info->palmap = valloc(omron_fb_info->palmapsize);

	if(omron_fb_info->palmap  == (char *) NULL) {
		Error("Can't allocate palette.");
		return FALSE;	
	}

	if (mmap(omron_fb_info->palmap, omron_fb_info->palmapsize,
			 (PROT_WRITE | PROT_READ),MAP_SHARED, omron_fb_info->palfd, 0) < 0) { 
		Error("Can't mmap palette.");
		free(omron_fb_info->palmap);
		return FALSE;
	}	

	if(ioctl(omron_fb_info->palfd, PLTIOCUND, 0) < 0) {
		Error("ioctl PLTIOCUND error.");
		return FALSE;
	}

	if(omron_fb_info->fb_type == DT_BM8) {	/* BM8 */
		r88k_bm8_pal = (union palette_bm8 *)(omron_fb_info->palmap);
		r88k_bm8_pal->reg.addr    = 0x04;
		r88k_bm8_pal->reg.command = (1 << omron_fb_info->fb_depth) - 1;
		r88k_bm8_pal->reg.addr    = 0x06;
		r88k_bm8_pal->reg.command = 0x40;
	}

	omron88kBmGetPal(omron_fb_info, paldata);

	return TRUE; 
}


static void
omron88kBmPalInit(omron_fb_info)
OmronFbInfoPtr omron_fb_info;
{
	memmove(palsave, palinit, sizeof(palinit));
	omron88kBmSetPal(omron_fb_info, palsave);
}


static void
omron88kBmSetPal(omron_fb_info, pal)
OmronFbInfoPtr omron_fb_info;
struct pal *pal;
{
	union palette	   *r88k_bm_pal;
	union palette_bm8  *r88k_bm8_pal;
	register int       i, j;
	unsigned char      *palp;

	if(omron_fb_info->fb_type == DT_BM8) {	/* BM8 */
		r88k_bm8_pal = (union palette_bm8 *)(omron_fb_info->palmap);
		for (i = 0; i < 256; i++) {
			palp = &pal++->red;
			r88k_bm8_pal->reg.addr = i;
			for (j = 0; j < 3; j++) {
				r88k_bm8_pal->reg.coldata = *palp++;
			}
		}
	} else {
		r88k_bm_pal = (union palette *)(omron_fb_info->palmap);
		/* restore palette data */
		for (i = 0; i < 16; i++) {
			palp = &pal++->red;
			r88k_bm_pal->reg.addr = i << 4;
			for (j = 0; j < 3; j++)
				r88k_bm_pal->reg.coldata = *palp++;
		}
	}
}


static void
omron88kBmGetPal(omron_fb_info, pal)
OmronFbInfoPtr omron_fb_info;
struct pal *pal;
{
	union palette_bm8  *r88k_bm8_pal;
	register	int    i,j;
	unsigned char    *palp;

	if(omron_fb_info->fb_type == DT_BM8) {	/* BM8 */
		r88k_bm8_pal = (union palette_bm8 *)(omron_fb_info->palmap);

		/* save the CPU ROM palette setting */
		for (i = 0; i < 256; i++) {
			palp = &pal++->red;
			r88k_bm8_pal->reg.addr = i;
			for (j = 0; j < 3; j++) {
				*palp++ = r88k_bm8_pal->reg.coldata;
			}
		}
	}
}


static void
omron88kBmFbClear(omron_fb_info)
OmronFbInfoPtr omron_fb_info;
{
	register int *f;
	register int nw,height;
	int nwidth,nlwidth,nlwExtra;

	f = (int *)omron_fb_info->plane;
	nlwidth  = (omron_fb_info->fb_width)>>5;
	nwidth   = (omron_fb_info->scr_width)>>5;
	nlwExtra = nlwidth - nwidth;
	height =omron_fb_info->scr_height;

	while(height--) {
		nw = nwidth;
		while(nw--)
			*f++ = 0;
		f += nlwExtra;
	}
}

void
omron88kBmGiveUp(omron_fb_info)
OmronFbInfoPtr omron_fb_info;
{
	omron88kBmFbClear(omron_fb_info);
	omron88kBmFbClose(omron_fb_info);
	omron88kBmPalClose(omron_fb_info);
}
#endif