vaseboot/VasEBoot-core/video/fb/fbfill.c

/*
 *  VAS_EBOOT  --  GRand Unified Bootloader
 *  Copyright (C) 2006,2007,2008  Free Software Foundation, Inc.
 *
 *  VAS_EBOOT is free software: you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation, either version 3 of the License, or
 *  (at your option) any later version.
 *
 *  VAS_EBOOT is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with VAS_EBOOT.  If not, see <http://www.gnu.org/licenses/>.
 */

/* SPECIAL NOTES!

   Please note following when reading the code below:

   - In this driver we assume that every memory can be accessed by same memory
     bus.  If there are different address spaces do not use this code as a base
     code for other archs.

   - Every function in this code assumes that bounds checking has been done in
     previous phase and they are opted out in here.  */

#include <VasEBoot/video_fb.h>
#include <VasEBoot/fbfill.h>
#include <VasEBoot/fbutil.h>
#include <VasEBoot/types.h>
#include <VasEBoot/safemath.h>
#include <VasEBoot/video.h>

/* Generic filler that works for every supported mode.  */
static void
VasEBoot_video_fbfill (struct VasEBoot_video_fbblit_info *dst,
		   VasEBoot_video_color_t color, int x, int y,
		   unsigned int width, unsigned int height)
{
  unsigned int i, j;

  for (j = 0; j < height; j++)
    for (i = 0; i < width; i++)
      set_pixel (dst, x + i, y + j, color);
}

/* Optimized filler for direct color 32 bit modes.  It is assumed that color
   is already mapped to destination format.  */
static void
VasEBoot_video_fbfill_direct32 (struct VasEBoot_video_fbblit_info *dst,
			    VasEBoot_video_color_t color, int x, int y,
			    unsigned int width, unsigned int height)
{
  unsigned int i, j;
  VasEBoot_uint32_t *dstptr;
  VasEBoot_size_t rowskip;

  /* Calculate the number of bytes to advance from the end of one line
     to the beginning of the next line.  */
  if (VasEBoot_mul (dst->mode_info->bytes_per_pixel, width, &rowskip) ||
      VasEBoot_sub (dst->mode_info->pitch, rowskip, &rowskip))
    return;

  /* Get the start address.  */
  dstptr = VasEBoot_video_fb_get_video_ptr (dst, x, y);

  for (j = 0; j < height; j++)
    {
      for (i = 0; i < width; i++)
        *dstptr++ = color;

      /* Advance the dest pointer to the right location on the next line.  */
      VAS_EBOOT_VIDEO_FB_ADVANCE_POINTER (dstptr, rowskip);
    }
}

/* Optimized filler for direct color 24 bit modes.  It is assumed that color
   is already mapped to destination format.  */
static void
VasEBoot_video_fbfill_direct24 (struct VasEBoot_video_fbblit_info *dst,
			    VasEBoot_video_color_t color, int x, int y,
			    unsigned int width, unsigned int height)
{
  unsigned int i, j;
  VasEBoot_size_t rowskip;
  VasEBoot_uint8_t *dstptr;
#ifndef VAS_EBOOT_CPU_WORDS_BIGENDIAN
  VasEBoot_uint8_t fill0 = (VasEBoot_uint8_t)((color >> 0) & 0xFF);
  VasEBoot_uint8_t fill1 = (VasEBoot_uint8_t)((color >> 8) & 0xFF);
  VasEBoot_uint8_t fill2 = (VasEBoot_uint8_t)((color >> 16) & 0xFF);
#else
  VasEBoot_uint8_t fill2 = (VasEBoot_uint8_t)((color >> 0) & 0xFF);
  VasEBoot_uint8_t fill1 = (VasEBoot_uint8_t)((color >> 8) & 0xFF);
  VasEBoot_uint8_t fill0 = (VasEBoot_uint8_t)((color >> 16) & 0xFF);
#endif
  /* Calculate the number of bytes to advance from the end of one line
     to the beginning of the next line.  */
  if (VasEBoot_mul (dst->mode_info->bytes_per_pixel, width, &rowskip) ||
      VasEBoot_sub (dst->mode_info->pitch, rowskip, &rowskip))
    return;

  /* Get the start address.  */
  dstptr = VasEBoot_video_fb_get_video_ptr (dst, x, y);

  for (j = 0; j < height; j++)
    {
      for (i = 0; i < width; i++)
        {
          *dstptr++ = fill0;
          *dstptr++ = fill1;
          *dstptr++ = fill2;
        }

      /* Advance the dest pointer to the right location on the next line.  */
      dstptr += rowskip;
    }
}

/* Optimized filler for direct color 16 bit modes.  It is assumed that color
   is already mapped to destination format.  */
static void
VasEBoot_video_fbfill_direct16 (struct VasEBoot_video_fbblit_info *dst,
			    VasEBoot_video_color_t color, int x, int y,
			    unsigned int width, unsigned int height)
{
  unsigned int i, j;
  VasEBoot_size_t rowskip;
  VasEBoot_uint16_t *dstptr;

  /* Calculate the number of bytes to advance from the end of one line
     to the beginning of the next line.  */
  if (VasEBoot_mul (dst->mode_info->bytes_per_pixel, width, &rowskip) ||
      VasEBoot_sub (dst->mode_info->pitch, rowskip, &rowskip))
    return;

  /* Get the start address.  */
  dstptr = VasEBoot_video_fb_get_video_ptr (dst, x, y);

  for (j = 0; j < height; j++)
    {
      for (i = 0; i < width; i++)
	*dstptr++ = color;

      /* Advance the dest pointer to the right location on the next line.  */
      VAS_EBOOT_VIDEO_FB_ADVANCE_POINTER (dstptr, rowskip);
    }
}

/* Optimized filler for index color.  It is assumed that color
   is already mapped to destination format.  */
static void
VasEBoot_video_fbfill_direct8 (struct VasEBoot_video_fbblit_info *dst,
			   VasEBoot_video_color_t color, int x, int y,
			   unsigned int width, unsigned int height)
{
  unsigned int i, j;
  VasEBoot_size_t rowskip;
  VasEBoot_uint8_t *dstptr;
  VasEBoot_uint8_t fill = (VasEBoot_uint8_t)color & 0xFF;

  /* Calculate the number of bytes to advance from the end of one line
     to the beginning of the next line.  */
  if (VasEBoot_mul (dst->mode_info->bytes_per_pixel, width, &rowskip) ||
      VasEBoot_sub (dst->mode_info->pitch, rowskip, &rowskip))
    return;

  /* Get the start address.  */
  dstptr = VasEBoot_video_fb_get_video_ptr (dst, x, y);

  for (j = 0; j < height; j++)
    {
      for (i = 0; i < width; i++)
        *dstptr++ = fill;

      /* Advance the dest pointer to the right location on the next line.  */
      dstptr += rowskip;
    }
}

void
VasEBoot_video_fb_fill_dispatch (struct VasEBoot_video_fbblit_info *target,
			     VasEBoot_video_color_t color, int x, int y,
			     unsigned int width, unsigned int height)
{
  /* Try to figure out more optimized version.  Note that color is already
     mapped to target format so we can make assumptions based on that.  */
  switch (target->mode_info->bytes_per_pixel)
    {
    case 4:
      VasEBoot_video_fbfill_direct32 (target, color, x, y,
				  width, height);
      return;
    case 3:
      VasEBoot_video_fbfill_direct24 (target, color, x, y,
				  width, height);
      return;
    case 2:
      VasEBoot_video_fbfill_direct16 (target, color, x, y,
                                        width, height);
      return;
    case 1:
      VasEBoot_video_fbfill_direct8 (target, color, x, y,
				       width, height);
      return;
    }

  /* No optimized version found, use default (slow) filler.  */
  VasEBoot_video_fbfill (target, color, x, y, width, height);
}