通过linux实现arm三原色的显示 include, linux, color

yuyang911220

#include <stdio.h>
#include <signal.h>
#include <stdlib.h>
#include <unistd.h>
#include <string.h>
#include <linux/fb.h>

#include <fcntl.h>
#include <sys/types.h>
#include <sys/mman.h>
#include <sys/ioctl.h>

enum color{red, green, blue};


unsigned long *create_pixel(struct fb_var_screeninfo *pinfo,
                               enum color c)
{
        unsigned long *pixel = calloc(1, pinfo->bits_per_pixel/8);
        unsigned long *mask  = calloc(1, pinfo->bits_per_pixel/8);
        *mask |= 0x1;

        int i;
        switch(c)
        {
        case red:
                for(i=0; i<pinfo->red.length-1; i++)
                {
                        *mask <<= 1;
                        *mask |= 0x1;
                }
                *pixel |= *mask << pinfo->red.offset;
                break;
        case green:
                for(i=0; i<pinfo->green.length-1; i++)
                {
                        *mask <<= 1;
                        *mask |= 0x1;
        ：        }
                *pixel |= *mask << pinfo->green.offset;
                break;
        case blue:
                for(i=0; i<pinfo->blue.length-1; i++)
                {
                        *mask <<= 1;
                        *mask |= 0x1;
                }
                *pixel |= *mask << pinfo->blue.offset;
        }

        return pixel;
}

int main(void)
{
        // fb = frame buffer
        int lcd = open("/dev/fb0", O_RDWR);
        if(lcd == -1)
        {
                perror("open(\"/dev/fb0\")");
                exit(1);
        }

        struct fb_fix_screeninfo finfo;
        struct fb_var_screeninfo vinfo;
        ioctl(lcd, FBIOGET_FSCREENINFO, &finfo);
        ioctl(lcd, FBIOGET_VSCREENINFO, &vinfo);


        vinfo.xoffset = 0;
        vinfo.yoffset = 0;
        ioctl(lcd, FBIOPAN_DISPLAY, &vinfo);

        unsigned long bpp = vinfo.bits_per_pixel;
        

        unsigned long *pixel[3] = {0};
        pixel[0] = create_pixel(&vinfo, red);
        pixel[1] = create_pixel(&vinfo, green);
        pixel[2] = create_pixel(&vinfo, blue);


        char *FB = mmap(NULL, vinfo.xres * vinfo.yres * bpp/8,
                        PROT_READ | PROT_WRITE, MAP_SHARED,
                        lcd, 0);
        int k;
        for(k=0; ;k++)
        {
                int i;
                for(i=0; i<vinfo.xres * vinfo.yres; i++)
                {
                        memcpy(FB+i*bpp/8, pixel[k%3], bpp/8);
                }
                sleep(1);
        }

        return 0;
}