scr_ecos.c

开放源码实时操作系统源码.

/*
 * Copyright (c) 1999, 2000, 2002 Greg Haerr <[e-mail]>
 *
 * Microwindows Screen Driver for Linux kernel framebuffers
 *
 * Portions used from Ben Pfaff's BOGL <[e-mail]>
 *
 * Modified for eCos by
 *   Gary Thomas <[e-mail]>
 *   Richard Panton <[e-mail]>
 * 
 * Note: modify select_fb_driver() to add new framebuffer subdrivers
 */
#define _GNU_SOURCE 1

#include <pkgconf/system.h>
#ifdef CYGPKG_HAL_ARM

#include <assert.h>
#include <fcntl.h>
#include <limits.h>
#include <cyg/hal/drv_api.h>
#include <cyg/infra/diag.h>
#include <cyg/io/io.h>
#include <stdarg.h>
#include <stdio.h>
#include <stdlib.h>
#include <sys/stat.h>
#include <sys/time.h>
#include <sys/types.h>
#include <unistd.h>
#include "device.h"
#include "genfont.h"
#include "genmem.h"
#include "fb.h"
#include <cyg/hal/lcd_support.h>

static PSD  fb_open(PSD psd);
static void fb_close(PSD psd);
static void fb_setpalette(PSD psd,int first, int count, MWPALENTRY *palette);
static void gen_getscreeninfo(PSD psd,PMWSCREENINFO psi);
static void set_portrait_mode(PSD psd, int portraitmode);

SCREENDEVICE	scrdev = {
	0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, NULL,
	fb_open,
	fb_close,
	gen_getscreeninfo,
	fb_setpalette,
	NULL,			/* DrawPixel subdriver*/
	NULL,			/* ReadPixel subdriver*/
	NULL,			/* DrawHorzLine subdriver*/
	NULL,			/* DrawVertLine subdriver*/
	NULL,			/* FillRect subdriver*/
	gen_fonts,
	NULL,			/* Blit subdriver*/
	NULL,			/* PreSelect*/
	NULL,			/* DrawArea subdriver*/
	NULL,			/* SetIOPermissions*/
	gen_allocatememgc,
	fb_mapmemgc,
	gen_freememgc,
	NULL,			/* StretchBlit subdriver*/
	set_portrait_mode	/* SetPortrait*/
};

/* static variables*/
static int status;		/* 0=never inited, 1=once inited, 2=inited. */
#if 0
static short saved_red[256];	/* original hw palette*/
static short saved_green[256];
static short saved_blue[256];
#endif
extern SUBDRIVER fbportrait_left, fbportrait_right, fbportrait_down;

/* local functions*/
static void	set_directcolor_palette(PSD psd);

/* init framebuffer*/
static PSD
fb_open(PSD psd)
{
    PSUBDRIVER subdriver;
    struct lcd_info li;

    assert(status < 2);

    // Initialize LCD screen
    lcd_init(16);
    lcd_getinfo(&li);

    psd->xres = psd->xvirtres = li.width;
    psd->yres = psd->yvirtres = li.height;
    psd->portrait = MWPORTRAIT_NONE;

    /* set planes from fb type*/
    if (1 /*type == FB_TYPE_PACKED_PIXELS*/)
        psd->planes = 1;   /* FIXME */
    else psd->planes = 0;	/* force error later*/

    psd->bpp = li.bpp;
    psd->ncolors = (psd->bpp >= 24)? (1 << 24): (1 << psd->bpp);

    /* set linelen to byte length, possibly converted later*/
    psd->linelen = li.rlen;
    psd->size = 0;		/* force subdriver init of size*/

    psd->flags = PSF_SCREEN | PSF_HAVEBLIT;
    if (psd->bpp == 16)
        psd->flags |= PSF_HAVEOP_COPY;

    /* set pixel format*/
    switch (li.type) {
#ifdef FB_TRUE_RGB555
    case FB_TRUE_RGB555:
        psd->pixtype = MWPF_TRUECOLOR555;
        break;
#endif
#ifdef FB_TRUE_RGB565
    case FB_TRUE_RGB565:
        psd->pixtype = MWPF_TRUECOLOR565;
        break;
#endif
    default:
        EPRINTF("Unsupported display type: %d\n", li.type);
        goto fail;
    }
#if 0
    if(1 /*visual == FB_VISUAL_TRUECOLOR || visual == FB_VISUAL_DIRECTCOLOR*/) {
        switch(psd->bpp) {
        case 8:
            psd->pixtype = MWPF_TRUECOLOR332;
            break;
        case 16:
            psd->pixtype = MWPF_TRUECOLOR565;
            break;
        case 24:
            psd->pixtype = MWPF_TRUECOLOR888;
            break;
        case 32:
            psd->pixtype = MWPF_TRUECOLOR0888;
            break;
        default:
            EPRINTF(
                "Unsupported %d color (%d bpp) truecolor framebuffer\n",
                psd->ncolors, psd->bpp);
            goto fail;
        }
    } else psd->pixtype = MWPF_PALETTE;
#endif

    diag_printf("%dx%dx%d linelen %d type %d bpp %d\n", psd->xres,
      psd->yres, psd->ncolors, psd->linelen, li.type, psd->bpp);

    /* select a framebuffer subdriver based on planes and bpp*/
    subdriver = select_fb_subdriver(psd);
    if (!subdriver) {
        EPRINTF("No driver for screen\n", psd->bpp);
        goto fail;
    }

    /*
     * set and initialize subdriver into screen driver
     * psd->size is calculated by subdriver init
     */
    if(!set_subdriver(psd, subdriver, TRUE)) {
        EPRINTF("Driver initialize failed\n", psd->bpp);
        goto fail;
    }
    /* Remember this as the original (HW) subdriver */
    psd->orgsubdriver = subdriver;

    /* mmap framebuffer into this address space*/
    psd->addr = li.fb;
    if(psd->addr == NULL || psd->addr == (unsigned char *)-1) {
//        EPRINTF("Error mmaping %s: %m\n", env);
        goto fail;
    }

#if 0    /* FIXME */
    /* save original palette*/
    ioctl_getpalette(0, 16, saved_red, saved_green, saved_blue);

    /* setup direct color palette if required (ATI cards)*/
    if(visual == FB_VISUAL_DIRECTCOLOR)
        set_directcolor_palette(psd);
#endif

    status = 2;
    return psd;	/* success*/

 fail:
    return NULL;
}

/* close framebuffer*/
static void
fb_close(PSD psd)
{
    printf("%s - NOT IMPLEMENTED\n", __FUNCTION__);
#if 0
	int	tty;

	/* if not opened, return*/
	if(status != 2)
		return;
	status = 1;

  	/* reset hw palette*/
	ioctl_setpalette(0, 256, saved_red, saved_green, saved_blue);
  
	/* unmap framebuffer*/
	// munmap(psd->addr, psd->size);
  
	/* close framebuffer*/
	close(fb);
#endif
}

/* setup directcolor palette - required for ATI cards*/
static void
set_directcolor_palette(PSD psd)
{
    printf("%s - NOT IMPLEMENTED\n", __FUNCTION__);  while (1) ;
#if 0
	int i;
	short r[256], g[256], b[256];

	/* 16bpp uses 32 palette entries*/
	if(psd->bpp == 16) {
		/* FIXME: this still doesn't work*/
		for(i=0; i<32; ++i) {
			//r[i] = g[i] = b[i] = ((i<<11)|(i<<6)|i)<<8;
			//r[i] = g[i] = b[i] = ((i<<5)|i)<<10;
			//r[i] = g[i] = b[i] = i<<11;
			//r[i] = g[i] = b[i] = (i<<11) | (i<<3);
			r[i] = g[i] = b[i] = (i<<11);
			//r[i] = i << 8;
			//g[i] = i << 10;
			//b[i] = i << 8;
		}
		ioctl_setpalette(0, 32, r, g, b);
	} else {
		/* 32bpp uses 256 entries*/
		for(i=0; i<256; ++i)
			r[i] = i<<8;
		ioctl_setpalette(0, 256, r, r, r);
	}
#endif
}

static int fade = 100;

/* convert Microwindows palette to framebuffer format and set it*/
static void
fb_setpalette(PSD psd,int first, int count, MWPALENTRY *palette)
{
    printf("%s - NOT IMPLEMENTED\n", __FUNCTION__);  while (1) ;
#if 0
	int 	i;
	unsigned short 	red[count];
	unsigned short 	green[count];
	unsigned short 	blue[count];

	/* convert palette to framebuffer format*/
	for(i=0; i < count; i++) {
		MWPALENTRY *p = &palette[i];

		/* grayscale computation:
		 * red[i] = green[i] = blue[i] =
		 *	(p->r * 77 + p->g * 151 + p->b * 28);
		 */
		red[i] = (p->r * fade / 100) << 8;
		green[i] = (p->g * fade / 100) << 8;
		blue[i] = (p->b * fade / 100) << 8;
	}
	ioctl_setpalette(first, count, red, green, blue);
#endif
}

/* get framebuffer palette*/
void
ioctl_getpalette(int start, int len, short *red, short *green, short *blue)
{
    printf("%s - NOT IMPLEMENTED\n", __FUNCTION__);  while (1) ;
#if 0
	struct fb_cmap cmap;
	cyg_uint32 sz = sizeof(cmap);

	cmap.start = start;
	cmap.len = len;
	cmap.red = red;
	cmap.green = green;
	cmap.blue = blue;
	cmap.transp = NULL;

	cyg_io_get_config( fb_handle, CYG_IO_GET_CONFIG_FB_PALETTE, &cmap, &sz );
	// ioctl(fb, FBIOGETCMAP, &cmap);
#endif
}

/* set framebuffer palette*/
void
ioctl_setpalette(int start, int len, short *red, short *green, short *blue)
{
    printf("%s - NOT IMPLEMENTED\n", __FUNCTION__);  while (1) ;
#if 0
	struct fb_cmap cmap;
	cyg_uint32 sz = sizeof(cmap);

	cmap.start = start;
	cmap.len = len;
	cmap.red = red;
	cmap.green = green;
	cmap.blue = blue;
	cmap.transp = NULL;

	cyg_io_set_config( fb_handle, CYG_IO_SET_CONFIG_FB_PALETTE, &cmap, &sz );
	// ioctl(fb, FBIOPUTCMAP, &cmap);
#endif
}

/* experimental palette animation*/
void
setfadelevel(PSD psd, int f)
{
    printf("%s - NOT IMPLEMENTED\n", __FUNCTION__);  while (1) ;
#if 0
	int 		i;
	unsigned short 	r[256], g[256], b[256];
	extern MWPALENTRY gr_palette[256];

	if(psd->pixtype != MWPF_PALETTE)
		return;

	fade = f;
	if(fade > 100)
		fade = 100;
	for(i=0; i<256; ++i) {
		r[i] = (gr_palette[i].r * fade / 100) << 8;
		g[i] = (gr_palette[i].g * fade / 100) << 8;
		b[i] = (gr_palette[i].b * fade / 100) << 8;
	}
	ioctl_setpalette(0, 256, r, g, b);
#endif
}

static void
gen_getscreeninfo(PSD psd,PMWSCREENINFO psi)
{
    psi->rows = psd->yvirtres;
    psi->cols = psd->xvirtres;
    psi->planes = psd->planes;
    psi->bpp = psd->bpp;
    psi->ncolors = psd->ncolors;
    psi->pixtype = psd->pixtype;
    psi->fonts = NUMBER_FONTS;
    psi->portrait = psd->portrait;

    switch (psd->portrait) {
    case MWPORTRAIT_NONE:
        psi->fbdriver = psd->orgsubdriver;
        break;
    case MWPORTRAIT_RIGHT:
        psi->fbdriver = &fbportrait_right;
        break;
    case MWPORTRAIT_LEFT:
        psi->fbdriver = &fbportrait_left;
        break;
    case MWPORTRAIT_DOWN:
        psi->fbdriver = &fbportrait_down;
        break;
    }

    switch (psd->pixtype) {
    case MWPF_TRUECOLOR555:
        psi->rmask = 0x7c00;
        psi->gmask = 0x03e0;
        psi->bmask = 0x001f;
        break;
    case MWPF_TRUECOLOR565:
        psi->rmask = 0xf800;
        psi->gmask = 0x07e0;
        psi->bmask = 0x001f;
        break;
    default:
        printf("%s - unsupported pixtype\n", __FUNCTION__);
        psi->rmask = 0xff;
        psi->gmask = 0xff;
        psi->bmask = 0xff;
        break;
    }
        

#if 0
    if(psd->yvirtres > 480) {
        /* SVGA 800x600*/
        psi->xdpcm = 33;	/* assumes screen width of 24 cm*/
        psi->ydpcm = 33;	/* assumes screen height of 18 cm*/
    } else if(psd->yvirtres > 350) {
        /* VGA 640x480*/
        psi->xdpcm = 27;	/* assumes screen width of 24 cm*/
        psi->ydpcm = 27;	/* assumes screen height of 18 cm*/
    } else {
        /* EGA 640x350*/
        psi->xdpcm = 27;	/* assumes screen width of 24 cm*/
        psi->ydpcm = 19;	/* assumes screen height of 18 cm*/
    }
#else
    // FIXME
    psi->ydpcm = 42; // 320 / (3 * 2.54)
    psi->xdpcm = 38; //240 / (2.5 * 2.54)
#endif
}

static void
set_portrait_mode(PSD psd, int portraitmode)
{
    psd->portrait = portraitmode;
    switch (portraitmode) {
    case MWPORTRAIT_NONE:
        psd->xvirtres = psd->xres;
        psd->yvirtres = psd->yres;
        set_subdriver(psd, psd->orgsubdriver, FALSE);
        break;
    case MWPORTRAIT_RIGHT:
        psd->xvirtres = psd->yres;
        psd->yvirtres = psd->xres;
        set_subdriver(psd, &fbportrait_right, FALSE);
        break;
    case MWPORTRAIT_LEFT:
        psd->xvirtres = psd->yres;
        psd->yvirtres = psd->xres;
        set_subdriver(psd, &fbportrait_left, FALSE);
        break;
    case MWPORTRAIT_DOWN:
        psd->xvirtres = psd->xres;
        psd->yvirtres = psd->yres;
        set_subdriver(psd, &fbportrait_down, FALSE);
        break;
    default:
        break;
    }
}

#endif