qq.c

#include <stdlib.h>
#include <unistd.h>
#include <stdio.h>
#include <fcntl.h>
#include <linux/fb.h>
#include <linux/kd.h>
#include <sys/mman.h>
#include <sys/ioctl.h>
#include <sys/time.h>
#include <string.h>
#include <errno.h>


struct fb_var_screeninfo vinfo;
struct fb_fix_screeninfo finfo;
char *frameBuffer = 0;


//打印fb驱动中fix结构信息，注：在fb驱动加载后，fix结构不可被修改。
void printFixedInfo ()
{
    printf ("Fixed screen info:\n"
        "\tid: %s\n"
        "\tsmem_start: 0x%lx\n"
        "\tsmem_len: %d\n"
        "\ttype: %d\n"
        "\ttype_aux: %d\n"
        "\tvisual: %d\n"
        "\txpanstep: %d\n"
        "\typanstep: %d\n"
        "\tywrapstep: %d\n"
        "\tline_length: %d\n"
        "\tmmio_start: 0x%lx\n"
        "\tmmio_len: %d\n"
        "\taccel: %d\n"
        "\n",
        finfo.id, finfo.smem_start, finfo.smem_len, finfo.type,
        finfo.type_aux, finfo.visual, finfo.xpanstep, finfo.ypanstep,
        finfo.ywrapstep, finfo.line_length, finfo.mmio_start,
        finfo.mmio_len, finfo.accel);
}

//打印fb驱动中var结构信息，注：fb驱动加载后，var结构可根据实际需要被重置
void printVariableInfo ()
{
    printf ("Variable screen info:\n"
        "\txres: %d\n"
        "\tyres: %d\n"
        "\txres_virtual: %d\n"
        "\tyres_virtual: %d\n"
        "\tyoffset: %d\n"
        "\txoffset: %d\n"
        "\tbits_per_pixel: %d\n"
        "\tgrayscale: %d\n"
        "\tred: offset: %2d, length: %2d, msb_right: %2d\n"
        "\tgreen: offset: %2d, length: %2d, msb_right: %2d\n"
        "\tblue: offset: %2d, length: %2d, msb_right: %2d\n"
        "\ttransp: offset: %2d, length: %2d, msb_right: %2d\n"
        "\tnonstd: %d\n"
        "\tactivate: %d\n"
        "\theight: %d\n"
        "\twidth: %d\n"
        "\taccel_flags: 0x%x\n"
        "\tpixclock: %d\n"
        "\tleft_margin: %d\n"
        "\tright_margin: %d\n"
        "\tupper_margin: %d\n"
        "\tlower_margin: %d\n"
        "\thsync_len: %d\n"
        "\tvsync_len: %d\n"
        "\tsync: %d\n"
        "\tvmode: %d\n"
        "\n",
        vinfo.xres, vinfo.yres, vinfo.xres_virtual, vinfo.yres_virtual,
        vinfo.xoffset, vinfo.yoffset, vinfo.bits_per_pixel,
        vinfo.grayscale, vinfo.red.offset, vinfo.red.length,
        vinfo.red.msb_right, vinfo.green.offset, vinfo.green.length,
        vinfo.green.msb_right, vinfo.blue.offset, vinfo.blue.length,
        vinfo.blue.msb_right, vinfo.transp.offset, vinfo.transp.length,
        vinfo.transp.msb_right, vinfo.nonstd, vinfo.activate,
        vinfo.height, vinfo.width, vinfo.accel_flags, vinfo.pixclock,
        vinfo.left_margin, vinfo.right_margin, vinfo.upper_margin,
        vinfo.lower_margin, vinfo.hsync_len, vinfo.vsync_len,
        vinfo.sync, vinfo.vmode);
}

//画大小为width*height的同色矩阵，8alpha+8reds+8greens+8blues
void
drawRect_rgb32 (int x0, int y0, int width, int height, int color)
{
    const int bytesPerPixel = 4;
    const int stride = finfo.line_length / bytesPerPixel;
    int *dest = (int *) (frameBuffer)
        + (y0 + vinfo.yoffset) * stride + (x0 + vinfo.xoffset);


    int x, y;
    for (y = 0; y < height; ++y)
    {
        for (x = 0; x < width; ++x)
        {
            dest[x] = color;
        }
        dest += stride;
    }
}


//画大小为width*height的同色矩阵，5reds+6greens+5blues
void
drawRect_rgb16 (int x0, int y0, int width, int height, int color)
{
    const int bytesPerPixel = 2;
    const int stride = finfo.line_length / bytesPerPixel;
    const int red = (color & 0xff0000) >> (16 + 3);
    const int green = (color & 0xff00) >> (8 + 2);
    const int blue = (color & 0xff) >> 3;
    const short color16 = blue | (green << 5) | (red << (5 + 6));
    short *dest = (short *) (frameBuffer)
        + (y0 + vinfo.yoffset) * stride + (x0 + vinfo.xoffset);


    int x, y;
    for (y = 0; y < height; ++y)
    {
        for (x = 0; x < width; ++x)
        {
            if(y == 0 || x == 0 || y == (height - 1) || x == (width - 1))
                dest[x] = color16;
        }
        dest += stride;
    }
}

//画大小为width*height的同色矩阵，5reds+5greens+5blues
void drawRect_rgb15 (int x0, int y0, int width, int height, int color)
{
    const int bytesPerPixel = 2;
    const int stride = finfo.line_length / bytesPerPixel;
    const int red = (color & 0xff0000) >> (16 + 3);
    const int green = (color & 0xff00) >> (8 + 3);
    const int blue = (color & 0xff) >> 3;
    const short color15 = blue | (green << 5) | (red << (5 + 5)) | 0x8000;


    short *dest = (short *) (frameBuffer)
        + (y0 + vinfo.yoffset) * stride + (x0 + vinfo.xoffset);
    int x, y;
    for (y = 0; y < height; ++y)
    {
        for (x = 0; x < width; ++x)
        {
            dest[x] = color15;
        }
        dest += stride;
    }
}


void drawRect (int x0, int y0, int width, int height, int color)
{
    switch (vinfo.bits_per_pixel)
    {
        case 32:
            drawRect_rgb32 (x0, y0, width, height, color);
            printf("this 32...............\n");
            break;
        case 16:
            drawRect_rgb16 (x0, y0, width, height, color);
            printf("this 16...............\n");
            break;
        case 15:
            drawRect_rgb15 (x0, y0, width, height, color);
            printf("this 15...............\n");
            break;
        default:
            printf ("Warning: drawRect() not implemented for color depth %i\n",
                vinfo.bits_per_pixel);
            break;
    }
}

#define PERFORMANCE_RUN_COUNT 5
void
performSpeedTest (void *fb, int fbSize)
{
    int i, j, run;
    struct timeval startTime, endTime;
    unsigned long long results[PERFORMANCE_RUN_COUNT];
    unsigned long long average;
    unsigned int *testImage;

    unsigned int randData[17] = {
        0x3A428472, 0x724B84D3, 0x26B898AB, 0x7D980E3C, 0x5345A084,
        0x6779B66B, 0x791EE4B4, 0x6E8EE3CC, 0x63AF504A, 0x18A21B33,
        0x0E26EB73, 0x022F708E, 0x1740F3B0, 0x7E2C699D, 0x0E8A570B,
        0x5F2C22FB, 0x6A742130
    };

    printf ("Frame Buffer Performance test...\n");
    for (run = 0; run < PERFORMANCE_RUN_COUNT; ++run)
    {
        /* Generate test image with random(ish) data: */
        testImage = (unsigned int *) malloc (fbSize);
        j = run;
        for (i = 0; i < (int) (fbSize / sizeof (int)); ++i)
        {
            testImage[i] = randData[j];
            j++;
            if (j >= 17)
            j = 0;
        }

    gettimeofday (&startTime, NULL);
    memcpy (fb, testImage, fbSize);
    gettimeofday (&endTime, NULL);

    long secsDiff = endTime.tv_sec - startTime.tv_sec;
    results[run] =
                secsDiff * 1000000 + (endTime.tv_usec - startTime.tv_usec);

    free (testImage);
    }

    average = 0;
    for (i = 0; i < PERFORMANCE_RUN_COUNT; ++i)
        average += results[i];
    average = average / PERFORMANCE_RUN_COUNT;

    printf (" Bandwidth: %.03f MByte/Sec\n",
        (fbSize / 1048576.0) / ((double) average / 1000000.0));
    printf (" Max. FPS: %.03f fps\n\n",
        1000000.0 / (double) average);

    /* Clear the framebuffer back to black again: */
    memset (fb, 0, fbSize);
}

int main (int argc, char **argv)
{
    const char *devfile = "/dev/fb0";
    long int screensize = 0;
    int fbFd = 0;
    if (argc < 2)
    {
        printf("framebuffer test\n");
        printf("Usage: %s devpath",argv[0]);
        printf("sample:%s /dev/fb0\n",argv[0]);
        exit(1);
    }
    printf("framebuffer test using device %s\n",argv[1]);
    /* Open the file for reading and writing */
    fbFd = open (devfile, O_RDWR);
    if (fbFd == -1)
    {
        perror ("Error: cannot open framebuffer device");
        exit (1);
    }


    //获取finfo信息并显示
    if (ioctl (fbFd, FBIOGET_FSCREENINFO, &finfo) == -1)
    {
        perror ("Error reading fixed information");
        exit (2);
    }
    printFixedInfo ();
    //获取vinfo信息并显示
    if (ioctl (fbFd, FBIOGET_VSCREENINFO, &vinfo) == -1)
    {
        perror ("Error reading variable information");
        exit (3);
    }
    printVariableInfo ();


    /* Figure out the size of the screen in bytes */
    screensize = finfo.smem_len;
    /* Map the device to memory */
    frameBuffer =
        (char *) mmap (0, screensize, PROT_READ | PROT_WRITE, MAP_SHARED,fbFd, 0);
    if (frameBuffer == MAP_FAILED)
    {
        perror ("Error: Failed to map framebuffer device to memory");
        exit (4);
    }


//测试virt fb的性能
    performSpeedTest (frameBuffer, screensize);


    printf ("Will draw 3 rectangles on the screen,\n"
        "they should be colored red, green and blue (in that order).\n");
        //drawRect (vinfo.xres * 3 / 8, vinfo.yres * 3 / 8, vinfo.xres / 4, vinfo.yres / 4, 0xff00ff00);
        drawRect (0, 0, 20, 20, 0xffff0000);
        drawRect (20, 20, 40, 40, 0xff00ff00);
        drawRect (0, 50, 40, 40, 0xff0000ff);
        drawRect (80, 100, 100, 100, 0xff00ff00);
        drawRect (200, 200, 200, 200, 0xff00ff00);
        drawRect (400, 400, 400, 400, 0xff0000ff);
        drawRect (350, 50, 40, 40, 0xff0000ff);
        drawRect (90, 200, 300, 300, 0xff0000ff);


    sleep (5);
    printf (" Done.\n");


    munmap (frameBuffer, screensize); //解除内存映射，与mmap对应


    close (fbFd);
    return 0;
}