pix_map_base_routines.c

在SOPC平台上

#include "pix_map_base_routines.h"


void copy_pix_map(
                    void *src_ptr,
                    long src_pixel_size,
                    long src_active_width,
                    long src_active_height,
                    long src_line_width,
                    void *dest_ptr,
                    long dest_pixel_size,
                    long dest_line_width
                  )
{
  switch (src_pixel_size)
  {
    case (_16BPP) :
    switch (dest_pixel_size)
    {
      case(_16BPP) :
      copy_pix_map_16_to_16(src_ptr, src_active_width, src_active_height, src_line_width, dest_ptr, dest_line_width);
      break;      
      case(_24BPP) :
      copy_pix_map_16_to_24(src_ptr, src_active_width, src_active_height, src_line_width, dest_ptr, dest_line_width);
      break;      
      case(_32BPP) :
      copy_pix_map_16_to_32(src_ptr, src_active_width, src_active_height, src_line_width, dest_ptr, dest_line_width);
      break;      
    }
    break;
    case (_24BPP) :
    switch (dest_pixel_size)
    {
      case(_16BPP) :
      copy_pix_map_24_to_16(src_ptr, src_active_width, src_active_height, src_line_width, dest_ptr, dest_line_width);
      break;      
      case(_24BPP) :
      copy_pix_map_24_to_24(src_ptr, src_active_width, src_active_height, src_line_width, dest_ptr, dest_line_width);
      break;      
      case(_32BPP) :
      copy_pix_map_24_to_32(src_ptr, src_active_width, src_active_height, src_line_width, dest_ptr, dest_line_width);
      break;      
    }
    break;
    case (_32BPP) :
    switch (dest_pixel_size)
    {
      case(_16BPP) :
      copy_pix_map_32_to_16(src_ptr, src_active_width, src_active_height, src_line_width, dest_ptr, dest_line_width);
      break;      
      case(_24BPP) :
      copy_pix_map_32_to_24(src_ptr, src_active_width, src_active_height, src_line_width, dest_ptr, dest_line_width);
      break;      
      case(_32BPP) :
      copy_pix_map_32_to_32(src_ptr, src_active_width, src_active_height, src_line_width, dest_ptr, dest_line_width);
      break;      
    }
    break;
  }
}

void copy_pix_map_32_to_32(
                    void *src_ptr,
                    long src_active_width,
                    long src_active_height,
                    long src_line_width,
                    void *dest_ptr,
                    long dest_line_width
                  )
{
  int src_row, src_col;
  void *src_line_ptr, *dest_line_ptr;
  long src_increment, dest_increment;
  
  src_increment = src_line_width + src_line_width + src_line_width + src_line_width;
  dest_increment = dest_line_width + dest_line_width + dest_line_width + dest_line_width;
  
  for( src_row = 0 ; src_row < src_active_height ; src_row++ )
  {
    src_line_ptr = src_ptr;
    dest_line_ptr = dest_ptr;
    for( src_col = 0 ; src_col < src_active_width ; src_col++ )
    {
      *(unsigned long *)(dest_line_ptr) = *(unsigned long *)(src_line_ptr);
      src_line_ptr += 4;
      dest_line_ptr += 4;
    }
    src_ptr += src_increment;
    dest_ptr += dest_increment;
  }
}

void copy_pix_map_32_to_24(
                    void *src_ptr,
                    long src_active_width,
                    long src_active_height,
                    long src_line_width,
                    void *dest_ptr,
                    long dest_line_width
                  )
{
  int src_row, src_col;
  void *src_line_ptr, *dest_line_ptr;
  long src_increment, dest_increment;
  
  src_increment = src_line_width + src_line_width + src_line_width + src_line_width;
  dest_increment = dest_line_width + dest_line_width + dest_line_width;

  for( src_row = 0 ; src_row < src_active_height ; src_row++ )
  {
    src_line_ptr = src_ptr;
    dest_line_ptr = dest_ptr;
    for( src_col = 0 ; src_col < src_active_width ; src_col++ )
    {
      *(unsigned char *)(dest_line_ptr) = *(unsigned char *)(src_line_ptr);
      src_line_ptr += 1;
      dest_line_ptr += 1;
      *(unsigned char *)(dest_line_ptr) = *(unsigned char *)(src_line_ptr);
      src_line_ptr += 1;
      dest_line_ptr += 1;
      *(unsigned char *)(dest_line_ptr) = *(unsigned char *)(src_line_ptr);
      src_line_ptr += 2;
      dest_line_ptr += 1;
    }
    src_ptr += src_increment;
    dest_ptr += dest_increment;
  }
}

/* original 32_to_24
void copy_pix_map_32_to_24(
                    void *src_ptr,
                    long src_active_width,
                    long src_active_height,
                    long src_line_width,
                    void *dest_ptr,
                    long dest_line_width
                  )
{
  int src_row, src_col;
  int last_pixel_buffered = 0;
  unsigned long next_long_pixel = 0;
  unsigned long out_temp_long_pixel_1 = 0, out_temp_long_pixel_2 = 0, out_temp_long_pixel_3 = 0;
  void *src_line_ptr, *dest_line_ptr;
  long src_increment, dest_increment;
  
  src_increment = src_line_width * _32BPP;
  dest_increment = dest_line_width * _24BPP;

  for( src_row = 0 ; src_row < src_active_height ; src_row++ )
  {
    last_pixel_buffered = 0;
    src_line_ptr = src_ptr;
    dest_line_ptr = dest_ptr;
    for( src_col = 0 ; src_col < src_active_width ; src_col++ )
    {
      next_long_pixel = *(unsigned long *)(src_line_ptr);
      src_line_ptr += 4;

      if((int)(dest_line_ptr) & 0x03)   // long aligned?
      {
        *(unsigned char *)(dest_line_ptr) = ( next_long_pixel >> 0 )  & 0x000000ff;
        dest_line_ptr += 1;
        *(unsigned char *)(dest_line_ptr) = ( next_long_pixel >> 8 )  & 0x000000ff;
        dest_line_ptr += 1;
        *(unsigned char *)(dest_line_ptr) = ( next_long_pixel >> 16 )  & 0x000000ff;
        dest_line_ptr += 1;
      }
      else                  // long aligned
      {
        switch (last_pixel_buffered & 0x03)
        {
          case (0) :
            out_temp_long_pixel_1 = next_long_pixel;
            last_pixel_buffered++;
            break;
          case (1) :
            out_temp_long_pixel_1 = (out_temp_long_pixel_1 & 0x00ffffff) | ((next_long_pixel << 24) & 0xff000000);
            out_temp_long_pixel_2 = ((next_long_pixel >> 8) & 0x0000ffff);
            last_pixel_buffered++;
            break;
          case (2) :
            out_temp_long_pixel_2 = (out_temp_long_pixel_2 & 0x0000ffff) | ((next_long_pixel << 16) & 0xffff0000);
            out_temp_long_pixel_3 = ((next_long_pixel >> 16) & 0x000000ff);
            last_pixel_buffered++;
            break;
          case (3) :
            *(unsigned long *)(dest_line_ptr) = out_temp_long_pixel_1;
            dest_line_ptr += 4;
            *(unsigned long *)(dest_line_ptr) = out_temp_long_pixel_2;
            dest_line_ptr += 4;
            *(unsigned long *)(dest_line_ptr) =  ((next_long_pixel << 8) & 0xffffff00) | (out_temp_long_pixel_3 & 0x000000ff);
            dest_line_ptr += 4;
            last_pixel_buffered = 0x00;
            break;
        }
      }
    }
    if(last_pixel_buffered)
    {
      switch (last_pixel_buffered & 0x03)
      {
        case (1) :
          *(unsigned char *)(dest_line_ptr) = ( out_temp_long_pixel_1 >> 0 )  & 0x000000ff;
          dest_line_ptr += 1;
          *(unsigned char *)(dest_line_ptr) = ( out_temp_long_pixel_1 >> 8 )  & 0x000000ff;
          dest_line_ptr += 1;
          *(unsigned char *)(dest_line_ptr) = ( out_temp_long_pixel_1 >> 16 )  & 0x000000ff;
          dest_line_ptr += 1;
          break;
        case (2) :
          *(unsigned long *)(dest_line_ptr) = out_temp_long_pixel_1;
          dest_line_ptr += 4;
          *(unsigned char *)(dest_line_ptr) = ( out_temp_long_pixel_2 >> 0 )  & 0x000000ff;
          dest_line_ptr += 1;
          *(unsigned char *)(dest_line_ptr) = ( out_temp_long_pixel_2 >> 8 )  & 0x000000ff;
          dest_line_ptr += 1;
          break;
        case (3) :
          *(unsigned long *)(dest_line_ptr) = out_temp_long_pixel_1;
          dest_line_ptr += 4;
          *(unsigned long *)(dest_line_ptr) = out_temp_long_pixel_2;
          dest_line_ptr += 4;
          *(unsigned char *)(dest_line_ptr) = ( out_temp_long_pixel_3 >> 0 )  & 0x000000ff;
          dest_line_ptr += 1;
          break;
      }
    }
    src_ptr += src_increment;
    dest_ptr += dest_increment;
  }
}
*/
void copy_pix_map_32_to_16(
                    void *src_ptr,
                    long src_active_width,
                    long src_active_height,
                    long src_line_width,
                    void *dest_ptr,
                    long dest_line_width
                  )
{
  int src_row, src_col;
  unsigned long next_long_pixel;
  unsigned short next_short_pixel;
  void *src_line_ptr, *dest_line_ptr;
  long src_increment, dest_increment;
  
  src_increment = src_line_width + src_line_width + src_line_width + src_line_width;
  dest_increment = dest_line_width + dest_line_width;
  
  for( src_row = 0 ; src_row < src_active_height ; src_row++ )
  {
    src_line_ptr = src_ptr;
    dest_line_ptr = dest_ptr;
    for( src_col = 0 ; src_col < src_active_width ; src_col++ )
    {
      next_long_pixel = *(unsigned long *)(src_line_ptr);
      src_line_ptr += 4;

      next_short_pixel =  (((next_long_pixel >> 3) & 0x1f) << 11) |
                          (((next_long_pixel >> 10) & 0x3f) << 5) |
                          (((next_long_pixel >> 19) & 0x1f) << 0) ;

      *(unsigned short *)(dest_line_ptr) = next_short_pixel;
      dest_line_ptr += 2;
    }
    src_ptr += src_increment;
    dest_ptr += dest_increment;
  }
}
/* original 32_to_16
void copy_pix_map_32_to_16(
                    void *src_ptr,
                    long src_active_width,
                    long src_active_height,
                    long src_line_width,
                    void *dest_ptr,
                    long dest_line_width
                  )
{
  int src_row, src_col;
  int last_pixel_buffered = 0;
  unsigned long next_long_pixel = 0;
  unsigned short next_short_pixel = 0;
  unsigned short last_short_pixel = 0;
  void *src_line_ptr, *dest_line_ptr;
  long src_increment, dest_increment;
  
  src_increment = src_line_width * _32BPP;
  dest_increment = dest_line_width * _16BPP;
  
  for( src_row = 0 ; src_row < src_active_height ; src_row++ )
  {
    last_pixel_buffered = 0;
    src_line_ptr = src_ptr;
    dest_line_ptr = dest_ptr;
    for( src_col = 0 ; src_col < src_active_width ; src_col++ )
    {
      next_long_pixel = *(unsigned long *)(src_line_ptr);
      src_line_ptr += 4;

      next_short_pixel =  (((next_long_pixel >> 3) & 0x1f) << 11) |
                          (((next_long_pixel >> 10) & 0x3f) << 5) |
                          (((next_long_pixel >> 19) & 0x1f) << 0) ;

      if((int)(dest_line_ptr) & 0x02)   // short aligned?
      {
        *(unsigned short *)(dest_line_ptr) = next_short_pixel;
        dest_line_ptr += 2;
      }
      else                  // long aligned
      {
        if(last_pixel_buffered)
        {
          *(unsigned long *)(dest_line_ptr) = ((next_short_pixel << 16) & 0xffff0000) | (last_short_pixel & 0x0000ffff);
          dest_line_ptr += 4;
          last_pixel_buffered = 0;
        }
        else
        {
          last_short_pixel = next_short_pixel;
          last_pixel_buffered++;
        }
      }
    }
    if(last_pixel_buffered)
    {
      *(unsigned short *)(dest_line_ptr) = last_short_pixel;
      dest_line_ptr += 2;
    }
    src_ptr += src_increment;
    dest_ptr += dest_increment;
  }
}
*/
void copy_pix_map_24_to_32(
                    void *src_ptr,
                    long src_active_width,
                    long src_active_height,
                    long src_line_width,
                    void *dest_ptr,
                    long dest_line_width
                  )
{
  int src_row, src_col;
  void *src_line_ptr, *dest_line_ptr;
  long src_increment, dest_increment;
  
  src_increment = src_line_width + src_line_width + src_line_width;
  dest_increment = dest_line_width + dest_line_width + dest_line_width + dest_line_width;
  
  for( src_row = 0 ; src_row < src_active_height ; src_row++ )
  {
    src_line_ptr = src_ptr;
    dest_line_ptr = dest_ptr;
    for( src_col = 0 ; src_col < src_active_width ; src_col++ )
    {
      *(unsigned char *)(dest_line_ptr)  = *(unsigned char *)(src_line_ptr);
      src_line_ptr += 1;
      dest_line_ptr += 1;
      *(unsigned char *)(dest_line_ptr)  = *(unsigned char *)(src_line_ptr);
      src_line_ptr += 1;
      dest_line_ptr += 1;
      *(unsigned char *)(dest_line_ptr)  = *(unsigned char *)(src_line_ptr);
      src_line_ptr += 1;
      dest_line_ptr += 1;
      *(unsigned char *)(dest_line_ptr)  = 0xff;