view/coordinateCtrl/CoordinateCtrl.cpp

/*!
  \file
  \brief 座標系の操作

  \author Satofumi KAMIMURA

  $Id$
*/

#include "CoordinateCtrl.h"
#include "MathUtils.h"
#include <set>
#include <cstddef>

using namespace beego;


/*!
  \brief CoordinateCtrl の内部クラス
*/
struct CoordinateCtrl::pImpl {
  typedef std::set<const CoordinateCtrl*> CrdSet;
  static CrdSet crd_set;

  const CoordinateCtrl* parent;        //!< 親座標系へのポインタ
  Position<int> offset;                //!< 親座標系で自座標系の原点位置

  pImpl(void) : parent(NULL) {
  }

  void convert(Position<int>& dst, const Position<int>& src,
               const Position<int>& offset) {

    double radian = offset.angle.to_rad();
    int x = static_cast<int>(src.x * cos(radian) - src.y * sin(radian));
    int y = static_cast<int>(src.x * sin(radian) + src.y * cos(radian));
    dst.x = x + offset.x;
    dst.y = y + offset.y;
    dst.angle = rad(src.angle.to_rad() + offset.angle.to_rad());
  }
};
CoordinateCtrl::pImpl::CrdSet CoordinateCtrl::pImpl::crd_set;


CoordinateCtrl::CoordinateCtrl(void) : pimpl(new pImpl) {
  pImpl::crd_set.insert(this);
}


CoordinateCtrl::~CoordinateCtrl(void) {
  pImpl::CrdSet::iterator it = pImpl::crd_set.find(this);
  if (it != pImpl::crd_set.end()) {
    pImpl::crd_set.erase(it);
  }
}


bool CoordinateCtrl::isActive(const CoordinateCtrl* crd) {
  pImpl::CrdSet::iterator it = pImpl::crd_set.find(crd);
  if (it != pImpl::crd_set.end()) {
    return true;
  } else {
    return false;
  }
}


CoordinateCtrl* CoordinateCtrl::getParent(void) {
  return const_cast<CoordinateCtrl*>(pimpl->parent);
}


// 座標系をある座標系上に固定
// !!!         固定されてない座標系の関係もある、ってことな。そのときが NULL かと
void CoordinateCtrl::setOrigin(const CoordinateCtrl* parent,
                               int x, int y, Angle angle) {
  pimpl->parent = parent;
  set_Position(&pimpl->offset, x, y, angle);
}


// 指定座標系の指定位置が、自座標系のどの位置に相当するかを返す
bool CoordinateCtrl::getPosition(Position<int>* dst,
                                 const CoordinateCtrl* crd,
                                 int x, int y, Angle angle) {

  if (crd == NULL) {
    // 渡された座標系が無効な場合、位置計算は行わない
    return false;
  }

  // 指定座標系の位置変換
  Position<int> crd_position;
  const CoordinateCtrl* crd_top = crd;
  set_Position(&crd_position, x, y, angle);
  for (crd_top = crd;
       crd_top->pimpl->parent != NULL; crd_top = crd_top->pimpl->parent) {
    pimpl->convert(crd_position, crd_position, crd_top->pimpl->offset);
  }

  // 自座標系の位置変換
  Position<int> this_origin;
  const CoordinateCtrl* this_top;
  for (this_top = this;
       this_top->pimpl->parent != NULL; this_top = this_top->pimpl->parent) {
    pimpl->convert(this_origin, this_origin, this_top->pimpl->offset);
  }

  if (crd_top != this_top) {
    // 最上位の親が同じでない場合、位置計算は無効
    return false;
  }

  // 最終的な位置変換
  // !!! Position に負号を定義するかな？
  dst->x = crd_position.x - this_origin.x;
  dst->y = crd_position.y - this_origin.y;
  dst->angle = rad(crd_position.angle.to_rad());
  Position<int> rotate_only;
  rotate_only.angle = rad(-this_origin.angle.to_rad());
  pimpl->convert(*dst, *dst, rotate_only);

  return true;
}