一组rgb转换函数，支持rgb565/rgb888/xrgb8888之间的数据转换mybmp.h
Cpp代码
/********************************************************************
created: 2012/04/07
filename: mybmp.h
author:
purpose:
*********************************************************************/
#ifndef _mybmp_h__
#define _mybmp_h__
//-------------------------------------------------------------------
#ifdef __cplusplus
extern "C" {
#endif
#define UpAlign4(n) (((n) + 3) & ~3)
#define UpAlign8(n) (((n) + 7) & ~7)
//拷贝数据
void rgb_copy(const void * psrc, void * pdst, int sw, int sh, int dw, int dh, int bpp);
void rbg565_copy(const void * psrc, void * pdst, int sw, int sh, int dw, int dh);
void rbg888_copy(const void * psrc, void * pdst, int sw, int sh, int dw, int dh);
void rbgx8888_copy(const void * psrc, void * pdst, int sw, int sh, int dw, int dh);
//行数据翻转
void line_reversal(void * pdata, int w, int h, int bpp);
void rgb565_line_reversal(void * p565, int w, int h);
void rgb888_line_reversal(void * p888, int w, int h);
void rgbx8888_line_reversal(void * p8888, int w, int h);
//转换
typedef void * (* RGB_CONVERT_FUN)(const void * psrc, int w, int h);
void * rgb565_to_rgb888_buffer(const void * psrc, int w, int h);
void * rgb888_to_rgb565_buffer(const void * psrc, int w, int h);
void * rgb565_to_rgbx8888_buffer(const void * psrc, int w, int h);
void * rgbx8888_to_rgb565_buffer(const void * psrc, int w, int h);
void * rgb888_to_rgbx8888_buffer(const void * psrc, int w, int h);
void * rgbx8888_to_rgb888_buffer(const void * psrc, int w, int h);
RGB_CONVERT_FUN get_convert_func(int frombpp, int tobpp);
#ifdef __cplusplus
};
#endif
//-------------------------------------------------------------------
#endif // #ifndef _mybmp_h__
rgb_convert.c
Cpp代码
/********************************************************************
created: 2012/05/19
filename: rgb_convert.c
author:
purpose:
*********************************************************************/
//-------------------------------------------------------------------
#include <stdlib.h>
#include <stdio.h>
#include <memory.h>
#include "mybmp.h"
//-------------------------------------------------------------------
//拷贝
void rgb_copy(const void * psrc, void * pdst, int sw, int sh, int dw, int dh, int bpp)
{
int bytes = UpAlign8(bpp) >> 3; // bpp / 8
int srclinesize = UpAlign4(sw * bytes);
int dstlinesize = UpAlign4(dw * bytes);
int copylinesize = srclinesize < dstlinesize ? srclinesize : dstlinesize;
int copylines = sh < dh ? sh : dh;
const unsigned char * psrcline = (const unsigned char *)psrc;
const unsigned char * pend = psrcline + copylines * srclinesize;
unsigned char * pdstline = (unsigned char *)pdst;
while (psrcline < pend) {
memcpy(pdstline, psrcline, copylinesize);
psrcline += srclinesize;
pdstline += dstlinesize;
}
}
void rbg565_copy(const void * psrc, void * pdst, int sw, int sh, int dw, int dh)
{
rgb_copy(psrc, pdst, sw, sh, dw, dh, 16);
}
void rbg888_copy(const void * psrc, void * pdst, int sw, int sh, int dw, int dh)
{
rgb_copy(psrc, pdst, sw, sh, dw, dh, 24);
}
void rbgx8888_copy(const void * psrc, void * pdst, int sw, int sh, int dw, int dh)
{
rgb_copy(psrc, pdst, sw, sh, dw, dh, 32);
}
//-------------------------------------------------------------------
//行数据翻转
void line_reversal(void * pdata, int w, int h, int bpp)
{
int bytes = UpAlign8(bpp) >> 3; // bpp / 8
int linesize = UpAlign4(w * bytes);//4的整数倍
int copylines = h >> 1;
int i;
unsigned char * pline = NULL;
unsigned char * pline1 = NULL;
unsigned char * linebuffer = NULL;
if (pdata && w > 0 && h > 1) {//至少两行才需要翻转
linebuffer = (unsigned char *)malloc(linesize);
if (linebuffer) {
pline = (unsigned char *)pdata;
pline1 = (unsigned char *)pdata + linesize * (h - 1);
for (i = 0; i < copylines; i++) {
memcpy(linebuffer, pline, linesize);
memcpy(pline, pline1, linesize);
memcpy(pline1, linebuffer, linesize);
pline += linesize;
pline1 -= linesize;
}
free(linebuffer);
}
}
}
void rgb565_line_reversal(void * p565, int w, int h)
{
line_reversal(p565, w, h, 16);
}
void rgb888_line_reversal(void * p888, int w, int h)
{
line_reversal(p888, w, h, 24);
}
void rgbx8888_line_reversal(void * p8888, int w, int h)
{
line_reversal(p8888, w, h, 32);
}
//-------------------------------------------------------------------
//转换
static int rgb565_to_rgb888(const void * psrc, int w, int h, void * pdst)
{
int srclinesize = UpAlign4(w * 2);
int dstlinesize = UpAlign4(w * 3);
const unsigned char * psrcline;
const unsigned short * psrcdot;
unsigned char * pdstline;
unsigned char * pdstdot;
int i,j;
if (!psrc || !pdst || w <= 0 || h <= 0) {
printf("rgb565_to_rgb888 : parameter error\n");
return -1;
}
psrcline = (const unsigned char *)psrc;
pdstline = (unsigned char *)pdst;
for (i=0; i<h; i++) {
psrcdot = (const unsigned short *)psrcline;
pdstdot = pdstline;
for (j=0; j<w; j++) {
//565 b|g|r -> 888 r|g|b
*pdstdot++ = (unsigned char)(((*psrcdot) >> 0 ) << 3);
*pdstdot++ = (unsigned char)(((*psrcdot) >> 5 ) << 2);
*pdstdot++ = (unsigned char)(((*psrcdot) >> 11) << 3);
psrcdot++;
}
psrcline += srclinesize;
pdstline += dstlinesize;
}
return 0;
}
static int rgb888_to_rgb565(const void * psrc, int w, int h, void * pdst)
{
int srclinesize = UpAlign4(w * 3);
int dstlinesize = UpAlign4(w * 2);
const unsigned char * psrcline;
const unsigned char * psrcdot;
unsigned char * pdstline;
unsigned short * pdstdot;
int i,j;
if (!psrc || !pdst || w <= 0 || h <= 0) {
printf("rgb888_to_rgb565 : parameter error\n");
return -1;
}
psrcline = (const unsigned char *)psrc;
pdstline = (unsigned char *)pdst;
for (i=0; i<h; i++) {
psrcdot = psrcline;
pdstdot = (unsigned short *)pdstline;
for (j=0; j<w; j++) {
//888 r|g|b -> 565 b|g|r
*pdstdot = (((psrcdot[0] >> 3) & 0x1F) << 0)//r
|(((psrcdot[1] >> 2) & 0x3F) << 5)//g
|(((psrcdot[2] >> 3) & 0x1F) << 11);//b
psrcdot += 3;
pdstdot++;
}
psrcline += srclinesize;
pdstline += dstlinesize;
}
return 0;
}
static int rgb565_to_rgbx8888(const void * psrc, int w, int h, void * pdst)
{
int srclinesize = UpAlign4(w * 2);
int dstlinesize = UpAlign4(w * 4);
const unsigned char * psrcline;
const unsigned short * psrcdot;
unsigned char * pdstline;
unsigned char * pdstdot;
int i,j;
if (!psrc || !pdst || w <= 0 || h <= 0) {
printf("rgb565_to_rgbx8888 : parameter error\n");
return -1;
}
psrcline = (const unsigned char *)psrc;
pdstline = (unsigned char *)pdst;
for (i=0; i<h; i++) {
psrcdot = (const unsigned short *)psrcline;
pdstdot = pdstline;
for (j=0; j<w; j++) {
pdstdot++;
*pdstdot++ = (unsigned char)(((*psrcdot) >> 0 ) << 3);
*pdstdot++ = (unsigned char)(((*psrcdot) >> 5 ) << 2);
*pdstdot++ = (unsigned char)(((*psrcdot) >> 11) << 3);
psrcdot++;
}
psrcline += srclinesize;
pdstline += dstlinesize;
}
return 0;
}
static int rgbx8888_to_rgb565(const void * psrc, int w, int h, void * pdst)
{
int srclinesize = UpAlign4(w * 4);
int dstlinesize = UpAlign4(w * 2);
const unsigned char * psrcline;
const unsigned char * psrcdot;
unsigned char * pdstline;
unsigned short * pdstdot;
int i,j;
if (!psrc || !pdst || w <= 0 || h <= 0) {
printf("rgbx8888_to_rgb565 : parameter error\n");
return -1;
}
psrcline = (const unsigned char *)psrc;
pdstline = (unsigned char *)pdst;
for (i=0; i<h; i++) {
psrcdot = psrcline;
pdstdot = (unsigned short *)pdstline;
for (j=0; j<w; j++) {
//888 r|g|b -> 565 b|g|r
*pdstdot = (((psrcdot[1] >> 3) & 0x1F) << 0)//r
|(((psrcdot[2] >> 2) & 0x3F) << 5)//g
|(((psrcdot[3] >> 3) & 0x1F) << 11);//b
psrcdot += 4;
pdstdot++;
}
psrcline += srclinesize;
pdstline += dstlinesize;
}
return 0;
}
static int rgb888_to_rgbx8888(const void * psrc, int w, int h, void * pdst)
{
int srclinesize = UpAlign4(w * 3);
int dstlinesize = UpAlign4(w * 4);
const unsigned char * psrcline;
const unsigned char * psrcdot;
unsigned char * pdstline;
unsigned char * pdstdot;
int i,j;
if (!psrc || !pdst || w <= 0 || h <= 0) {
printf("rgb888_to_rgbx8888 : parameter error\n");
return -1;
}
psrcline = (const unsigned char *)psrc;
pdstline = (unsigned char *)pdst;
for (i=0; i<h; i++) {
psrcdot = psrcline;
pdstdot = pdstline;
for (j=0; j<w; j++) {
*pdstdot++ = 0;
*pdstdot++ = *psrcdot++;
*pdstdot++ = *psrcdot++;
*pdstdot++ = *psrcdot++;
}
psrcline += srclinesize;
pdstline += dstlinesize;
}
return 0;
}
static int rgbx8888_to_rgb888(const void * psrc, int w, int h, void * pdst)
{
int srclinesize = UpAlign4(w * 4);
int dstlinesize = UpAlign4(w * 3);
const unsigned char * psrcline;
const unsigned char * psrcdot;
unsigned char * pdstline;
unsigned char * pdstdot;
int i,j;
if (!psrc || !pdst || w <= 0 || h <= 0) {
printf("rgbx8888_to_rgb888 : parameter error\n");
return -1;
}
psrcline = (const unsigned char *)psrc;
pdstline = (unsigned char *)pdst;
for (i=0; i<h; i++) {
psrcdot = psrcline;
pdstdot = pdstline;
for (j=0; j<w; j++) {
psrcdot++;
*pdstdot++ = *psrcdot++;
*pdstdot++ = *psrcdot++;
*pdstdot++ = *psrcdot++;
}
psrcline += srclinesize;
pdstline += dstlinesize;
}
return 0;
}
void * rgb565_to_rgb888_buffer(const void * psrc, int w, int h)
{
int size = h * UpAlign4(w * 3);
void * pdst = NULL;
if (psrc && w > 0 && h > 0) {
pdst = malloc(size);
if (pdst) {
if (rgb565_to_rgb888(psrc, w, h, pdst)) {
free(pdst);
pdst = NULL;
}
}
}
return pdst;
}
void * rgb888_to_rgb565_buffer(const void * psrc, int w, int h)
{
int size = h * UpAlign4(w * 2);
void * pdst = NULL;
if (psrc && w > 0 && h > 0) {
pdst = malloc(size);
if (pdst) {
if (rgb888_to_rgb565(psrc, w, h, pdst)) {
free(pdst);
pdst = NULL;
}
}
}
return pdst;
}
void * rgb565_to_rgbx8888_buffer(const void * psrc, int w, int h)
{
int size = h * UpAlign4(w * 4);
void * pdst = NULL;
if (psrc && w > 0 && h > 0) {
pdst = malloc(size);
if (pdst) {
if (rgb565_to_rgbx8888(psrc, w, h, pdst)) {
free(pdst);
pdst = NULL;
}
}
}
return pdst;
}
void * rgbx8888_to_rgb565_buffer(const void * psrc, int w, int h)
{
int size = h * UpAlign4(w * 2);
void * pdst = NULL;
if (psrc && w > 0 && h > 0) {
pdst = malloc(size);
if (pdst) {
if (rgbx8888_to_rgb565(psrc, w, h, pdst)) {
free(pdst);
pdst = NULL;
}
}
}
return pdst;
}
void * rgb888_to_rgbx8888_buffer(const void * psrc, int w, int h)
{
int size = h * UpAlign4(w * 4);
void * pdst = NULL;
if (psrc && w > 0 && h > 0) {
pdst = malloc(size);
if (pdst) {
if (rgb888_to_rgbx8888(psrc, w, h, pdst)) {
free(pdst);
pdst = NULL;
}
}
}
return pdst;
}
void * rgbx8888_to_rgb888_buffer(const void * psrc, int w, int h)
{
int size = h * UpAlign4(w * 3);
void * pdst = NULL;
if (psrc && w > 0 && h > 0) {
pdst = malloc(size);
if (pdst) {
if (rgbx8888_to_rgb888(psrc, w, h, pdst)) {
free(pdst);
pdst = NULL;
}
}
}
return pdst;
}
static const RGB_CONVERT_FUN g_convert_func[3][3] =
{
{NULL, rgb565_to_rgb888_buffer, rgb565_to_rgbx8888_buffer},
{rgb888_to_rgb565_buffer, NULL, rgb888_to_rgbx8888_buffer},
{rgbx8888_to_rgb565_buffer, rgbx8888_to_rgb888_buffer, NULL}
};
RGB_CONVERT_FUN get_convert_func(int frombpp, int tobpp)
{
RGB_CONVERT_FUN func_ptr = NULL;
frombpp = UpAlign8(frombpp) / 8 - 2;
tobpp = UpAlign8(tobpp) / 8 - 2;
if ((frombpp >= 0 && frombpp <= 2)
&& (tobpp >= 0 && tobpp <= 2)) {
func_ptr = g_convert_func[frombpp][tobpp];
}
return func_ptr;
}
//-------------------------------------------------------------------
