/* -*- mode: java; c-basic-offset: 2; indent-tabs-mode: nil -*- */

/*
 * Copyright (c) 2007, Oracle and/or its affiliates. All rights reserved.
 * DO NOT ALTER OR REMOVE COPYRIGHT NOTICES OR THIS FILE HEADER.
 *
 * This code is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License version 2 only, as
 * published by the Free Software Foundation.  Oracle designates this
 * particular file as subject to the "Classpath" exception as provided
 * by Oracle in the LICENSE file that accompanied this code.
 *
 * This code 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
 * version 2 for more details (a copy is included in the LICENSE file that
 * accompanied this code).
 *
 * You should have received a copy of the GNU General Public License version
 * 2 along with this work; if not, write to the Free Software Foundation,
 * Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA.
 *
 * Please contact Oracle, 500 Oracle Parkway, Redwood Shores, CA 94065 USA
 * or visit www.oracle.com if you need additional information or have any
 * questions.
 */

package processing.opengl;

import processing.core.PMatrix2D;

/**
 *
 * @author Martin Prout
 */
public class LineStroker  {
  private LineStroker output;
  private int capStyle;
  private int joinStyle;
  private int m00, m01;
  private int m10, m11;
  private int lineWidth2;
  private long scaledLineWidth2;

  // For any pen offset (pen_dx, pen_dy) that does not depend on
  // the line orientation, the pen should be transformed so that:
  //
  // pen_dx' = m00*pen_dx + m01*pen_dy
  // pen_dy' = m10*pen_dx + m11*pen_dy
  //
  // For a round pen, this means:
  //
  // pen_dx(r, theta) = r*cos(theta)
  // pen_dy(r, theta) = r*sin(theta)
  //
  // pen_dx'(r, theta) = r*(m00*cos(theta) + m01*sin(theta))
  // pen_dy'(r, theta) = r*(m10*cos(theta) + m11*sin(theta))
  private int numPenSegments;
  private int[] pen_dx;
  private int[] pen_dy;

  private boolean[] penIncluded;
  private int[] join;
  private final int[] offset = new int[2];
  private int[] reverse = new int[100];
  private final int[] miter = new int[2];
  private long miterLimitSq;
  private int prev;
  private int rindex;
  private boolean started;
  private boolean lineToOrigin;
  private boolean joinToOrigin;
  private int sx0, sy0, sx1, sy1, x0, y0;
  private int scolor0, pcolor0, color0;
  private int mx0, my0, omx, omy;
  private int px0, py0;
  private double m00_2_m01_2;
  private double m10_2_m11_2;
  private double m00_m10_m01_m11;

  /**
   * Empty constructor. <code>setOutput</code> and <code>setParameters</code>
   * must be called prior to calling any other methods.
   */
  public LineStroker() {
  }

  /**
   * Constructs a <code>LineStroker</code>.
   *
   * @param output
   *          an output <code>LineStroker</code>.
   * @param lineWidth
   *          the desired line width in pixels, in S15.16 format.
   * @param capStyle
   *          the desired end cap style, one of <code>CAP_BUTT</code>,
   *          <code>CAP_ROUND</code> or <code>CAP_SQUARE</code>.
   * @param joinStyle
   *          the desired line join style, one of <code>JOIN_MITER</code>,
   *          <code>JOIN_ROUND</code> or <code>JOIN_BEVEL</code>.
   * @param miterLimit
   *          the desired miter limit, in S15.16 format.
   * @param transform
   *          a <code>Transform4</code> object indicating the transform that has
   *          been previously applied to all incoming coordinates. This is
   *          required in order to produce consistently shaped end caps and
   *          joins.
   */
  public LineStroker(LineStroker output, int lineWidth, int capStyle, int joinStyle,
                 int miterLimit, PMatrix2D transform) {
    setOutput(output);
    setParameters(lineWidth, capStyle, joinStyle, miterLimit, transform);
  }

  /**
   * Sets the output <code>LineStroker</code> of this <code>LineStroker</code>.
   *
   * @param output
   *          an output <code>LineStroker</code>.
   */
  private void setOutput(LineStroker output) {
    this.output = output;
  }

  /**
   * Sets the parameters of this <code>LineStroker</code>.
   *
   * @param lineWidth
   *          the desired line width in pixels, in S15.16 format.
   * @param capStyle
   *          the desired end cap style, one of <code>CAP_BUTT</code>,
   *          <code>CAP_ROUND</code> or <code>CAP_SQUARE</code>.
   * @param joinStyle
   *          the desired line join style, one of <code>JOIN_MITER</code>,
   *          <code>JOIN_ROUND</code> or <code>JOIN_BEVEL</code>.
   * @param miterLimit
   *          the desired miter limit, in S15.16 format.
   * @param transform
   *          a <code>Transform4</code> object indicating the transform that has
   *          been previously applied to all incoming coordinates. This is
   *          required in order to produce consistently shaped end caps and
   *          joins.
   */
  public final void setParameters(int lineWidth, int capStyle, int joinStyle,
                            int miterLimit, PMatrix2D transform) {
    this.m00 = LinePath.FloatToS15_16(transform.m00);
    this.m01 = LinePath.FloatToS15_16(transform.m01);
    this.m10 = LinePath.FloatToS15_16(transform.m10);
    this.m11 = LinePath.FloatToS15_16(transform.m11);

    this.lineWidth2 = lineWidth >> 1;
    this.scaledLineWidth2 = ((long) m00 * lineWidth2) >> 16;
    this.capStyle = capStyle;
    this.joinStyle = joinStyle;

    this.m00_2_m01_2 = (double) m00 * m00 + (double) m01 * m01;
    this.m10_2_m11_2 = (double) m10 * m10 + (double) m11 * m11;
    this.m00_m10_m01_m11 = (double) m00 * m10 + (double) m01 * m11;

    double dm00 = m00 / 65536.0;
    double dm01 = m01 / 65536.0;
    double dm10 = m10 / 65536.0;
    double dm11 = m11 / 65536.0;
    double determinant = dm00 * dm11 - dm01 * dm10;

    if (joinStyle == LinePath.JOIN_MITER) {
      double limit = (miterLimit / 65536.0) * (lineWidth2 / 65536.0)
        * determinant;
      double limitSq = limit * limit;
      this.miterLimitSq = (long) (limitSq * 65536.0 * 65536.0);
    }

    this.numPenSegments = (int) (3.14159f * lineWidth / 65536.0f);
    if (pen_dx == null || pen_dx.length < numPenSegments) {
      this.pen_dx = new int[numPenSegments];
      this.pen_dy = new int[numPenSegments];
      this.penIncluded = new boolean[numPenSegments];
      this.join = new int[2 * numPenSegments];
    }

    for (int i = 0; i < numPenSegments; i++) {
      double r = lineWidth / 2.0;
      double theta = i * 2 * Math.PI / numPenSegments;

      double cos = Math.cos(theta);
      double sin = Math.sin(theta);
      pen_dx[i] = (int) (r * (dm00 * cos + dm01 * sin));
      pen_dy[i] = (int) (r * (dm10 * cos + dm11 * sin));
    }

    prev = LinePath.SEG_CLOSE;
    rindex = 0;
    started = false;
    lineToOrigin = false;
  }

  private void computeOffset(int x0, int y0, int x1, int y1, int[] m) {
    long lx = (long) x1 - (long) x0;
    long ly = (long) y1 - (long) y0;

    int dx, dy;
    if (m00 > 0 && m00 == m11 && m01 == 0 & m10 == 0) {
      long ilen = LinePath.hypot(lx, ly);
      if (ilen == 0) {
        dx = dy = 0;
      } else {
        dx = (int) ((ly * scaledLineWidth2) / ilen);
        dy = (int) (-(lx * scaledLineWidth2) / ilen);
      }
    } else {
      double dlx = x1 - x0;
      double dly = y1 - y0;
      double det = (double) m00 * m11 - (double) m01 * m10;
      int sdet = (det > 0) ? 1 : -1;
      double a = dly * m00 - dlx * m10;
      double b = dly * m01 - dlx * m11;
      double dh = LinePath.hypot(a, b);
      double div = sdet * lineWidth2 / (65536.0 * dh);
      double ddx = dly * m00_2_m01_2 - dlx * m00_m10_m01_m11;
      double ddy = dly * m00_m10_m01_m11 - dlx * m10_2_m11_2;
      dx = (int) (ddx * div);
      dy = (int) (ddy * div);
    }

    m[0] = dx;
    m[1] = dy;
  }

  private void ensureCapacity(int newrindex) {
    if (reverse.length < newrindex) {
      int[] tmp = new int[Math.max(newrindex, 6 * reverse.length / 5)];
      System.arraycopy(reverse, 0, tmp, 0, rindex);
      this.reverse = tmp;
    }
  }

  private boolean isCCW(int x0, int y0, int x1, int y1, int x2, int y2) {
    int dx0 = x1 - x0;
    int dy0 = y1 - y0;
    int dx1 = x2 - x1;
    int dy1 = y2 - y1;
    return (long) dx0 * dy1 < (long) dy0 * dx1;
  }

  private boolean side(int x, int y, int x0, int y0, int x1, int y1) {
    long lx = x;
    long ly = y;
    long lx0 = x0;
    long ly0 = y0;
    long lx1 = x1;
    long ly1 = y1;

    return (ly0 - ly1) * lx + (lx1 - lx0) * ly + (lx0 * ly1 - lx1 * ly0) > 0;
  }

  private int computeRoundJoin(int cx, int cy, int xa, int ya, int xb, int yb,
                               int side, boolean flip, int[] join) {
    int px, py;
    int ncoords = 0;

    boolean centerSide;
    if (side == 0) {
      centerSide = side(cx, cy, xa, ya, xb, yb);
    } else {
      centerSide = (side == 1);
    }
    for (int i = 0; i < numPenSegments; i++) {
      px = cx + pen_dx[i];
      py = cy + pen_dy[i];

      boolean penSide = side(px, py, xa, ya, xb, yb);
      penIncluded[i] = penSide != centerSide;
    }

    int start = -1, end = -1;
    for (int i = 0; i < numPenSegments; i++) {
      if (penIncluded[i]
        && !penIncluded[(i + numPenSegments - 1) % numPenSegments]) {
        start = i;
      }
      if (penIncluded[i] && !penIncluded[(i + 1) % numPenSegments]) {
        end = i;
      }
    }

    if (end < start) {
      end += numPenSegments;
    }

    if (start != -1 && end != -1) {
      long dxa = cx + pen_dx[start] - xa;
      long dya = cy + pen_dy[start] - ya;
      long dxb = cx + pen_dx[start] - xb;
      long dyb = cy + pen_dy[start] - yb;

      boolean rev = (dxa * dxa + dya * dya > dxb * dxb + dyb * dyb);
      int i = rev ? end : start;
      int incr = rev ? -1 : 1;
      while (true) {
        int idx = i % numPenSegments;
        px = cx + pen_dx[idx];
        py = cy + pen_dy[idx];
        join[ncoords++] = px;
        join[ncoords++] = py;
        if (i == (rev ? start : end)) {
          break;
        }
        i += incr;
      }
    }

    return ncoords / 2;
  }

  //private static final long ROUND_JOIN_THRESHOLD = 1000L;
  private static final long ROUND_JOIN_THRESHOLD = 100000000L;

  private static final long ROUND_JOIN_INTERNAL_THRESHOLD = 1000000000L;

  private void drawRoundJoin(int x, int y, int omx, int omy, int mx, int my,
                             int side, int color,
                             boolean flip, boolean rev, long threshold) {
    if ((omx == 0 && omy == 0) || (mx == 0 && my == 0)) {
      return;
    }

    long domx = (long) omx - mx;
    long domy = (long) omy - my;
    long len = domx * domx + domy * domy;
    if (len < threshold) {
      return;
    }

    if (rev) {
      omx = -omx;
      omy = -omy;
      mx = -mx;
      my = -my;
    }

    int bx0 = x + omx;
    int by0 = y + omy;
    int bx1 = x + mx;
    int by1 = y + my;

    int npoints = computeRoundJoin(x, y, bx0, by0, bx1, by1, side, flip, join);
    for (int i = 0; i < npoints; i++) {
      emitLineTo(join[2 * i], join[2 * i + 1], color, rev);
    }
  }

  // Return the intersection point of the lines (ix0, iy0) -> (ix1, iy1)
  // and (ix0p, iy0p) -> (ix1p, iy1p) in m[0] and m[1]
  private void computeMiter(int ix0, int iy0, int ix1, int iy1, int ix0p,
                            int iy0p, int ix1p, int iy1p, int[] m) {
    long x0 = ix0;
    long y0 = iy0;
    long x1 = ix1;
    long y1 = iy1;

    long x0p = ix0p;
    long y0p = iy0p;
    long x1p = ix1p;
    long y1p = iy1p;

    long x10 = x1 - x0;
    long y10 = y1 - y0;
    long x10p = x1p - x0p;
    long y10p = y1p - y0p;

    long den = (x10 * y10p - x10p * y10) >> 16;
    if (den == 0) {
      m[0] = ix0;
      m[1] = iy0;
      return;
    }

    long t = (x1p * (y0 - y0p) - x0 * y10p + x0p * (y1p - y0)) >> 16;
    m[0] = (int) (x0 + (t * x10) / den);
    m[1] = (int) (y0 + (t * y10) / den);
  }

  private void drawMiter(int px0, int py0, int x0, int y0, int x1, int y1,
                         int omx, int omy, int mx, int my, int color,
                         boolean rev) {
    if (mx == omx && my == omy) {
      return;
    }
    if (px0 == x0 && py0 == y0) {
      return;
    }
    if (x0 == x1 && y0 == y1) {
      return;
    }

    if (rev) {
      omx = -omx;
      omy = -omy;
      mx = -mx;
      my = -my;
    }

    computeMiter(px0 + omx, py0 + omy, x0 + omx, y0 + omy, x0 + mx, y0 + my, x1
      + mx, y1 + my, miter);

    // Compute miter length in untransformed coordinates
    long dx = (long) miter[0] - x0;
    long dy = (long) miter[1] - y0;
    long a = (dy * m00 - dx * m10) >> 16;
    long b = (dy * m01 - dx * m11) >> 16;
    long lenSq = a * a + b * b;

    if (lenSq < miterLimitSq) {
      emitLineTo(miter[0], miter[1], color, rev);
    }
  }

    /**
     *
     * @param x0
     * @param y0
     * @param c0
     */
    public void moveTo(int x0, int y0, int c0) {
    // System.out.println("LineStroker.moveTo(" + x0/65536.0 + ", " + y0/65536.0 + ")");

    if (lineToOrigin) {
      // not closing the path, do the previous lineTo
      lineToImpl(sx0, sy0, scolor0, joinToOrigin);
      lineToOrigin = false;
    }

    if (prev == LinePath.SEG_LINETO) {
      finish();
    }

    this.sx0 = this.x0 = x0;
    this.sy0 = this.y0 = y0;
    this.scolor0 = this.color0 = c0;
    this.rindex = 0;
    this.started = false;
    this.joinSegment = false;
    this.prev = LinePath.SEG_MOVETO;
  }

  boolean joinSegment = false;

    /**
     *
     */
    public void lineJoin() {
    // System.out.println("LineStroker.lineJoin()");
    this.joinSegment = true;
  }

    /**
     *
     * @param x1
     * @param y1
     * @param c1
     */
    public void lineTo(int x1, int y1, int c1) {
    // System.out.println("LineStroker.lineTo(" + x1/65536.0 + ", " + y1/65536.0 + ")");

    if (lineToOrigin) {
      if (x1 == sx0 && y1 == sy0) {
        // staying in the starting point
        return;
      }

      // not closing the path, do the previous lineTo
      lineToImpl(sx0, sy0, scolor0, joinToOrigin);
      lineToOrigin = false;
    } else if (x1 == x0 && y1 == y0) {
      return;
    } else if (x1 == sx0 && y1 == sy0) {
      lineToOrigin = true;
      joinToOrigin = joinSegment;
      joinSegment = false;
      return;
    }

    lineToImpl(x1, y1, c1, joinSegment);
    joinSegment = false;
  }

  private void lineToImpl(int x1, int y1, int c1, boolean joinSegment) {
    computeOffset(x0, y0, x1, y1, offset);
    int mx = offset[0];
    int my = offset[1];

    if (!started) {
      emitMoveTo(x0 + mx, y0 + my, color0);
      this.sx1 = x1;
      this.sy1 = y1;
      this.mx0 = mx;
      this.my0 = my;
      started = true;
    } else {
      boolean ccw = isCCW(px0, py0, x0, y0, x1, y1);
      if (joinSegment) {
        if (joinStyle == LinePath.JOIN_MITER) {
          drawMiter(px0, py0, x0, y0, x1, y1, omx, omy, mx, my, color0, ccw);
        } else if (joinStyle == LinePath.JOIN_ROUND) {
          drawRoundJoin(x0, y0, omx, omy, mx, my, 0, color0, false, ccw,
                        ROUND_JOIN_THRESHOLD);
        }
      } else {
        // Draw internal joins as round
        drawRoundJoin(x0, y0, omx, omy, mx, my, 0, color0, false, ccw,
                      ROUND_JOIN_INTERNAL_THRESHOLD);
      }

      emitLineTo(x0, y0, color0, !ccw);
    }

    emitLineTo(x0 + mx, y0 + my, color0, false);
    emitLineTo(x1 + mx, y1 + my, c1, false);

    emitLineTo(x0 - mx, y0 - my, color0, true);
    emitLineTo(x1 - mx, y1 - my, c1, true);

    this.omx = mx;
    this.omy = my;
    this.px0 = x0;
    this.py0 = y0;
    this.pcolor0 = color0;
    this.x0 = x1;
    this.y0 = y1;
    this.color0 = c1;
    this.prev = LinePath.SEG_LINETO;
  }

    /**
     *
     */
    public void close() {
    if (lineToOrigin) {
      // ignore the previous lineTo
      lineToOrigin = false;
    }

    if (!started) {
      finish();
      return;
    }

    computeOffset(x0, y0, sx0, sy0, offset);
    int mx = offset[0];
    int my = offset[1];

    // Draw penultimate join
    boolean ccw = isCCW(px0, py0, x0, y0, sx0, sy0);
    if (joinSegment) {
      if (joinStyle == LinePath.JOIN_MITER) {
        drawMiter(px0, py0, x0, y0, sx0, sy0, omx, omy, mx, my, pcolor0, ccw);
      } else if (joinStyle == LinePath.JOIN_ROUND) {
        drawRoundJoin(x0, y0, omx, omy, mx, my, 0, color0, false, ccw,
                      ROUND_JOIN_THRESHOLD);
      }
    } else {
      // Draw internal joins as round
      drawRoundJoin(x0, y0, omx, omy, mx, my, 0, color0, false, ccw,
                    ROUND_JOIN_INTERNAL_THRESHOLD);
    }

    emitLineTo(x0 + mx, y0 + my, color0);
    emitLineTo(sx0 + mx, sy0 + my, scolor0);

    ccw = isCCW(x0, y0, sx0, sy0, sx1, sy1);

    // Draw final join on the outside
    if (!ccw) {
      if (joinStyle == LinePath.JOIN_MITER) {
        drawMiter(x0, y0, sx0, sy0, sx1, sy1, mx, my, mx0, my0, color0, false);
      } else if (joinStyle == LinePath.JOIN_ROUND) {
        drawRoundJoin(sx0, sy0, mx, my, mx0, my0, 0, scolor0, false, false,
                      ROUND_JOIN_THRESHOLD);
      }
    }

    emitLineTo(sx0 + mx0, sy0 + my0, scolor0);
    emitLineTo(sx0 - mx0, sy0 - my0, scolor0); // same as reverse[0], reverse[1]

    // Draw final join on the inside
    if (ccw) {
      if (joinStyle == LinePath.JOIN_MITER) {
        drawMiter(x0, y0, sx0, sy0, sx1, sy1, -mx, -my, -mx0, -my0, color0,
                  false);
      } else if (joinStyle == LinePath.JOIN_ROUND) {
        drawRoundJoin(sx0, sy0, -mx, -my, -mx0, -my0, 0, scolor0, true, false,
                      ROUND_JOIN_THRESHOLD);
      }
    }

    emitLineTo(sx0 - mx, sy0 - my, scolor0);
    emitLineTo(x0 - mx, y0 - my, color0);
    for (int i = rindex - 3; i >= 0; i -= 3) {
      emitLineTo(reverse[i], reverse[i + 1], reverse[i + 2]);
    }

    this.x0 = this.sx0;
    this.y0 = this.sy0;
    this.rindex = 0;
    this.started = false;
    this.joinSegment = false;
    this.prev = LinePath.SEG_CLOSE;
    emitClose();
  }

    /**
     *
     */
    public void end() {
    if (lineToOrigin) {
      // not closing the path, do the previous lineTo
      lineToImpl(sx0, sy0, scolor0, joinToOrigin);
      lineToOrigin = false;
    }

    if (prev == LinePath.SEG_LINETO) {
      finish();
    }

    output.end();
    this.joinSegment = false;
    this.prev = LinePath.SEG_MOVETO;
  }

  long lineLength(long ldx, long ldy) {
    long ldet = ((long) m00 * m11 - (long) m01 * m10) >> 16;
    long la = (ldy * m00 - ldx * m10) / ldet;
    long lb = (ldy * m01 - ldx * m11) / ldet;
    long llen = (int) LinePath.hypot(la, lb);
    return llen;
  }

  private void finish() {
    if (capStyle == LinePath.CAP_ROUND) {
      drawRoundJoin(x0, y0, omx, omy, -omx, -omy, 1, color0, false, false,
                    ROUND_JOIN_THRESHOLD);
    } else if (capStyle == LinePath.CAP_SQUARE) {
      long ldx = px0 - x0;
      long ldy = py0 - y0;
      long llen = lineLength(ldx, ldy);
      if (0 < llen) {
        long s = (long) lineWidth2 * 65536 / llen;

        int capx = x0 - (int) (ldx * s >> 16);
        int capy = y0 - (int) (ldy * s >> 16);

        emitLineTo(capx + omx, capy + omy, color0);
        emitLineTo(capx - omx, capy - omy, color0);
      }
    }

    for (int i = rindex - 3; i >= 0; i -= 3) {
      emitLineTo(reverse[i], reverse[i + 1], reverse[i + 2]);
    }
    this.rindex = 0;

    if (capStyle == LinePath.CAP_ROUND) {
      drawRoundJoin(sx0, sy0, -mx0, -my0, mx0, my0, 1, scolor0, false, false,
                    ROUND_JOIN_THRESHOLD);
    } else if (capStyle == LinePath.CAP_SQUARE) {
      long ldx = sx1 - sx0;
      long ldy = sy1 - sy0;
      long llen = lineLength(ldx, ldy);
      if (0  < llen) {
        long s = (long) lineWidth2 * 65536 / llen;

        int capx = sx0 - (int) (ldx * s >> 16);
        int capy = sy0 - (int) (ldy * s >> 16);

        emitLineTo(capx - mx0, capy - my0, scolor0);
        emitLineTo(capx + mx0, capy + my0, scolor0);
      }
    }

    emitClose();
    this.joinSegment = false;
  }

  private void emitMoveTo(int x0, int y0, int c0) {
    output.moveTo(x0, y0, c0);
  }

  private void emitLineTo(int x1, int y1, int c1) {
    output.lineTo(x1, y1, c1);
  }

  private void emitLineTo(int x1, int y1, int c1, boolean rev) {
    if (rev) {
      ensureCapacity(rindex + 3);
      reverse[rindex++] = x1;
      reverse[rindex++] = y1;
      reverse[rindex++] = c1;
    } else {
      emitLineTo(x1, y1, c1);
    }
  }

  private void emitClose() {
    output.close();
  }
}