DynamicSeparation.cpp

#include <vector>

#include "DynamicSeparation.hpp"
#include "Mobile.hpp"
#include "Triple.hpp"

//#define DEBUG_DYNAMICSEPARATION

#ifdef DEBUG_DYNAMICSEPARATION
#       include <iostream>
#       define DEBUG_SEPARATION_PRINT(S) std::cout << "DEBUG: DynamicSeparation " << reinterpret_cast<void *>(this) << ": " #S << " == " << S << std::endl;
#else
#       define DEBUG_SEPARATION_PRINT(S)
#endif

DynamicSeparation::DynamicSeparation(std::string name, Mobile *character, Mobile *target, double minForce, double separationRadius):
        DynamicV(name),
        character(character),
        target(target),
        minForce(minForce),
        separationRadius(separationRadius)
{}

std::vector<Triple> DynamicSeparation::getForce(unsigned int ticks, unsigned int delta_ticks) {
        Triple steering;
        double d;

        Triple cp, tp;
        std::tie(cp, tp) = points(character, target);

        steering = cp - tp;
        d = steering.length();
        DEBUG_SEPARATION_PRINT(d);
        if (0 < d && d < separationRadius) {
                steering *= (minForce * separationRadius) / d;
                return std::vector<Triple>(1, steering);
        }
        return std::vector<Triple>();

}