modifier_direction.hpp

#pragma once
 
#include "vipra/vipra_behaviors/definitions/sim_pack.hpp"
#include "vipra/vipra_behaviors/values/direction.hpp"
 
namespace VIPRA::Behaviors {
class ModifierDirection {
  NON_DEFAULT_CONSTRUCTIBLE(ModifierDirection)
  COPYABLE(ModifierDirection)
  MOVEABLE(ModifierDirection)
 
 public:
  explicit ModifierDirection(Direction direction) : _direction(direction) {}

  auto operator()(Simpack pack, VIPRA::idx targetIdx, VIPRA::idx selfIdx) const -> bool
  {
    auto const& goalCoord = pack.goals.current_goal(selfIdx);
    auto const& selfCoord = pack.pedset.ped_coords(selfIdx);
    auto const& targetCoord = pack.pedset.ped_coords(targetIdx);
 
    auto forward = goalCoord - selfCoord;
    auto dif = targetCoord - selfCoord;
 
    if ( _direction == Direction::FRONT ) {
      return dif.dot(forward) > RANGE;
    }
 
    return dif.dot(forward) <= RANGE;
  }
 
 private:
  Direction _direction;
 
  static constexpr VIPRA::f_pnt RANGE = 0.1F;
};
}  // namespace VIPRA::Behaviors