mirror of
https://github.com/encounter/Petari.git
synced 2026-03-30 11:34:15 -07:00
Headpenguin
e8794553c5
DiskTorusGravity.o Matched all remaining functions in the above files and both forms of `TRot3f::mult33`. The `mult33` functions and `mult33inline` should be returned to since they likely are the same function. As of right now, `mult33inline` is used to define the single argument form of `mult33` but not the double argument form. Added some extra paired single TVec3f inlines Provided comments explaining what `MR::makeAxisVerticalZX` and `MR::calcPerpendicularFootToLineInside` do
131 lines
3.6 KiB
C++
131 lines
3.6 KiB
C++
#include "Game/Gravity.hpp"
|
|
#include "Game/Util.hpp"
|
|
#include "Inline.hpp"
|
|
|
|
|
|
#define DISK_TORUS_DISABLE_BOTH_EDGE_GRAVITY 0
|
|
#define DISK_TORUS_DISABLE_OUTER_EDGE_GRAVITY 1
|
|
#define DISK_TORUS_DISABLE_INNER_EDGE_GRAVITY 2
|
|
|
|
DiskTorusGravity::DiskTorusGravity() :
|
|
PlanetGravity(),
|
|
CALL_INLINE_FUNC(mLocalPosition, 0.0f, 50.0f, 0.0f),
|
|
CALL_INLINE_FUNC(mTranslation, 0.0f, 50.0f, 0.0f),
|
|
mLocalDirection(0, 1, 0),
|
|
mRotation(0, 1, 0)
|
|
{
|
|
mRadius = 2000.0f;
|
|
mWorldRadius = 2000.0f;
|
|
mDiskRadius = 0.0f;
|
|
mEdgeType = 3;
|
|
mEnableBothSide = true;
|
|
}
|
|
|
|
void DiskTorusGravity::setPosition(const TVec3f &rPosition) {
|
|
mLocalPosition = rPosition;
|
|
}
|
|
|
|
void DiskTorusGravity::setDirection(const TVec3f &rDirection) {
|
|
mLocalDirection = rDirection;
|
|
}
|
|
|
|
void DiskTorusGravity::setRadius(f32 val) {
|
|
mRadius = val;
|
|
}
|
|
|
|
void DiskTorusGravity::setDiskRadius(f32 val) {
|
|
if (val < 0.0f) {
|
|
mDiskRadius = 0.0f;
|
|
}
|
|
else {
|
|
mDiskRadius = val;
|
|
}
|
|
}
|
|
|
|
void DiskTorusGravity::setEdgeType(s32 val) {
|
|
mEdgeType = val;
|
|
}
|
|
|
|
void DiskTorusGravity::setBothSide(bool val) {
|
|
mEnableBothSide = val;
|
|
}
|
|
|
|
bool DiskTorusGravity::calcOwnGravityVector(TVec3f *pDest, f32 *pScalar, const TVec3f &rPos) const {
|
|
|
|
TVec3f relativePosition;
|
|
relativePosition = rPos - mTranslation;
|
|
|
|
f32 centralAxisY = relativePosition.dot(mRotation);
|
|
|
|
if(!mEnableBothSide && centralAxisY < 0.0f) {
|
|
return false;
|
|
}
|
|
|
|
TVec3f dirOnTorusPlane = relativePosition - mRotation.multInline2(centralAxisY);
|
|
f32 distanceToCentralAxis;
|
|
MR::separateScalarAndDirection(&distanceToCentralAxis, &dirOnTorusPlane, dirOnTorusPlane);
|
|
if(MR::isNearZero(distanceToCentralAxis, 0.00100000005f)) {
|
|
|
|
// Just choose a direction in-plane for gravity if the object is sitting
|
|
// on the central axis (otherwise dirOnTorusPlane is zero)
|
|
MR::makeAxisVerticalZX(&dirOnTorusPlane, mRotation);
|
|
|
|
}
|
|
|
|
|
|
f32 innerRadius = mWorldRadius - mDiskRadius;
|
|
f32 worldRadius = mWorldRadius;
|
|
TVec3f gravity(0, 0, 0);
|
|
f32 distance = 0.0f;
|
|
|
|
if(distanceToCentralAxis < innerRadius) {
|
|
|
|
if(mEdgeType == DISK_TORUS_DISABLE_BOTH_EDGE_GRAVITY || mEdgeType == DISK_TORUS_DISABLE_INNER_EDGE_GRAVITY) {
|
|
return false;
|
|
}
|
|
|
|
TVec3f nearestInnerEdgePoint;
|
|
JMAVECScaleAdd(dirOnTorusPlane.toCVec(), mTranslation.toCVec(), nearestInnerEdgePoint.toVec(), innerRadius);
|
|
|
|
gravity = nearestInnerEdgePoint - rPos;
|
|
MR::separateScalarAndDirection(&distance, &gravity, gravity);
|
|
}
|
|
else if(distanceToCentralAxis > worldRadius) {
|
|
|
|
if(mEdgeType == DISK_TORUS_DISABLE_BOTH_EDGE_GRAVITY || mEdgeType == DISK_TORUS_DISABLE_OUTER_EDGE_GRAVITY) {
|
|
return false;
|
|
}
|
|
|
|
TVec3f nearestOuterEdgePoint;
|
|
JMAVECScaleAdd(dirOnTorusPlane.toCVec(), mTranslation.toCVec(), nearestOuterEdgePoint.toVec(), worldRadius);
|
|
gravity = nearestOuterEdgePoint - rPos;
|
|
MR::separateScalarAndDirection(&distance, &gravity, gravity);
|
|
}
|
|
else {
|
|
gravity = centralAxisY >= 0.0f ? mRotation.negateInline_2() : mRotation;
|
|
distance = __fabsf(centralAxisY);
|
|
}
|
|
|
|
if(!isInRangeDistance(distance)) {
|
|
return false;
|
|
}
|
|
if(pDest) {
|
|
*pDest = gravity;
|
|
}
|
|
if(pScalar) {
|
|
*pScalar = distance;
|
|
}
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
void DiskTorusGravity::updateMtx(const TPos3f &rMtx) {
|
|
rMtx.mult(mLocalPosition, mTranslation);
|
|
rMtx.mult33Inline(mLocalDirection, mRotation);
|
|
|
|
f32 worldScale;
|
|
MR::separateScalarAndDirection(&worldScale, &mRotation, mRotation);
|
|
mWorldRadius = mRadius * worldScale;
|
|
}
|