嵌入式Linux Framebuffer怎么描点画线

#include <sys/mman.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <unistd.h>
#include <linux/fb.h>
#include <fcntl.h>
#include <stdio.h>
#include <string.h>
#include <sys/ioctl.h>
#include <math.h>
static int fd_fb;
static struct fb_var_screeninfo var;	/* Current var */
static int screen_size;					/* 一帧数据所占用的字节数*/
static unsigned char *fb_base;			/* Framebuffer首地址*/
static unsigned int line_width;			/* 一行数据所占用的字节数*/
static unsigned int pixel_width;		/* 单个像素所占用的字节数*/

/**********************************************************************
 * 函数名称： lcd_put_pixel
 * 功能描述： 在LCD指定位置上输出指定颜色（描点）
 * 输入参数： x坐标，y坐标，颜色
 * 输出参数： 无
 * 返 回 值： 会
 * 修改日期        版本号     修改人	      修改内容
 * -----------------------------------------------
 * 2020/05/12	     V1.0	  zh(angenao)	      创建
 ***********************************************************************/ 
void lcd_put_pixel(int x, int y, unsigned int color){
	unsigned char *pen_8 = fb_base+y*line_width+x*pixel_width;
	unsigned short *pen_16;	
	unsigned int *pen_32;	

	unsigned int red, green, blue;	

	pen_16 = (unsigned short *)pen_8;
	pen_32 = (unsigned int *)pen_8;

	switch (var.bits_per_pixel){
		case 8:{
			*pen_8 = color;
			break;
		}
		case 16:{
			/* 565 */
			red   = (color >> 16) & 0xff;
			green = (color >> 8) & 0xff;
			blue  = (color >> 0) & 0xff;
			color = ((red >> 3) << 11) | ((green >> 2) << 5) | (blue >> 3);
			*pen_16 = color;
			break;
		}
		case 32:{
			*pen_32 = color;
			break;
		}
		default:{
			printf("can't surport %dbpp\n", var.bits_per_pixel);
			break;
		}
	}
}
int main(int argc, char **argv){
	int i;
	fd_fb = open("/dev/fb0", O_RDWR);/** 打开fb设备*/
	if (fd_fb < 0){
		printf("can't open /dev/fb0\n");
		return -1;
	}
	if (ioctl(fd_fb, FBIOGET_VSCREENINFO, &var)){/** 获取屏幕可变信息*/
		printf("can't get var\n");
		return -1;
	}
	printf("RES:%d x %d\n",var.xres,var.yres);
	printf("one pixel bits:%d\n",var.bits_per_pixel);
	line_width  = var.xres * var.bits_per_pixel / 8;// 一行数据 占据字节数
	printf("line_width:%d byte\n",line_width);
	pixel_width = var.bits_per_pixel / 8;///单个像素占用的字节数
	printf("pixel_width:%d byte\n",pixel_width);
	screen_size = var.xres * var.yres * var.bits_per_pixel / 8;//一帧画面占用的字节数
	printf("screen_size:%d byte\n",screen_size);
	fb_base = (unsigned char *)mmap(NULL , screen_size, PROT_READ | PROT_WRITE, MAP_SHARED, fd_fb, 0);/** 映射framebuffer的首地址*/
	if (fb_base == (unsigned char *)-1){
		printf("can't mmap\n");
		return -1;
	}
	memset(fb_base, 0x00, screen_size);/* 清屏: 全部设为黑色 */
	/* 随便设置出100个为红点 */
	const double T=2*3.14;//周期
	const int A=100;//振幅
	double x,sin_y,cos_y;
	int start_x,start_y;//绘图的起始点像素坐标
	start_x=0;
	start_y = var.yres/2;
	
	while(1){
		for(i=0;i<var.xres;i++){
			x= (i*2*T)/(var.xres);
			sin_y = A*sin(x);
			cos_y = A*cos(x);
			int w=0;
			for(w=0;w<5;w++){
				
				lcd_put_pixel(start_x+i+w,start_y+sin_y, 0x00FF00);	
				lcd_put_pixel(start_x+i+w,start_y+cos_y, 0xFF0000);
			}
			usleep(1000);
		}
		memset(fb_base, 0x00, screen_size);/* 清屏: 全部设为黑色 */
	}
	munmap(fb_base , screen_size);/** 解除内存映射*/
	close(fd_fb);
	return 0;	
}