ObjectCollisionSphere.cc

#include "ObjectCollisionSphere.hh"
 
namespace Kinoko::Field {

ObjectCollisionSphere::ObjectCollisionSphere(f32 radius, const EGG::Vector3f &center)
    : m_hasTranslation(false), m_radius(radius), m_pos(center), m_scaledRadius(radius),
      m_scaledPos(center), m_worldPos(center) {}

ObjectCollisionSphere::~ObjectCollisionSphere() = default;

void ObjectCollisionSphere::transform(const EGG::Matrix34f &mat, const EGG::Vector3f &scale) {
    m_hasTranslation = false;
 
    if (scale.x != 1.0f) {
        m_scaledPos = m_pos * scale.x;
        m_scaledRadius = m_radius * scale.x;
    }
 
    m_worldPos = mat.multVector(m_scaledPos);
}

void ObjectCollisionSphere::transform(const EGG::Matrix34f &mat, const EGG::Vector3f &scale,
        const EGG::Vector3f &speed) {
    m_hasTranslation = true;
    m_translation = speed;
 
    if (scale.x != 1.0f) {
        m_scaledPos = m_pos * scale.x;
        m_scaledRadius = m_radius * scale.x;
    }
 
    m_worldPos = mat.multVector(m_scaledPos);
 
    m_center = m_worldPos - speed;
}

const EGG::Vector3f &ObjectCollisionSphere::getSupport(const EGG::Vector3f &v) const {
    if (!m_hasTranslation) {
        return m_worldPos;
    }
 
    return m_worldPos.dot(v) > m_center.dot(v) ? m_worldPos : m_center;
}
 
} // namespace Kinoko::Field