/*------------------------------------------------------- 
 * ブレゼンハム指数増加アルゴリズム
 *-------------------------------------------------------*/
#include <xc.h>
#include <stdint.h>
#include "incr-exp.h"

/* y値 */
static uint16_t incr_y = 0;

/* 誤差値 */
static int16_t  incr_e = 0;

/* 初期化 */
void incr_exp_init(uint16_t y0)
{
  incr_y = y0;
  incr_exp_reset_error();
}

/* 誤差値のリセット */
void incr_exp_reset_error(void)
{
  incr_e = 0;
}

/* 次のy値を得る */
uint16_t incr_exp_next(uint16_t tc, uint16_t y1)
{
  /* 今のy値 */
  uint16_t y = incr_y;
  /* すでにy値は目標値に到達済 */
  if (incr_y == y1) {
    incr_e = 0;
    return incr_y;
  }
  /* xの増加値 */
  int16_t sdx = (int16_t)tc;
  /* yの増加値 */
  int16_t sdy;
  if (incr_y < y1) {
    sdy = y1 - incr_y;
  } else {
    sdy = incr_y - y1;
  }
  for (;;) {
    /* y値が目標値に到達 - 終了 */
    if (incr_y == y1) {
      incr_e = 0;
      break;
    }
    /* 誤差値の計算 (不変式 e_01 >= e_11 >= e_10 に注意) */
    int16_t e_01 = incr_e + sdx;       /* 点 (x,y+1)   */
    int16_t e_11 = incr_e + sdx - sdy; /* 点 (x+1,y+1) */
    int16_t e_10 = incr_e - sdy;       /* 点 (x+1,y)   */
    /* y値の1増加で誤差値が減少するか否かを検査*/
    if (e_10 + e_11 < 0) { /* 誤差値は減少 */
      /* 誤差値を更新 */
      incr_e = e_01;
      /* y値を1増加 */
      if (incr_y < y1) {
        incr_y++;
      } else {
        incr_y--;
      }
    }
    /* x値の1増加で誤差値が減少するか否かを検査 */
    else if (e_01 + e_11 > 0) { /* 誤差値は減少 */
      /* 誤差値を更新 */
      incr_e = e_10;
      /* x値を1増加(本関数終了) */
      break; 
    }

  }
  return y;
}
