将bmp格式文件写到Lcd

#include <unistd.h>
#include <stdio.h>
#include <stdlib.h>
#include <fcntl.h>
#include <string.h>
#include <linux/fb.h>
#include <sys/mman.h>
#include <sys/ioctl.h>
#include <arpa/inet.h>

typedef struct {
    char cfType[2];
    long cfSize;
    long cfReserved;
    long cfoffBits;
}__attribute__((packed)) BITMAPFILEHEADER;

typedef struct
{
    char ciSize[4];
    long ciWidth;
    long ciHeight;
    char ciPlanes[2];
    int ciBitCount;
    char ciCompress[4];
    char ciSizeImage[4];
    char ciXPelsPerMeter[4];
    char ciYPelsPerMeter[4];
    char ciClrUsed[4];
    char ciClrImportant[4];
}__attribute__((packed)) BITMAPINFOHEADER;

typedef struct
{
    char r;
    char g;
    char b;
}__attribute__((packed)) PIXEL;

BITMAPFILEHEADER FileHead;
BITMAPINFOHEADER InfoHead;

static char *fbp = 0;
static int xres = 0;
static int yres = 0;
static int bits_per_pixel = 0;

int show_bmp();

int main ( int argc, char *argv[] )
{
    int fbfd = 0;
    struct fb_var_screeninfo vinfo;
    struct fb_fix_screeninfo finfo;
    long int screensize = 0;

    fbfd = open("/dev/graphics/fb0", O_RDWR);
    if (!fbfd)
    {
        printf("Error: cannot open framebuffer device.\n");
        exit(1);
    }
    if (ioctl(fbfd, FBIOGET_FSCREENINFO, &finfo))
    {
        printf("Error：reading fixed information.\n");
        exit(2);
    }

    if (ioctl(fbfd, FBIOGET_VSCREENINFO, &vinfo))
    {
        printf("Error: reading variable information.\n");
        exit(3);
    }

    printf("%dx%d, %dbpp\n", vinfo.xres, vinfo.yres, vinfo.bits_per_pixel );
    xres = vinfo.xres;
    yres = vinfo.yres;
    bits_per_pixel = vinfo.bits_per_pixel;

    screensize = vinfo.xres * vinfo.yres * vinfo.bits_per_pixel / 8;
    printf("screensize=%d\n",(int)screensize);

    fbp = (char *)mmap(0, screensize, PROT_READ | PROT_WRITE, MAP_SHARED, fbfd, 0);
    if ((int)fbp == -1)
    {
        printf("Error: failed to map framebuffer device to memory.\n");
        exit(4);
    }
    printf("sizeof header=%d\n", sizeof(BITMAPFILEHEADER));

    printf("into show_bmp function\n");

    while(1)
    {
        show_bmp();
    }

    munmap(fbp, screensize);
    close(fbfd);
    return 0;
}

int show_bmp()
{
    FILE *fp;
    int rc;
    int line_x, line_y;
    long int location = 0, BytesPerLine = 0;
    char tmp[1024*10];

    fp = fopen( "/data/test.bmp", "rb" );
    if (fp == NULL)
    {
        return( -1 );
    }

    rc = fread( &FileHead, sizeof(BITMAPFILEHEADER),1, fp );
    if ( rc != 1)
    {
        printf("read header error!\n");
        fclose( fp );
        return( -2 );
    }

    if (memcmp(FileHead.cfType, "BM", 2) != 0)
    {
        printf("it's not a BMP file\n");
        fclose( fp );
        return( -3 );
    }

    rc = fread( (char *)&InfoHead, sizeof(BITMAPINFOHEADER),1, fp );
    if ( rc != 1)
    {
        printf("read infoheader error!\n");
        fclose( fp );
        return( -4 );
    }

    else
    {
        int ciWidth = (int)(InfoHead.ciWidth); //the width
        int ciHeight = (int)(InfoHead.ciHeight);//the height
        int ciBitCount = (int)(InfoHead.ciBitCount); //the number of colors
        printf("InfoHead height=%d\n", ciHeight);
        printf("InfoHead wdith=%d\n", ciWidth);
        printf("InfoHead bitCount==%d\n", ciBitCount);
    }

    fseek(fp, FileHead.cfoffBits, SEEK_SET);
    BytesPerLine = (InfoHead.ciWidth * InfoHead.ciBitCount + 31) / 32 * 4;

    line_x = line_y = 0;
    while(!feof(fp))
    {
        PIXEL pix;
        unsigned int tmp;
        rc = fread(&pix, 1, sizeof(pix), fp);
        if (rc != sizeof(pix))
        {
            break;
        }
        tmp=pix.r|pix.g<<8|pix.b<<16;
        //tmp=pix.r<<16|pix.g<<8|pix.b;
        *(fbp + location) = tmp;
        location+=4;
    }
    printf("the location is %d\n",(int)location);
    fclose( fp );
    return( 0 );
}