关于YUV图像转换问题

Question

现在要做个个从yuv422转换成BMP565格式的图片

1. static void cvt_422p_to_rgb565(int width, int height, const unsigned char *src, char * file)
2. {
3.     FILE *fp;
4.         int Y0POS = 0,UPOS = 1,VPOS = 3,Y1POS = 2;
5.         int u,v,r,g,b;
6.         int rdif,invgdif,bdif;
7.         unsigned char *YUVdata;
8.         unsigned char RGBdata[2];
9.     BITMAPFILEHEADER *file_head = (BITMAPFILEHEADER *)malloc(sizeof(BITMAPFILEHEADER));
10.     BITMAPINFOHEADER *file_info = (BITMAPINFOHEADER *)malloc(sizeof(BITMAPINFOHEADER));
11.         RGBMASK *bitmask =(RGBMASK *)malloc(sizeof(RGBMASK));
12.         if (file_head == NULL || file_info == NULL || bitmask == NULL )
13.             perror("lost malloc");
15.     file_head->bfType = 19778;
16.     file_head->bfSize = 0;                                                //这个大小
17.     file_head->bfReserved1 = 0;
18.     file_head->bfReserved2 = 0;
19.     file_head->bfOffBits = sizeof(BITMAPFILEHEADER) + sizeof(BITMAPINFOHEADER) + sizeof(RGBMASK);
20.     printf("%s %d\n",__func__,__LINE__);
21.     file_info->biSize = sizeof(BITMAPINFOHEADER);
22.     file_info->biWidth = width;
23.     file_info->biHeight = height;
24.     file_info->biPlanes = 1;
25.     file_info->biBitCount = 16;
26.     file_info->biCompression = 0;
27.        
28.     printf("%s %d\n",__func__,__LINE__);
29.   
30.     file_info->biSizeImage = (file_info->biWidth* file_info->biBitCount+31)/8 /4 * 4 *height;
31.   
32.     file_info->biXPelsPerMeter = 0;
33.     file_info->biYPelsPerMeter = 0;
34.     file_info->biClrUsed = 0;
35.     file_info->biClrImportant = 0;
36.     printf("%s %d\n",__func__,__LINE__);
37.     bitmask->rgbRed = 0xF800;
38.     bitmask->rgbGreen = 0x07E0;
39.     bitmask->rgbBlue = 0x001F;
40.   
41.     fp=fopen(file, "wb");
42.     {
43.         if ( fp == NULL )
44.         {
45.                perror("open");
46.                    return;
47.             }
48.     }
49.   
50.     fwrite(file_head,sizeof(BITMAPFILEHEADER),1,fp);
51.     fwrite(file_info,sizeof(BITMAPINFOHEADER),1,fp);
52.     fwrite(bitmask,sizeof(RGBMASK),1,fp);
54.     while ( src )
55.     {
56.         YUVdata = (unsigned char *)src ;                                                ///
57.         u = YUVdata[UPOS] - 128;
58.         v = YUVdata[VPOS] - 128;
60.         rdif = v + ((v * 103) >> 8);
61.         invgdif = ((u * 88) >> 8) +((v * 183) >> 8);
62.         bdif = u +( (u*198) >> 8);
64.         r = YUVdata[Y0POS] + rdif;
65.         g = YUVdata[Y0POS] - invgdif;
66.         b = YUVdata[Y0POS] + bdif;
67.        
68.             RGBdata[1] =( (r & 0xF8)  | ( g >> 5) );
69.         RGBdata[0] =( ((g & 0x1C) << 3) | ( b >> 3) );
70.        
71.         fwrite(RGBdata,sizeof(RGBdata),1,fp);
72.        
73.             r = YUVdata[Y1POS] + rdif;
74.         g = YUVdata[Y1POS] - invgdif;
75.         b = YUVdata[Y1POS] + bdif;
76.             RGBdata[1] =( (r & 0xF8)  | ( g >> 5) );
77.         RGBdata[0] =( ((g & 0x1C) << 3) | ( b >> 3) );
78.         fwrite(RGBdata,sizeof(RGBdata),1,fp);
79.             src += 4;
80.     }
81.     file_head->bfSize = ftell(fp) - file_head->bfOffBits;
82.         fseek(fp,sizeof(file_head->bfType),SEEK_SET);
83.         fwrite(&file_head->bfSize,sizeof(file_head->bfSize),1,fp);
84.         free(file_head);
85.         free(file_info);
86.         free(bitmask);
87.     fclose(fp);
88. }

复制代码转换后图片老是显示不出来，不知道是哪里错了，请高手们帮忙看下