一道字符串算法优化，求助

请教一下大家（32位字长的pc机环境）：
#define WIDTH 320
#define HEIGHT 240
#define BYTES 3

对一个char s[WIDTH*HEIGHT*BYTES]的线性数据空间，
BYTES为最小处理单位，320*240为VIDEO的宽度和高度，也是LCD像素点个数。因为从摄像头获取到的是24位的RGB色彩，所以每3字节表示一个像素的色彩，深度为24位，现要把它转换为16位，2 字节的rgb格式（5:6:5）。

/* 包含在.h文件中的片段 */
typedef struct st_video_color_pixel_24{
unsigned char blue;
unsigned char green;
unsigned char red;
} COLOR24_T;
#define color_24to16(color) ((short)(((color.blue>>3))|((color.green>>2)<<5)|((color.red>>3)<<11)))

/* 包含在.c文件中的片段 */
unsigned short pbuf[WIDTH*HEIGHT];
COLOR24_T color;
...

for(row=0; row<HEIGHT; row++){
for(col=0; col<WIDTH; col++){
strncpy((char *)&color, (const char *)(pvideo_buf+row*WIDTH*BYTES+col*BYTES), sizeof(COLOR24_T));
pbuf[row*WIDTH+col] = (unsigned short)color_24to16(color);
}
}

按这种常规处理方案，需要处理WIDTH*HEIGHT次，对每一个BYTES字节的24位RGB色彩，转换为2字节16位的565格式的数据，这段代码效率很低，还有3字节的RGB色彩跨4字节边界问题。大家有没有好的算法，优化一下这个数据处理过程。谢了！