KartBody.cc

#include "KartBody.hh"
 
#include <egg/math/Math.hh>
 
namespace Kart {
 
KartBody::KartBody(KartPhysics *physics) : m_physics(physics) {
    m_anAngle = 0.0f;
    m_sinkDepth = 0.0f;
    m_targetSinkDepth = 0.0f;
}
 
EGG::Matrix34f KartBody::wheelMatrix(u16) {
    EGG::Matrix34f mat;
    mat.makeQT(fullRot(), pos());
    return mat;
}
EGG::Matrix34f KartBody::wheelMatrix(u16) {…}
 
void KartBody::reset() {
    m_physics->reset();
    m_anAngle = 0.0f;
    m_sinkDepth = 0.0f;
    m_targetSinkDepth = 0.0f;
}
 
void KartBody::calcSinkDepth() {
    m_sinkDepth += (m_targetSinkDepth - m_sinkDepth) * 0.1f;
}
 
void KartBody::trySetTargetSinkDepth(f32 val) {
    m_targetSinkDepth = std::max(val, m_targetSinkDepth);
}
 
void KartBody::calcTargetSinkDepth() {
    m_targetSinkDepth = 3.0f * static_cast<f32>(collisionData().intensity);
}
 
KartBodyKart::KartBodyKart(KartPhysics *physics) : KartBody(physics) {}
 
KartBodyKart::~KartBodyKart() {
    delete m_physics;
}
 
KartBodyBike::KartBodyBike(KartPhysics *physics) : KartBody(physics) {}
 
KartBodyBike::~KartBodyBike() {
    delete m_physics;
}
 
EGG::Matrix34f KartBodyBike::wheelMatrix(u16 wheelIdx) {
    EGG::Matrix34f mat;
 
    mat.makeQT(fullRot(), pos());
    if (wheelIdx != 0) {
        return mat;
    }
 
    EGG::Vector3f position = param()->bikeDisp().m_handlePos * scale();
    EGG::Vector3f rotation = DEG2RAD * param()->bikeDisp().m_handleRot;
 
    EGG::Matrix34f handleMatrix;
    handleMatrix.makeRT(rotation, position);
    EGG::Matrix34f tmp = mat.multiplyTo(handleMatrix);
 
    EGG::Vector3f yRotation = EGG::Vector3f(0.0f, DEG2RAD * m_anAngle, 0.0f);
    EGG::Matrix34f yRotMatrix;
    yRotMatrix.makeR(yRotation);
    mat = tmp.multiplyTo(yRotMatrix);
 
    return mat;
}
EGG::Matrix34f KartBodyBike::wheelMatrix(u16 wheelIdx) {…}
 
KartBodyQuacker::KartBodyQuacker(KartPhysics *physics) : KartBodyBike(physics) {}
 
KartBodyQuacker::~KartBodyQuacker() = default;
 
EGG::Matrix34f KartBodyQuacker::wheelMatrix(u16 /* wheelIdx */) {
    EGG::Matrix34f mat;
    mat.makeQT(fullRot(), pos());
    return mat;
}
EGG::Matrix34f KartBodyQuacker::wheelMatrix(u16 /* wheelIdx */) {…}
 
} // namespace Kart