/**************************************************************************
fb.c 0.2 Copyright (C) 2002, hito
**************************************************************************/
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <fcntl.h>
#include <limits.h>
#include <errno.h>
#include <sys/ioctl.h>
#include <sys/mman.h>
#include <linux/fb.h>
#include "fb.h"
#define FB_ENV "FRAMEBUFFER"
#define FB_DEFDEV "/dev/fb0"
#define FALSE 0
#define TRUE 1
static struct fb_cmap* fb_cmap_create(struct fb_fix_screeninfo*, struct fb_var_screeninfo *);
static void fb_cmap_destroy(struct fb_cmap *cmap);
static int fb_fscrn_get(int fbfp, struct fb_fix_screeninfo *scinfo);
static void *fb_mmap(int fbfp, struct fb_fix_screeninfo *scinfo);
static int fb_munmap(void* buf,struct fb_fix_screeninfo *scinfo);
static int fb_vscrn_get(int fbfp, struct fb_var_screeninfo *scinfo);
static struct fb_fix_screeninfo fscinfo;
static struct fb_var_screeninfo vscinfo;
static struct fb_cmap *cmap = NULL;
static int is_open = FALSE;
static int fbfp = -1;
static unsigned char *buf=NULL;
int fb_open(void){
char *fbdev = {FB_DEFDEV};
if(is_open == TRUE)
return 1;
if(getenv(FB_ENV)){
fbdev=getenv(FB_ENV);
}
if((fbfp = open(fbdev,O_RDWR))==-1){
fprintf(stderr, "open %s error\n",fbdev);
goto ERR_END;
}
if(fb_fscrn_get(fbfp,&fscinfo)){
goto ERR_END;
}
if(fb_vscrn_get(fbfp,&vscinfo)){
goto ERR_END;
}
if((cmap = fb_cmap_create(&fscinfo,&vscinfo)) == (struct fb_cmap*) -1){
goto ERR_END;
}
if(!(buf = fb_mmap(fbfp,&fscinfo))){
fprintf(stderr, "Can't allocate memory.\n");
goto ERR_END;
}
if(fscinfo.type!=FB_TYPE_PACKED_PIXELS){
fprintf(stderr, "This type of framebuffer is not supported.\n");
goto ERR_END;
}
/*
if(fscinfo.visual == FB_VISUAL_PSEUDOCOLOR){
printf("FB_VISUAL_PSEUDOCOLOR\n");
if(vscinfo.bits_per_pixel!=8){
fprintf(stderr, "̤�б��ե졼��Хåե�\n");
goto ERR_END;
}
if(fb_cmap_get(fbfp,cmap)){
fprintf(stderr, "���顼�ޥå׳�������\n");
// fb_cmap_destroy(cmap);
goto ERR_END;
}
// fb_cmap_disp(cmap);
if(cmap->len <(LINUX_LOGO_COLORS + LOGO_COLOR_OFFSET)){
fprintf(stderr, "���γ����ΰ褬�����Ƥ��ޤ�\n");
goto ERR_END;
}
cmap->start = LOGO_COLOR_OFFSET;
cmap->len = LINUX_LOGO_COLORS;
for(lp = 0; lp < LINUX_LOGO_COLORS; lp++){
if(cmap->red){
*(cmap->red+lp) = (linux_logo_red[lp]<<CHAR_BIT)+linux_logo_red[lp];
}
if(cmap->green){
*(cmap->green+lp)= (linux_logo_green[lp]<<CHAR_BIT)+linux_logo_green[lp];
}
if(cmap->blue){
*(cmap->blue+lp)= (linux_logo_blue[lp]<<CHAR_BIT)+linux_logo_blue[lp];
}
}
if(fb_cmap_set(fbfp,cmap)){
fb_cmap_destroy(cmap);
fprintf(stderr, "���顼�ޥå׳�������\n");
goto ERR_END;
}
}
*/
if(!(fscinfo.visual == FB_VISUAL_TRUECOLOR &&
(vscinfo.bits_per_pixel == 15 ||
vscinfo.bits_per_pixel == 16 ||
vscinfo.bits_per_pixel == 24 ||
vscinfo.bits_per_pixel == 32))){
fprintf(stderr,"This type of framebuffer is not supported.\n");
goto ERR_END;
}
is_open = TRUE;
return 0;
ERR_END:
fb_close();
return 1;
}
void fb_close(void)
{
if(is_open != TRUE)
return;
if(cmap != NULL){
fb_cmap_destroy(cmap);
cmap = NULL;
}
if(buf != NULL){
fb_munmap(buf,&fscinfo);
buf = NULL;
}
if(fbfp >= 0){
close(fbfp);
}
is_open = FALSE;
}
void fb_pset(int x, int y, int r, int g, int b)
{
unsigned long work;
int offset;
static size_t size = 0;
if(is_open != TRUE || x >= vscinfo.xres || y >= vscinfo.yres)
return;
if(size == 0)
size = (vscinfo.bits_per_pixel + 7) / CHAR_BIT;
offset = fscinfo.line_length * y + size * x;
if(offset >= fscinfo.smem_len)
return;
work=
((r >> (CHAR_BIT - vscinfo.red.length )) << vscinfo.red.offset)+
((g >> (CHAR_BIT - vscinfo.green.length)) << vscinfo.green.offset)+
((b >> (CHAR_BIT - vscinfo.blue.length )) << vscinfo.blue.offset);
memcpy(buf + offset, &work, size);
}
int fb_get_color(int x, int y, int *r, int *g, int *b)
{
unsigned long work = 0;
int offset;
static size_t size = 0;
if(is_open != TRUE || x >= vscinfo.xres || y >= vscinfo.yres)
return 1;
if(size == 0)
size = (vscinfo.bits_per_pixel + 7) / CHAR_BIT;
offset = fscinfo.line_length * y + size * x;
if(offset >= fscinfo.smem_len)
return 1;
memcpy(&work, buf + offset, size);
*r = ((work >> vscinfo.red.offset) & (0x000000ff >> (CHAR_BIT - vscinfo.red.length)))
<< (CHAR_BIT - vscinfo.red.length);
*g = ((work >> vscinfo.green.offset) & (0x000000ff >> (CHAR_BIT - vscinfo.green.length)))
<<(CHAR_BIT - vscinfo.green.length);
*b = ((work >> vscinfo.blue.offset) & (0x000000ff >> (CHAR_BIT - vscinfo.blue.length)))
<< (CHAR_BIT - vscinfo.blue.length);
return 0;
}
void fb_clear(void)
{
if(is_open != TRUE)
return;
memset(buf, 0, (vscinfo.xres * vscinfo.yres * vscinfo.bits_per_pixel) / CHAR_BIT);
}
int fb_width(void)
{
if(is_open != TRUE)
return 0;
return vscinfo.xres;
}
int fb_height(void)
{
if(is_open != TRUE)
return 0;
return vscinfo.yres;
}
void fb_cmap_disp(void)
{
int lp;
if(is_open != TRUE)
return;
printf("cmap DUMP\n");
printf("start :[%08x]\n", cmap->start);
printf("len :[%08x]\n", cmap->len);
printf("red :[%8p]\n", cmap->red);
if(cmap->red){
for(lp=0;lp<cmap->len;lp++){
if((lp+1)%16==0) printf("%04x\n",*(cmap->red+lp));
else printf("%04x ",*(cmap->red+lp));
}
if(lp%16) printf("\n");
}
printf("green :[%8p]\n",cmap->green);
if(cmap->green){
for(lp=0;lp<cmap->len;lp++){
if((lp+1)%16==0) printf("%04x\n",*(cmap->green+lp));
else printf("%04x ",*(cmap->green+lp));
}
if(lp%16) printf("\n");
}
printf("blue :[%8p]\n",cmap->blue);
if(cmap->blue){
for(lp=0;lp<cmap->len;lp++){
if((lp+1)%16==0) printf("%04x\n",*(cmap->blue+lp));
else printf("%04x ",*(cmap->blue+lp));
}
if(lp%16) printf("\n");
}
printf("transp :[%8p]\n",cmap->transp);
if(cmap->transp){
for(lp=0;lp<cmap->len;lp++){
if((lp+1)%16==0) printf("%04x\n",*(cmap->transp+lp));
else printf("%04x ",*(cmap->transp+lp));
}
if(lp%16) printf("\n");
}
return;
}
void fb_fscrn_disp(void)
{
if(is_open != TRUE)
return;
printf("scinfo[%8p] DUMP\n", &fscinfo);
printf("id :[%s]\n", fscinfo.id);
printf("smem_start :[%08lx]\n", fscinfo.smem_start);
printf("smem_len :[%d]\n", fscinfo.smem_len);
printf("type :[%d] ", fscinfo.type);
switch(fscinfo.type){
case FB_TYPE_PACKED_PIXELS:
printf("FB_TYPE_PACKED_PIXELS\n");break;
case FB_TYPE_PLANES:
printf("FB_TYPE_PLANES\n");break;
case FB_TYPE_INTERLEAVED_PLANES:
printf("FB_TYPE_INTERLEAVED_PLANES\n");break;
case FB_TYPE_TEXT:
printf("FB_TYPE_TEXT\n");break;
default:printf("Unknown type.\n");
}
printf("type_aux :[%d] ",fscinfo.type_aux);
switch(fscinfo.type_aux){
case FB_AUX_TEXT_MDA:
printf("FB_AUX_TEXT_MDA\n");break;
case FB_AUX_TEXT_CGA:
printf("FB_AUX_TEXT_CGA\n");break;
case FB_AUX_TEXT_S3_MMIO:
printf("FB_AUX_TEXT_S3_MMIO\n");break;
case FB_AUX_TEXT_MGA_STEP16:
printf("FB_AUX_TEXT_MGA_STEP16\n");break;
case FB_AUX_TEXT_MGA_STEP8:
printf("FB_AUX_TEXT_MGA_STEP8\n");break;
default:printf("Unknown type_aux.\n");
}
printf("visual :[%d] ",fscinfo.visual);
switch(fscinfo.visual){
case FB_VISUAL_MONO01:
printf("FB_VISUAL_MONO01\n");break;
case FB_VISUAL_MONO10:
printf("FB_VISUAL_MONO10\n");break;
case FB_VISUAL_TRUECOLOR:
printf("FB_VISUAL_TRUECOLOR\n");break;
case FB_VISUAL_PSEUDOCOLOR:
printf("FB_VISUAL_PSEUDOCOLOR\n");break;
case FB_VISUAL_DIRECTCOLOR:
printf("FB_VISUAL_DIRECTCOLOR\n");break;
case FB_VISUAL_STATIC_PSEUDOCOLOR:
printf("FB_VISUAL_STATIC_PSEUDOCOLOR\n");break;
default:printf("Unknown Visual mode.\n");
}
printf("xpanstep :[%d]\n",fscinfo.xpanstep);
printf("ypanstep :[%d]\n",fscinfo.ypanstep);
printf("ywrapstep :[%d]\n",fscinfo.ywrapstep);
printf("line_length :[%d]\n",fscinfo.line_length);
printf("mmio_start :[%08lx]\n",fscinfo.mmio_start);
printf("mmio_len :[%d]\n",fscinfo.mmio_len);
printf("accel :[%d] ",fscinfo.accel);
switch(fscinfo.accel){
case FB_ACCEL_NONE:
printf("FB_ACCEL_NONE\n");break;
case FB_ACCEL_ATARIBLITT:
printf("FB_ACCEL_ATARIBLITT\n");break;
case FB_ACCEL_AMIGABLITT:
printf("FB_ACCEL_AMIGABLITT\n");break;
case FB_ACCEL_S3_TRIO64:
printf("FB_ACCEL_S3_TRIO64\n");break;
case FB_ACCEL_NCR_77C32BLT:
printf("FB_ACCEL_NCR_77C32BLT\n");break;
case FB_ACCEL_S3_VIRGE:
printf("FB_ACCEL_S3_VIRGE\n");break;
case FB_ACCEL_ATI_MACH64GX:
printf("FB_ACCEL_ATI_MACH64GX\n");break;
case FB_ACCEL_DEC_TGA:
printf("FB_ACCEL_DEC_TGA\n");break;
case FB_ACCEL_ATI_MACH64CT:
printf("FB_ACCEL_ATI_MACH64CT\n");break;
case FB_ACCEL_ATI_MACH64VT:
printf("FB_ACCEL_ATI_MACH64VT\n");break;
case FB_ACCEL_ATI_MACH64GT:
printf("FB_ACCEL_ATI_MACH64GT\n");break;
case FB_ACCEL_SUN_CREATOR:
printf("FB_ACCEL_SUN_CREATOR\n");break;
case FB_ACCEL_SUN_CGSIX:
printf("FB_ACCEL_SUN_CGSIX\n");break;
case FB_ACCEL_SUN_LEO:
printf("FB_ACCEL_SUN_LEO\n");break;
case FB_ACCEL_IMS_TWINTURBO:
printf("FB_ACCEL_IMS_TWINTURBO\n");break;
case FB_ACCEL_3DLABS_PERMEDIA2:
printf("FB_ACCEL_3DLABS_PERMEDIA2\n");break;
case FB_ACCEL_MATROX_MGA2064W:
printf("FB_ACCEL_MATROX_MGA2064W\n");break;
case FB_ACCEL_MATROX_MGA1064SG:
printf("FB_ACCEL_MATROX_MGA1064SG\n");break;
case FB_ACCEL_MATROX_MGA2164W:
printf("FB_ACCEL_MATROX_MGA2164W\n");break;
case FB_ACCEL_MATROX_MGA2164W_AGP:
printf("FB_ACCEL_MATROX_MGA2164W_AGP\n");break;
case FB_ACCEL_MATROX_MGAG100:
printf("FB_ACCEL_MATROX_MGAG100\n");break;
case FB_ACCEL_MATROX_MGAG200:
printf("FB_ACCEL_MATROX_MGAG200\n");break;
case FB_ACCEL_SUN_CG14:
printf("FB_ACCEL_SUN_CG14\n");break;
case FB_ACCEL_SUN_BWTWO:
printf("FB_ACCEL_SUN_BWTWO\n");break;
case FB_ACCEL_SUN_CGTHREE:
printf("FB_ACCEL_SUN_CGTHREE\n");break;
case FB_ACCEL_SUN_TCX:
printf("FB_ACCEL_SUN_TCX\n");break;
default:printf("Unknown Visual mode.\n");
}
return;
}
void fb_vscrn_disp(void)
{
if(is_open != TRUE)
return;
printf("vscinfo DUMP\n");
printf("xres :[%d]\n",vscinfo.xres);
printf("yres :[%d]\n",vscinfo.yres);
printf("xres_virtual :[%d]\n",vscinfo.xres_virtual);
printf("yres_virtual :[%d]\n",vscinfo.yres_virtual);
printf("xoffset :[%d]\n",vscinfo.xoffset);
printf("yoffset :[%d]\n",vscinfo.yoffset);
printf("bits_per_pixel :[%d]\n",vscinfo.bits_per_pixel);
printf("grayscale :[%d]\n",vscinfo.grayscale);
printf("red.offset :[%d]\n",vscinfo.red.offset);
printf("red.length :[%d]\n",vscinfo.red.length);
printf("red.msb_right :[%d]\n",vscinfo.red.msb_right);
printf("green.offset :[%d]\n",vscinfo.green.offset);
printf("green.length :[%d]\n",vscinfo.green.length);
printf("green.msb_right :[%d]\n",vscinfo.green.msb_right);
printf("blue.offset :[%d]\n",vscinfo.blue.offset);
printf("blue.length :[%d]\n",vscinfo.blue.length);
printf("blue.msb_right :[%d]\n",vscinfo.blue.msb_right);
printf("transp.offset :[%d]\n",vscinfo.transp.offset);
printf("transp.length :[%d]\n",vscinfo.transp.length);
printf("transp.msb_right:[%d]\n",vscinfo.transp.msb_right);
printf("nonstd :[%d]\n",vscinfo.nonstd);
printf("activate :[%d]\n",vscinfo.activate);
printf("height :[%d]\n",vscinfo.height);
printf("width :[%d]\n",vscinfo.width);
printf("accel_flags :[%d]\n",vscinfo.accel_flags);
printf("pixclock :[%d]\n",vscinfo.pixclock);
printf("left_margin :[%d]\n",vscinfo.left_margin);
printf("right_margin :[%d]\n",vscinfo.right_margin);
printf("upper_margin :[%d]\n",vscinfo.upper_margin);
printf("lower_margin :[%d]\n",vscinfo.lower_margin);
printf("hsync_len :[%d]\n",vscinfo.hsync_len);
printf("vsync_len :[%d]\n",vscinfo.vsync_len);
printf("sync :[%d]\n",vscinfo.sync);
printf("vmode :[%d]\n",vscinfo.vmode);
return;
}
/********* static functions **************/
/*
(struct fb_cmap)�ǥХ����˰�¸���ʤ����顼�ޥå���
fb_cmap_create() �����Υ��顼�ޥå���
fb_cmap_destroy() ���顼�ޥå�����˴�
fb_cmap_disp() �����ɽ��
fb_cmap_get() ������
fb_cmap_set() ���������
*/
#define LUT_MAX (256)
static struct fb_cmap* fb_cmap_create(struct fb_fix_screeninfo* fscinfo,
struct fb_var_screeninfo *vscinfo)
{
struct fb_cmap* cmap;
int cmaplen=LUT_MAX;
/* ���顼�ޥåפ�¸�ߥ����å� */
if(fscinfo->visual==FB_VISUAL_MONO01 ||
fscinfo->visual==FB_VISUAL_MONO10 ||
fscinfo->visual==FB_VISUAL_TRUECOLOR) return NULL;
cmap=(struct fb_cmap*)malloc(sizeof(struct fb_cmap));
if(!cmap){
perror("cmap malloc error\n");
return (struct fb_cmap*)-1;
}
memset(cmap,0,sizeof(struct fb_cmap));
/* ��ʬ����¸�ߤ��������ä��饫�顼�ޥå��Ѥ��ΰ����� */
if(vscinfo->red.length){
cmap->red=(__u16*)malloc(sizeof(__u16)*cmaplen);
if(!cmap->red){
perror("red lut malloc error\n");
return (struct fb_cmap*)-1;
}
}
if(vscinfo->green.length){
cmap->green=(__u16*)malloc(sizeof(__u16)*cmaplen);
if(!cmap->green){
if(vscinfo->red.length) free(cmap->red);
perror("green lut malloc error\n");
return (struct fb_cmap*)-1;
}
}
if(vscinfo->blue.length){
cmap->blue=(__u16*)malloc(sizeof(__u16)*cmaplen);
if(!cmap->blue){
if(vscinfo->red.length) free(cmap->red);
if(vscinfo->green.length) free(cmap->green);
perror("blue lut malloc error\n");
return (struct fb_cmap*)-1;
}
}
if(vscinfo->transp.length){
cmap->transp=(__u16*)malloc(sizeof(__u16)*cmaplen);
if(!cmap->transp){
if(vscinfo->red.length) free(cmap->red);
if(vscinfo->green.length) free(cmap->green);
if(vscinfo->blue.length) free(cmap->blue);
perror("transp lut malloc error\n");
return (struct fb_cmap*)-1;
}
}
cmap->len=cmaplen;
return cmap;
}
static void fb_cmap_destroy(struct fb_cmap* cmap)
{
if(cmap->red) free(cmap->red);
if(cmap->green) free(cmap->green);
if(cmap->blue) free(cmap->blue);
if(cmap->transp) free(cmap->transp);
free(cmap);
}
/*
static int fb_cmap_get(int fbfp,struct fb_cmap* cmap)
{
if(ioctl(fbfp,FBIOGETCMAP,cmap)){
perror("ioctl FBIOGETCMAP error\n");
return -1;
}
return 0;
}
static int fb_cmap_set(int fbfp,struct fb_cmap* cmap)
{
if(ioctl(fbfp,FBIOPUTCMAP,cmap)){
perror("ioctl FBIOPUTCMAP error\n");
return -1;
}
return 0;
}
*/
/*
�ե졼��Хåե����Ф��륢������
fb_mmap() �ե졼��Хåե��Υ����ؤΥޥå�
fb_munmap() �ե졼��Хåե��Υ���夫��Υ���ޥå�
*/
static void *fb_mmap(int fbfp, struct fb_fix_screeninfo* scinfo)
{
void *buf;
if((buf=(unsigned char*)
mmap(NULL, scinfo->smem_len, PROT_READ|PROT_WRITE,MAP_SHARED, fbfp, (off_t)0))
==MAP_FAILED){
perror("mmap error");
return NULL;
}
return buf;
}
static int fb_munmap(void* buf,struct fb_fix_screeninfo* scinfo)
{
return munmap(buf,scinfo->smem_len);
}
/*
(struct fb_fix_screeninfo)�ǥХ����˰�¸���ʤ����ꤵ�줿����
fb_fscrn_disp() �����ɽ��
fb_fscrn_get() ������
*/
static int fb_fscrn_get(int fbfp,struct fb_fix_screeninfo* scinfo)
{
if(ioctl(fbfp,FBIOGET_FSCREENINFO,scinfo)){
perror("ioctl FBIOGET_FSCREENINFO error\n");
return -1;
}
return 0;
}
/*
(struct fb_var_screeninfo)�ǥХ����˰�¸���ʤ��ѹ���ǽ�ʾ���
fb_vscrn_disp() �����ɽ��
fb_vscrn_get() ������
fb_vscrn_set() ���������
*/
static int fb_vscrn_get(int fbfp,struct fb_var_screeninfo* scinfo)
{
if(ioctl(fbfp,FBIOGET_VSCREENINFO,scinfo)){
perror("ioctl FBIOGET_VSCREENINFO error\n");
return -1;
}
return 0;
}
/*
static int fb_vscrn_set(int fbfp,struct fb_var_screeninfo* scinfo)
{
if(ioctl(fbfp,FBIOPUT_VSCREENINFO,scinfo)){
perror("ioctl FBIOPUT_VSCREENINFO error\n");
return -1;
}
return 0;
}
*/
