// Most code come from original Allegro rotation code:
// By Shawn Hargreaves.
// Flipping routines by Andrew Geers.
// Optimized by Sven Sandberg.
// To C++ templates by David Capello
//
// This file is released under the terms of the MIT license.
// Read LICENSE.txt for more information.

#ifdef HAVE_CONFIG_H
  #include "config.h"
#endif

#include "base/pi.h"
#include "doc/blend_funcs.h"
#include "doc/image.h"
#include "doc/mask.h"
#include "doc/primitives.h"
#include "doc/primitives_fast.h"
#include "fixmath/fixmath.h"

#include <cmath>

namespace doc { namespace algorithm {

using namespace fixmath;

static void ase_parallelogram_map_standard(Image* bmp,
                                           const Image* sprite,
                                           const Image* mask,
                                           fixed xs[4],
                                           fixed ys[4]);

static void ase_rotate_scale_flip_coordinates(fixed w,
                                              fixed h,
                                              fixed x,
                                              fixed y,
                                              fixed cx,
                                              fixed cy,
                                              fixed angle,
                                              fixed scale_x,
                                              fixed scale_y,
                                              int h_flip,
                                              int v_flip,
                                              fixed xs[4],
                                              fixed ys[4]);

template<typename ImageTraits, typename BlendFunc>
static void image_scale_tpl(Image* dst,
                            const Image* src,
                            int dst_x,
                            int dst_y,
                            int dst_w,
                            int dst_h,
                            int src_x,
                            int src_y,
                            int src_w,
                            int src_h,
                            BlendFunc blend)
{
  LockImageBits<ImageTraits> dst_bits(dst, gfx::Rect(dst_x, dst_y, dst_w, dst_h));
  typename LockImageBits<ImageTraits>::iterator dst_it = dst_bits.begin();
  fixed x, first_x = itofix(src_x);
  fixed y = itofix(src_y);
  fixed dx = fixdiv(itofix(src_w - 1), itofix(dst_w - 1));
  fixed dy = fixdiv(itofix(src_h - 1), itofix(dst_h - 1));
  int old_x, new_x;

  for (int v = 0; v < dst_h; ++v) {
    old_x = fixtoi(x = first_x);

    const LockImageBits<ImageTraits> src_bits(src, gfx::Rect(src_x, fixtoi(y), src_w, 1));
    auto src_it = src_bits.begin();

    for (int u = 0; u < dst_w; ++u) {
      ASSERT(dst_it != dst_bits.end());

      *dst_it = blend(*dst_it, *src_it);
      ++dst_it;

      x = fixadd(x, dx);
      new_x = fixtoi(x);
      if (old_x != new_x) {
        // We don't want to move the "src_it" iterator outside the src
        // image bounds.
        if (new_x < src_w) {
          src_it += (new_x - old_x);
          old_x = new_x;
        }
        else
          break;
      }
    }

    y = fixadd(y, dy);
  }
}

static color_t rgba_blender(color_t back, color_t front)
{
  return rgba_blender_normal(back, front);
}

static color_t grayscale_blender(color_t back, color_t front)
{
  return graya_blender_normal(back, front);
}

class if_blender {
public:
  if_blender(color_t mask) : m_mask(mask) {}
  color_t operator()(color_t back, color_t front)
  {
    if (front != m_mask)
      return front;
    else
      return back;
  }

private:
  color_t m_mask;
};

void scale_image(Image* dst,
                 const Image* src,
                 int dst_x,
                 int dst_y,
                 int dst_w,
                 int dst_h,
                 int src_x,
                 int src_y,
                 int src_w,
                 int src_h)
{
  gfx::Clip clip(dst_x, dst_y, src_x, src_y, dst_w, dst_h);
  if (src_w == dst_w && src_h == dst_h) {
    dst->copy(src, clip);
    return;
  }

  if (!clip.clip(dst->width(), dst->height(), src->width(), src->height()))
    return;

  switch (dst->pixelFormat()) {
    case IMAGE_RGB:
      image_scale_tpl<
        RgbTraits>(dst, src, dst_x, dst_y, dst_w, dst_h, src_x, src_y, src_w, src_h, rgba_blender);
      break;

    case IMAGE_GRAYSCALE:
      image_scale_tpl<GrayscaleTraits>(dst,
                                       src,
                                       dst_x,
                                       dst_y,
                                       dst_w,
                                       dst_h,
                                       src_x,
                                       src_y,
                                       src_w,
                                       src_h,
                                       grayscale_blender);
      break;

    case IMAGE_INDEXED:
      image_scale_tpl<IndexedTraits>(dst,
                                     src,
                                     dst_x,
                                     dst_y,
                                     dst_w,
                                     dst_h,
                                     src_x,
                                     src_y,
                                     src_w,
                                     src_h,
                                     if_blender(src->maskColor()));
      break;

    case IMAGE_BITMAP:
      image_scale_tpl<BitmapTraits>(dst,
                                    src,
                                    dst_x,
                                    dst_y,
                                    dst_w,
                                    dst_h,
                                    src_x,
                                    src_y,
                                    src_w,
                                    src_h,
                                    if_blender(0));
      break;
  }
}

void rotate_image(Image* dst,
                  const Image* src,
                  int x,
                  int y,
                  int w,
                  int h,
                  int cx,
                  int cy,
                  double angle)
{
  fixed xs[4], ys[4];

  ase_rotate_scale_flip_coordinates(itofix(src->width()),
                                    itofix(src->height()),
                                    itofix(x),
                                    itofix(y),
                                    itofix(cx),
                                    itofix(cy),
                                    ftofix(256 * angle / PI),
                                    fixdiv(itofix(w), itofix(src->width())),
                                    fixdiv(itofix(h), itofix(src->height())),
                                    false,
                                    false,
                                    xs,
                                    ys);

  ase_parallelogram_map_standard(dst, src, nullptr, xs, ys);
}

/*    1-----2
      |     |
      4-----3
 */
void parallelogram(Image* bmp,
                   const Image* sprite,
                   const Image* mask,
                   int x1,
                   int y1,
                   int x2,
                   int y2,
                   int x3,
                   int y3,
                   int x4,
                   int y4)
{
  fixed xs[4], ys[4];

  xs[0] = itofix(x1);
  ys[0] = itofix(y1);
  xs[1] = itofix(x2);
  ys[1] = itofix(y2);
  xs[2] = itofix(x3);
  ys[2] = itofix(y3);
  xs[3] = itofix(x4);
  ys[3] = itofix(y4);

  ase_parallelogram_map_standard(bmp, sprite, mask, xs, ys);
}

// Scanline drawers.

template<class Traits, class Delegate>
static void draw_scanline(Image* bmp,
                          const Image* spr,
                          const Image* mask,
                          fixed l_bmp_x,
                          int bmp_y_i,
                          fixed r_bmp_x,
                          fixed l_spr_x,
                          fixed l_spr_y,
                          fixed spr_dx,
                          fixed spr_dy,
                          Delegate& delegate)
{
  r_bmp_x >>= 16;
  l_bmp_x >>= 16;

  delegate.lockBits(bmp, gfx::Rect(l_bmp_x, bmp_y_i, r_bmp_x - l_bmp_x + 1, 1));

  gfx::Rect maskBounds = (mask ? mask->bounds() : spr->bounds());

  for (int x = (int)l_bmp_x; x <= (int)r_bmp_x; ++x) {
    int u = l_spr_x >> 16;
    int v = l_spr_y >> 16;

    if (!mask || (maskBounds.contains(u, v) && get_pixel_fast<BitmapTraits>(mask, u, v)))
      delegate.putPixel(spr, u, v);
    delegate.nextPixel();

    l_spr_x += spr_dx;
    l_spr_y += spr_dy;
  }

  delegate.unlockBits();
}

template<class Traits>
class GenericDelegate {
public:
  void lockBits(Image* bmp, const gfx::Rect& bounds)
  {
    m_bits = bmp->lockBits<Traits>(Image::ReadWriteLock, bounds);
    m_it = m_bits.begin();
    m_end = m_bits.end();
  }

  void unlockBits() { m_bits.unlock(); }

  void nextPixel()
  {
    ASSERT(m_it != m_end);
    ++m_it;
  }

private:
  ImageBits<Traits> m_bits;

protected:
  typename LockImageBits<Traits>::iterator m_it, m_end;
};

class RgbDelegate : public GenericDelegate<RgbTraits> {
public:
  RgbDelegate(color_t mask_color) { m_mask_color = mask_color; }

  void putPixel(const Image* spr, int spr_x, int spr_y)
  {
    ASSERT(m_it != m_end);

    int c = get_pixel_fast<RgbTraits>(spr, spr_x, spr_y);
    if ((rgba_geta(m_mask_color) == 0) || ((c & rgba_rgb_mask) != (m_mask_color & rgba_rgb_mask)))
      *m_it = rgba_blender_normal(*m_it, c);
  }

private:
  color_t m_mask_color;
};

class GrayscaleDelegate : public GenericDelegate<GrayscaleTraits> {
public:
  GrayscaleDelegate(color_t mask_color) { m_mask_color = mask_color; }

  void putPixel(const Image* spr, int spr_x, int spr_y)
  {
    ASSERT(m_it != m_end);

    int c = get_pixel_fast<GrayscaleTraits>(spr, spr_x, spr_y);
    if ((graya_geta(m_mask_color) == 0) || ((c & graya_v_mask) != (m_mask_color & graya_v_mask)))
      *m_it = graya_blender_normal(*m_it, c, 255);
  }

private:
  color_t m_mask_color;
};

class IndexedDelegate : public GenericDelegate<IndexedTraits> {
public:
  IndexedDelegate(color_t mask_color) : m_mask_color(mask_color) {}

  void putPixel(const Image* spr, int spr_x, int spr_y)
  {
    ASSERT(m_it != m_end);

    color_t c = get_pixel_fast<IndexedTraits>(spr, spr_x, spr_y);
    if (c != m_mask_color)
      *m_it = c;
  }

private:
  color_t m_mask_color;
};

class BitmapDelegate : public GenericDelegate<BitmapTraits> {
public:
  void putPixel(const Image* spr, int spr_x, int spr_y)
  {
    ASSERT(m_it != m_end);

    int c = get_pixel_fast<BitmapTraits>(spr, spr_x, spr_y);
    if (c != 0) // TODO
      *m_it = c;
  }
};

class TilemapDelegate : public GenericDelegate<TilemapTraits> {
public:
  TilemapDelegate(color_t mask_color) : m_mask_color(mask_color) {}

  void putPixel(const Image* spr, int spr_x, int spr_y)
  {
    ASSERT(m_it != m_end);

    color_t c = get_pixel_fast<TilemapTraits>(spr, spr_x, spr_y);
    if (c != m_mask_color)
      *m_it = c;
  }

private:
  color_t m_mask_color;
};

/* _parallelogram_map:
 *  Worker routine for drawing rotated and/or scaled and/or flipped sprites:
 *  It actually maps the sprite to any parallelogram-shaped area of the
 *  bitmap. The top left corner is mapped to (xs[0], ys[0]), the top right to
 *  (xs[1], ys[1]), the bottom right to x (xs[2], ys[2]), and the bottom left
 *  to (xs[3], ys[3]). The corners are assumed to form a perfect
 *  parallelogram, i.e. xs[0]+xs[2] = xs[1]+xs[3]. The corners are given in
 *  fixed point format, so xs[] and ys[] are coordinates of the outer corners
 *  of corner pixels in clockwise order beginning with top left.
 *  All coordinates begin with 0 in top left corner of pixel (0, 0). So a
 *  rotation by 0 degrees of a sprite to the top left of a bitmap can be
 *  specified with coordinates (0, 0) for the top left pixel in source
 *  bitmap. With the default scanline drawer, a pixel in the destination
 *  bitmap is drawn if and only if its center is covered by any pixel in the
 *  sprite. The color of this covering sprite pixel is used to draw.
 *  If sub_pixel_accuracy=false, then the scanline drawer will be called with
 *  *_bmp_x being a fixed point representation of the integers representing
 *  the x coordinate of the first and last point in bmp whose centre is
 *  covered by the sprite. If sub_pixel_accuracy=true, then the scanline
 *  drawer will be called with the exact fixed point position of the first
 *  and last point in which the horizontal line passing through the centre is
 *  at least partly covered by the sprite. This is useful for doing
 *  anti-aliased blending.
 */
template<class Traits, class Delegate>
static void ase_parallelogram_map(Image* bmp,
                                  const Image* spr,
                                  const Image* mask,
                                  fixed xs[4],
                                  fixed ys[4],
                                  int sub_pixel_accuracy,
                                  Delegate delegate)
{
  /* Index in xs[] and ys[] to topmost point. */
  int top_index;
  /* Rightmost point has index (top_index+right_index) int xs[] and ys[]. */
  int right_index;
  /* Loop variables. */
  int index, i;
  /* Coordinates in bmp ordered as top-right-bottom-left. */
  fixed corner_bmp_x[4], corner_bmp_y[4];
  /* Coordinates in spr ordered as top-right-bottom-left. */
  fixed corner_spr_x[4], corner_spr_y[4];
  /* y coordinate of bottom point, left point and right point. */
  int clip_bottom_i, l_bmp_y_bottom_i, r_bmp_y_bottom_i;
  /* Left and right clipping. */
  fixed clip_left, clip_right;
  /* Temporary variable. */
  fixed extra_scanline_fraction;

  /*
   * Variables used in the loop
   */
  /* Coordinates of sprite and bmp points in beginning of scanline. */
  fixed l_spr_x, l_spr_y, l_bmp_x, l_bmp_dx;
  /* Increment of left sprite point as we move a scanline down. */
  fixed l_spr_dx, l_spr_dy;
  /* Coordinates of sprite and bmp points in end of scanline. */
  fixed r_bmp_x, r_bmp_dx;
#ifdef KEEP_TRACK_OF_RIGHT_SPRITE_SCANLINE
  fixed r_spr_x, r_spr_y;
  /* Increment of right sprite point as we move a scanline down. */
  fixed r_spr_dx, r_spr_dy;
#endif
  /* Increment of sprite point as we move right inside a scanline. */
  fixed spr_dx, spr_dy;
  /* Positions of beginning of scanline after rounding to integer coordinate
     in bmp. */
  fixed l_spr_x_rounded, l_spr_y_rounded, l_bmp_x_rounded;
  fixed r_bmp_x_rounded;
  /* Current scanline. */
  int bmp_y_i;
  /* Right edge of scanline. */
  int right_edge_test;

  /* Get index of topmost point. */
  top_index = 0;
  if (ys[1] < ys[0])
    top_index = 1;
  if (ys[2] < ys[top_index])
    top_index = 2;
  if (ys[3] < ys[top_index])
    top_index = 3;

  /* Get direction of points: clockwise or anti-clockwise. */
  if (fixmul(xs[(top_index + 1) & 3] - xs[top_index], ys[(top_index - 1) & 3] - ys[top_index]) >
      fixmul(xs[(top_index - 1) & 3] - xs[top_index], ys[(top_index + 1) & 3] - ys[top_index]))
    right_index = 1;
  else
    right_index = -1;

  /*
   * Get coordinates of the corners.
   */

  /* corner_*[0] is top, [1] is right, [2] is bottom, [3] is left. */
  index = top_index;
  for (i = 0; i < 4; i++) {
    corner_bmp_x[i] = xs[index];
    corner_bmp_y[i] = ys[index];
    if (index < 2)
      corner_spr_y[i] = 0;
    else
      /* Need `- 1' since otherwise it would be outside sprite. */
      corner_spr_y[i] = (spr->height() << 16) - 1;
    if ((index == 0) || (index == 3))
      corner_spr_x[i] = 0;
    else
      corner_spr_x[i] = (spr->width() << 16) - 1;
    index = (index + right_index) & 3;
  }

  /*
   * Get scanline starts, ends and deltas, and clipping coordinates.
   */
#define top_bmp_y    corner_bmp_y[0]
#define right_bmp_y  corner_bmp_y[1]
#define bottom_bmp_y corner_bmp_y[2]
#define left_bmp_y   corner_bmp_y[3]
#define top_bmp_x    corner_bmp_x[0]
#define right_bmp_x  corner_bmp_x[1]
#define bottom_bmp_x corner_bmp_x[2]
#define left_bmp_x   corner_bmp_x[3]
#define top_spr_y    corner_spr_y[0]
#define right_spr_y  corner_spr_y[1]
#define bottom_spr_y corner_spr_y[2]
#define left_spr_y   corner_spr_y[3]
#define top_spr_x    corner_spr_x[0]
#define right_spr_x  corner_spr_x[1]
#define bottom_spr_x corner_spr_x[2]
#define left_spr_x   corner_spr_x[3]

  /* Calculate left and right clipping. */
  clip_left = 0;
  clip_right = (bmp->width() << 16) - 1;

  /* Quit if we're totally outside. */
  if ((left_bmp_x > clip_right) && (top_bmp_x > clip_right) && (bottom_bmp_x > clip_right))
    return;
  if ((right_bmp_x < clip_left) && (top_bmp_x < clip_left) && (bottom_bmp_x < clip_left))
    return;

  /* Bottom clipping. */
  if (sub_pixel_accuracy)
    clip_bottom_i = (bottom_bmp_y + 0xffff) >> 16;
  else
    clip_bottom_i = (bottom_bmp_y + 0x8000) >> 16;

  if (clip_bottom_i > bmp->height())
    clip_bottom_i = bmp->height();

  /* Calculate y coordinate of first scanline. */
  if (sub_pixel_accuracy)
    bmp_y_i = top_bmp_y >> 16;
  else
    bmp_y_i = (top_bmp_y + 0x8000) >> 16;

  if (bmp_y_i < 0)
    bmp_y_i = 0;

  /* Sprite is above or below bottom clipping area. */
  if (bmp_y_i >= clip_bottom_i)
    return;

  /* Vertical gap between top corner and centre of topmost scanline. */
  extra_scanline_fraction = (bmp_y_i << 16) + 0x8000 - top_bmp_y;
  /* Calculate x coordinate of beginning of scanline in bmp. */
  l_bmp_dx = fixdiv(left_bmp_x - top_bmp_x, left_bmp_y - top_bmp_y);
  l_bmp_x = top_bmp_x + fixmul(extra_scanline_fraction, l_bmp_dx);
  /* Calculate x coordinate of beginning of scanline in spr. */
  /* note: all these are rounded down which is probably a Good Thing (tm) */
  l_spr_dx = fixdiv(left_spr_x - top_spr_x, left_bmp_y - top_bmp_y);
  l_spr_x = top_spr_x + fixmul(extra_scanline_fraction, l_spr_dx);
  /* Calculate y coordinate of beginning of scanline in spr. */
  l_spr_dy = fixdiv(left_spr_y - top_spr_y, left_bmp_y - top_bmp_y);
  l_spr_y = top_spr_y + fixmul(extra_scanline_fraction, l_spr_dy);

  /* Calculate left loop bound. */
  l_bmp_y_bottom_i = (left_bmp_y + 0x8000) >> 16;
  if (l_bmp_y_bottom_i > clip_bottom_i)
    l_bmp_y_bottom_i = clip_bottom_i;

  /* Calculate x coordinate of end of scanline in bmp. */
  r_bmp_dx = fixdiv(right_bmp_x - top_bmp_x, right_bmp_y - top_bmp_y);
  r_bmp_x = top_bmp_x + fixmul(extra_scanline_fraction, r_bmp_dx);
#ifdef KEEP_TRACK_OF_RIGHT_SPRITE_SCANLINE
  /* Calculate x coordinate of end of scanline in spr. */
  r_spr_dx = fixdiv(right_spr_x - top_spr_x, right_bmp_y - top_bmp_y);
  r_spr_x = top_spr_x + fixmul(extra_scanline_fraction, r_spr_dx);
  /* Calculate y coordinate of end of scanline in spr. */
  r_spr_dy = fixdiv(right_spr_y - top_spr_y, right_bmp_y - top_bmp_y);
  r_spr_y = top_spr_y + fixmul(extra_scanline_fraction, r_spr_dy);
#endif

  /* Calculate right loop bound. */
  r_bmp_y_bottom_i = (right_bmp_y + 0x8000) >> 16;

  /* Get dx and dy, the offsets to add to the source coordinates as we move
     one pixel rightwards along a scanline. This formula can be derived by
     considering the 2x2 matrix that transforms the sprite to the
     parallelogram.
     We'd better use double to get this as exact as possible, since any
     errors will be accumulated along the scanline.
  */
  spr_dx = (fixed)((ys[3] - ys[0]) * 65536.0 * (65536.0 * spr->width()) /
                   ((xs[1] - xs[0]) * (double)(ys[3] - ys[0]) -
                    (xs[3] - xs[0]) * (double)(ys[1] - ys[0])));
  spr_dy = (fixed)((ys[1] - ys[0]) * 65536.0 * (65536.0 * spr->height()) /
                   ((xs[3] - xs[0]) * (double)(ys[1] - ys[0]) -
                    (xs[1] - xs[0]) * (double)(ys[3] - ys[0])));

  /*
   * Loop through scanlines.
   */

  while (1) {
    /* Has beginning of scanline passed a corner? */
    if (bmp_y_i >= l_bmp_y_bottom_i) {
      /* Are we done? */
      if (bmp_y_i >= clip_bottom_i)
        break;

      /* Vertical gap between left corner and centre of scanline. */
      extra_scanline_fraction = (bmp_y_i << 16) + 0x8000 - left_bmp_y;
      /* Update x coordinate of beginning of scanline in bmp. */
      l_bmp_dx = fixdiv(bottom_bmp_x - left_bmp_x, bottom_bmp_y - left_bmp_y);
      l_bmp_x = left_bmp_x + fixmul(extra_scanline_fraction, l_bmp_dx);
      /* Update x coordinate of beginning of scanline in spr. */
      l_spr_dx = fixdiv(bottom_spr_x - left_spr_x, bottom_bmp_y - left_bmp_y);
      l_spr_x = left_spr_x + fixmul(extra_scanline_fraction, l_spr_dx);
      /* Update y coordinate of beginning of scanline in spr. */
      l_spr_dy = fixdiv(bottom_spr_y - left_spr_y, bottom_bmp_y - left_bmp_y);
      l_spr_y = left_spr_y + fixmul(extra_scanline_fraction, l_spr_dy);

      /* Update loop bound. */
      if (sub_pixel_accuracy)
        l_bmp_y_bottom_i = (bottom_bmp_y + 0xffff) >> 16;
      else
        l_bmp_y_bottom_i = (bottom_bmp_y + 0x8000) >> 16;
      if (l_bmp_y_bottom_i > clip_bottom_i)
        l_bmp_y_bottom_i = clip_bottom_i;
    }

    /* Has end of scanline passed a corner? */
    if (bmp_y_i >= r_bmp_y_bottom_i) {
      /* Vertical gap between right corner and centre of scanline. */
      extra_scanline_fraction = (bmp_y_i << 16) + 0x8000 - right_bmp_y;
      /* Update x coordinate of end of scanline in bmp. */
      r_bmp_dx = fixdiv(bottom_bmp_x - right_bmp_x, bottom_bmp_y - right_bmp_y);
      r_bmp_x = right_bmp_x + fixmul(extra_scanline_fraction, r_bmp_dx);
#ifdef KEEP_TRACK_OF_RIGHT_SPRITE_SCANLINE
      /* Update x coordinate of beginning of scanline in spr. */
      r_spr_dx = fixdiv(bottom_spr_x - right_spr_x, bottom_bmp_y - right_bmp_y);
      r_spr_x = right_spr_x + fixmul(extra_scanline_fraction, r_spr_dx);
      /* Update y coordinate of beginning of scanline in spr. */
      r_spr_dy = fixdiv(bottom_spr_y - right_spr_y, bottom_bmp_y - right_bmp_y);
      r_spr_y = right_spr_y + fixmul(extra_scanline_fraction, r_spr_dy);
#endif

      /* Update loop bound: We aren't supposed to use this any more, so
         just set it to some big enough value. */
      r_bmp_y_bottom_i = clip_bottom_i;
    }

    /* Make left bmp coordinate be an integer and clip it. */
    if (sub_pixel_accuracy)
      l_bmp_x_rounded = l_bmp_x;
    else
      l_bmp_x_rounded = (l_bmp_x + 0x8000) & ~0xffff;
    if (l_bmp_x_rounded < clip_left)
      l_bmp_x_rounded = clip_left;

    /* ... and move starting point in sprite accordingly. */
    if (sub_pixel_accuracy) {
      l_spr_x_rounded = l_spr_x + fixmul((l_bmp_x_rounded - l_bmp_x), spr_dx);
      l_spr_y_rounded = l_spr_y + fixmul((l_bmp_x_rounded - l_bmp_x), spr_dy);
    }
    else {
      l_spr_x_rounded = l_spr_x + fixmul(l_bmp_x_rounded + 0x7fff - l_bmp_x, spr_dx);
      l_spr_y_rounded = l_spr_y + fixmul(l_bmp_x_rounded + 0x7fff - l_bmp_x, spr_dy);
    }

    /* Make right bmp coordinate be an integer and clip it. */
    if (sub_pixel_accuracy)
      r_bmp_x_rounded = r_bmp_x;
    else
      r_bmp_x_rounded = (r_bmp_x - 0x8000) & ~0xffff;
    if (r_bmp_x_rounded > clip_right)
      r_bmp_x_rounded = clip_right;

    /* Draw! */
    if (l_bmp_x_rounded <= r_bmp_x_rounded) {
      if (!sub_pixel_accuracy) {
        /* The bodies of these ifs are only reached extremely seldom,
           it's an ugly hack to avoid reading outside the sprite when
           the rounding errors are accumulated the wrong way. It would
           be nicer if we could ensure that this never happens by making
           all multiplications and divisions be rounded up or down at
           the correct places.
           I did try another approach: recalculate the edges of the
           scanline from scratch each scanline rather than incrementally.
           Drawing a sprite with that routine took about 25% longer time
           though.
        */
        if ((unsigned)(l_spr_x_rounded >> 16) >= (unsigned)spr->width()) {
          if (((l_spr_x_rounded < 0) && (spr_dx <= 0)) ||
              ((l_spr_x_rounded > 0) && (spr_dx >= 0))) {
            /* This can happen. */
            goto skip_draw;
          }
          else {
            /* I don't think this can happen, but I can't prove it. */
            do {
              l_spr_x_rounded += spr_dx;
              l_bmp_x_rounded += 65536;
              if (l_bmp_x_rounded > r_bmp_x_rounded)
                goto skip_draw;
            } while ((unsigned)(l_spr_x_rounded >> 16) >= (unsigned)spr->width());
          }
        }
        right_edge_test = l_spr_x_rounded + ((r_bmp_x_rounded - l_bmp_x_rounded) >> 16) * spr_dx;
        if ((unsigned)(right_edge_test >> 16) >= (unsigned)spr->width()) {
          if (((right_edge_test < 0) && (spr_dx <= 0)) ||
              ((right_edge_test > 0) && (spr_dx >= 0))) {
            /* This can happen. */
            do {
              r_bmp_x_rounded -= 65536;
              right_edge_test -= spr_dx;
              if (l_bmp_x_rounded > r_bmp_x_rounded)
                goto skip_draw;
            } while ((unsigned)(right_edge_test >> 16) >= (unsigned)spr->width());
          }
          else {
            /* I don't think this can happen, but I can't prove it. */
            goto skip_draw;
          }
        }
        if ((unsigned)(l_spr_y_rounded >> 16) >= (unsigned)spr->height()) {
          if (((l_spr_y_rounded < 0) && (spr_dy <= 0)) ||
              ((l_spr_y_rounded > 0) && (spr_dy >= 0))) {
            /* This can happen. */
            goto skip_draw;
          }
          else {
            /* I don't think this can happen, but I can't prove it. */
            do {
              l_spr_y_rounded += spr_dy;
              l_bmp_x_rounded += 65536;
              if (l_bmp_x_rounded > r_bmp_x_rounded)
                goto skip_draw;
            } while (((unsigned)l_spr_y_rounded >> 16) >= (unsigned)spr->height());
          }
        }
        right_edge_test = l_spr_y_rounded + ((r_bmp_x_rounded - l_bmp_x_rounded) >> 16) * spr_dy;
        if ((unsigned)(right_edge_test >> 16) >= (unsigned)spr->height()) {
          if (((right_edge_test < 0) && (spr_dy <= 0)) ||
              ((right_edge_test > 0) && (spr_dy >= 0))) {
            /* This can happen. */
            do {
              r_bmp_x_rounded -= 65536;
              right_edge_test -= spr_dy;
              if (l_bmp_x_rounded > r_bmp_x_rounded)
                goto skip_draw;
            } while ((unsigned)(right_edge_test >> 16) >= (unsigned)spr->height());
          }
          else {
            /* I don't think this can happen, but I can't prove it. */
            goto skip_draw;
          }
        }
      }
      draw_scanline<Traits, Delegate>(bmp,
                                      spr,
                                      mask,
                                      l_bmp_x_rounded,
                                      bmp_y_i,
                                      r_bmp_x_rounded,
                                      l_spr_x_rounded,
                                      l_spr_y_rounded,
                                      spr_dx,
                                      spr_dy,
                                      delegate);
    }
    /* I'm not going to apoligize for this label and its gotos: to get
       rid of it would just make the code look worse. */
  skip_draw:

    /* Jump to next scanline. */
    bmp_y_i++;
    /* Update beginning of scanline. */
    l_bmp_x += l_bmp_dx;
    l_spr_x += l_spr_dx;
    l_spr_y += l_spr_dy;
    /* Update end of scanline. */
    r_bmp_x += r_bmp_dx;
#ifdef KEEP_TRACK_OF_RIGHT_SPRITE_SCANLINE
    r_spr_x += r_spr_dx;
    r_spr_y += r_spr_dy;
#endif
  }
}

/* _parallelogram_map_standard:
 *  Helper function for calling _parallelogram_map() with the appropriate
 *  scanline drawer. I didn't want to include this in the
 *  _parallelogram_map() function since then you can bypass it and define
 *  your own scanline drawer, eg. for anti-aliased rotations.
 */
static void ase_parallelogram_map_standard(Image* bmp,
                                           const Image* sprite,
                                           const Image* mask,
                                           fixed xs[4],
                                           fixed ys[4])
{
  switch (bmp->pixelFormat()) {
    case IMAGE_RGB: {
      RgbDelegate delegate(sprite->maskColor());
      ase_parallelogram_map<RgbTraits, RgbDelegate>(bmp, sprite, mask, xs, ys, false, delegate);
      break;
    }

    case IMAGE_GRAYSCALE: {
      GrayscaleDelegate delegate(sprite->maskColor());
      ase_parallelogram_map<GrayscaleTraits, GrayscaleDelegate>(bmp,
                                                                sprite,
                                                                mask,
                                                                xs,
                                                                ys,
                                                                false,
                                                                delegate);
      break;
    }

    case IMAGE_INDEXED: {
      IndexedDelegate delegate(sprite->maskColor());
      ase_parallelogram_map<IndexedTraits, IndexedDelegate>(bmp,
                                                            sprite,
                                                            mask,
                                                            xs,
                                                            ys,
                                                            false,
                                                            delegate);
      break;
    }

    case IMAGE_BITMAP: {
      BitmapDelegate delegate;
      ase_parallelogram_map<BitmapTraits, BitmapDelegate>(bmp,
                                                          sprite,
                                                          mask,
                                                          xs,
                                                          ys,
                                                          false,
                                                          delegate);
      break;
    }

    case IMAGE_TILEMAP: {
      TilemapDelegate delegate(sprite->maskColor());
      ase_parallelogram_map<TilemapTraits, TilemapDelegate>(bmp,
                                                            sprite,
                                                            mask,
                                                            xs,
                                                            ys,
                                                            false,
                                                            delegate);
      break;
    }
  }
}

/* _rotate_scale_flip_coordinates:
 *  Calculates the coordinates for the rotated, scaled and flipped sprite,
 *  and passes them on to the given function.
 */
static void ase_rotate_scale_flip_coordinates(fixed w,
                                              fixed h,
                                              fixed x,
                                              fixed y,
                                              fixed cx,
                                              fixed cy,
                                              fixed angle,
                                              fixed scale_x,
                                              fixed scale_y,
                                              int h_flip,
                                              int v_flip,
                                              fixed xs[4],
                                              fixed ys[4])
{
  fixed fix_cos, fix_sin;
  int tl = 0, tr = 1, bl = 3, br = 2;
  int tmp;
  double cos_angle, sin_angle;
  fixed xofs, yofs;

  /* Setting angle to the range -180...180 degrees makes sin & cos
     more numerically stable. (Yes, this does have an effect for big
     angles!) Note that using "real" sin() and cos() gives much better
     precision than fixsin() and fixcos(). */
  angle = angle & 0xffffff;
  if (angle >= 0x800000)
    angle -= 0x1000000;

  cos_angle = cos(angle * (PI / (double)0x800000));
  sin_angle = sin(angle * (PI / (double)0x800000));

  if (cos_angle >= 0)
    fix_cos = (int)(cos_angle * 0x10000 + 0.5);
  else
    fix_cos = (int)(cos_angle * 0x10000 - 0.5);
  if (sin_angle >= 0)
    fix_sin = (int)(sin_angle * 0x10000 + 0.5);
  else
    fix_sin = (int)(sin_angle * 0x10000 - 0.5);

  /* Decide what order to take corners in. */
  if (v_flip) {
    tl = 3;
    tr = 2;
    bl = 0;
    br = 1;
  }
  else {
    tl = 0;
    tr = 1;
    bl = 3;
    br = 2;
  }
  if (h_flip) {
    tmp = tl;
    tl = tr;
    tr = tmp;
    tmp = bl;
    bl = br;
    br = tmp;
  }

  /* Calculate new coordinates of all corners. */
  w = fixmul(w, scale_x);
  h = fixmul(h, scale_y);
  cx = fixmul(cx, scale_x);
  cy = fixmul(cy, scale_y);

  xofs = x - fixmul(cx, fix_cos) + fixmul(cy, fix_sin);

  yofs = y - fixmul(cx, fix_sin) - fixmul(cy, fix_cos);

  xs[tl] = xofs;
  ys[tl] = yofs;
  xs[tr] = xofs + fixmul(w, fix_cos);
  ys[tr] = yofs + fixmul(w, fix_sin);
  xs[bl] = xofs - fixmul(h, fix_sin);
  ys[bl] = yofs + fixmul(h, fix_cos);

  xs[br] = xs[tr] + xs[bl] - xs[tl];
  ys[br] = ys[tr] + ys[bl] - ys[tl];
}

}} // namespace doc::algorithm
