ObjectSanbo.cc

#include "ObjectSanbo.hh"
 
#include "game/field/CollisionDirector.hh"
#include "game/field/KColData.hh"
 
namespace Field {
 
ObjectSanbo::ObjectSanbo(const System::MapdataGeoObj &params) : ObjectCollidable(params) {
    m_yVel = 0.0f;
}
 
ObjectSanbo::~ObjectSanbo() = default;
 
void ObjectSanbo::init() {
    m_up = EGG::Vector3f::ey;
    EGG::Matrix34f rot;
    rot.makeR(m_rot);
    m_tangent = rot.base(2);
    m_tangent.normalise();
    m_standstill = false;
    m_railInterpolator->init(0.0f, 0);
}
 
void ObjectSanbo::calc() {
    calcMove();
}
 
void ObjectSanbo::calcMove() {
    constexpr f32 GRAVITY = 2.0f;
 
    if (m_standstill) {
        if (--m_stillDuration == 0) {
            m_standstill = false;
        }
 
        return;
    }
 
    auto railStatus = m_railInterpolator->calc();
    if (railStatus == RailInterpolator::Status::ChangingDirection) {
        m_standstill = true;
        m_stillDuration = m_railInterpolator->curPoint().setting[0];
    }
 
    const EGG::Vector3f &railPos = m_railInterpolator->curPos();
    m_pos.x = railPos.x;
    m_pos.z = railPos.z;
    m_yVel -= GRAVITY;
    m_flags.setBit(eFlags::Position);
    m_pos.y = m_yVel + m_pos.y;
 
    checkSphere();
}
 
void ObjectSanbo::checkSphere() {
    constexpr f32 RADIUS = 10.0f;
    constexpr EGG::Vector3f POS_OFFSET = EGG::Vector3f(0.0f, RADIUS, 0.0f);
 
    CollisionInfo colInfo;
    colInfo.bbox.setZero();
 
    EGG::Vector3f norm = m_up;
 
    if (CollisionDirector::Instance()->checkSphereFull(RADIUS, m_pos + POS_OFFSET,
                EGG::Vector3f::inf, KCL_TYPE_FLOOR, &colInfo, nullptr, 0)) {
        m_yVel = 0.0f;
        m_flags.setBit(eFlags::Position);
        m_pos += colInfo.tangentOff;
        norm = colInfo.floorNrm;
    }
 
    EGG::Vector3f upNrm = m_up;
    upNrm.normalise();
    norm.normalise();
 
    m_up += (norm - upNrm).multInv(60.0f);
    m_up.normalise();
 
    setMatrixTangentTo(m_up, m_tangent);
}
 
} // namespace Field