mirror of https://github.com/AxioDL/metaforce.git
806 lines
27 KiB
C++
806 lines
27 KiB
C++
#include "CMapWorld.hpp"
|
|
#include "CMapWorldInfo.hpp"
|
|
#include "GameGlobalObjects.hpp"
|
|
#include "CSimplePool.hpp"
|
|
#include "World/CWorld.hpp"
|
|
#include "CStateManager.hpp"
|
|
|
|
namespace urde
|
|
{
|
|
|
|
CMapWorld::CMapAreaData::CMapAreaData(CAssetId areaRes, EMapAreaList list, CMapAreaData* next)
|
|
: x0_area(g_SimplePool->GetObj(SObjectTag{FOURCC('MAPA'), areaRes})), x10_list(list), x14_next(next)
|
|
{}
|
|
|
|
CMapWorld::CMapWorld(CInputStream& in)
|
|
{
|
|
x10_listHeads.resize(3);
|
|
in.readUint32Big();
|
|
in.readUint32Big();
|
|
u32 areaCount = in.readUint32Big();
|
|
x0_areas.reserve(areaCount);
|
|
x20_traversed.resize(areaCount);
|
|
for (u32 i=0 ; i<areaCount ; ++i)
|
|
{
|
|
CAssetId mapaId = in.readUint32Big();
|
|
x0_areas.emplace_back(mapaId, EMapAreaList::Unloaded,
|
|
x0_areas.empty() ? nullptr : &x0_areas.back());
|
|
}
|
|
x10_listHeads[2] = &x0_areas.back();
|
|
}
|
|
|
|
bool CMapWorld::IsMapAreaInBFSInfoVector(const CMapWorld::CMapAreaData* area,
|
|
const std::vector<CMapWorld::CMapAreaBFSInfo>& vec) const
|
|
{
|
|
for (const CMapWorld::CMapAreaBFSInfo& bfs : vec)
|
|
{
|
|
if (&x0_areas[bfs.GetAreaIndex()] == area)
|
|
return true;
|
|
}
|
|
return false;
|
|
}
|
|
|
|
void CMapWorld::SetWhichMapAreasLoaded(const IWorld& wld, int start, int count)
|
|
{
|
|
ClearTraversedFlags();
|
|
|
|
std::vector<CMapAreaBFSInfo> bfsInfos;
|
|
bfsInfos.reserve(x0_areas.size());
|
|
DoBFS(wld, start, count, 9999.f, 9999.f, false, bfsInfos);
|
|
|
|
for (int i=0 ; i<2 ; ++i)
|
|
{
|
|
for (CMapAreaData* data = x10_listHeads[i] ; data ; data = data->NextMapAreaData())
|
|
{
|
|
if (!IsMapAreaInBFSInfoVector(data, bfsInfos))
|
|
{
|
|
data->Unlock();
|
|
MoveMapAreaToList(data, EMapAreaList::Unloaded);
|
|
}
|
|
}
|
|
}
|
|
|
|
for (CMapAreaBFSInfo& bfs : bfsInfos)
|
|
{
|
|
CMapAreaData& data = x0_areas[bfs.GetAreaIndex()];
|
|
data.Lock();
|
|
if (data.GetContainingList() == EMapAreaList::Unloaded)
|
|
MoveMapAreaToList(&data, EMapAreaList::Loading);
|
|
}
|
|
}
|
|
|
|
bool CMapWorld::IsMapAreasStreaming() const
|
|
{
|
|
bool ret = false;
|
|
for (CMapAreaData* data = x10_listHeads[1] ; data ; data = data->NextMapAreaData())
|
|
{
|
|
if (data->IsLoaded())
|
|
const_cast<CMapWorld*>(this)->MoveMapAreaToList(data, EMapAreaList::Loaded);
|
|
else
|
|
ret = true;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
void CMapWorld::MoveMapAreaToList(CMapWorld::CMapAreaData* data, CMapWorld::EMapAreaList list)
|
|
{
|
|
CMapAreaData* last = nullptr;
|
|
for (CMapAreaData* head = x10_listHeads[int(data->GetContainingList())] ;;
|
|
last = head, head = head->NextMapAreaData())
|
|
{
|
|
if (head != data)
|
|
continue;
|
|
if (!last)
|
|
x10_listHeads[int(data->GetContainingList())] = head->NextMapAreaData();
|
|
else
|
|
last->SetNextMapArea(head->NextMapAreaData());
|
|
break;
|
|
}
|
|
data->SetNextMapArea(x10_listHeads[int(list)]);
|
|
data->SetContainingList(list);
|
|
x10_listHeads[int(list)] = data;
|
|
}
|
|
|
|
s32 CMapWorld::GetCurrentMapAreaDepth(const IWorld& wld, TAreaId aid) const
|
|
{
|
|
ClearTraversedFlags();
|
|
std::vector<CMapAreaBFSInfo> info;
|
|
info.reserve(x0_areas.size());
|
|
DoBFS(wld, aid, 9999, 9999.f, 9999.f, false, info);
|
|
if (info.empty())
|
|
return 0;
|
|
return info.back().GetDepth();
|
|
}
|
|
|
|
std::vector<int> CMapWorld::GetVisibleAreas(const IWorld& wld, const CMapWorldInfo& mwInfo) const
|
|
{
|
|
std::vector<int> ret;
|
|
ret.reserve(x0_areas.size());
|
|
for (int i=0 ; i<x0_areas.size() ; ++i)
|
|
{
|
|
if (!IsMapAreaValid(wld, i, true))
|
|
continue;
|
|
const CMapArea* area = GetMapArea(i);
|
|
bool areaVis = mwInfo.IsAreaVisible(i);
|
|
bool worldVis = mwInfo.IsWorldVisible(i);
|
|
if (area->GetIsVisibleToAutoMapper(worldVis, areaVis))
|
|
ret.push_back(i);
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
void CMapWorld::Draw(const CMapWorld::CMapWorldDrawParms& parms, int curArea, int otherArea,
|
|
float depth1, float depth2, bool inMapScreen) const
|
|
{
|
|
if (depth1 == 0.f && depth2 == 0.f)
|
|
return;
|
|
|
|
ClearTraversedFlags();
|
|
int areaDepth = std::ceil(std::max(depth1, depth2));
|
|
|
|
std::vector<CMapAreaBFSInfo> bfsInfos;
|
|
bfsInfos.reserve(x0_areas.size());
|
|
if (curArea != otherArea)
|
|
{
|
|
const_cast<CMapWorld*>(this)->x20_traversed[otherArea] = true;
|
|
DoBFS(parms.GetWorld(), curArea, areaDepth, depth1, depth2, true, bfsInfos);
|
|
|
|
float lowD1 = std::ceil(depth1 - 1.f);
|
|
float tmp;
|
|
if (depth1 == std::floor(depth1))
|
|
tmp = 0.f;
|
|
else
|
|
tmp = 1.f - std::fmod(depth1, 1.f);
|
|
float newD1 = lowD1 + tmp;
|
|
|
|
float lowD2 = std::ceil(depth2 - 1.f);
|
|
if (depth2 == std::floor(depth2))
|
|
tmp = 0.f;
|
|
else
|
|
tmp = 1.f - std::fmod(depth2, 1.f);
|
|
float newD2 = lowD2 + tmp;
|
|
|
|
int otherDepth = std::ceil(std::max(newD1, newD2));
|
|
if (parms.GetWorld().IGetAreaAlways(otherArea)->IIsActive())
|
|
{
|
|
const_cast<CMapWorld*>(this)->x20_traversed[otherArea] = false;
|
|
DoBFS(parms.GetWorld(), otherArea, otherDepth, newD1, newD2, true, bfsInfos);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
DoBFS(parms.GetWorld(), curArea, areaDepth, depth1, depth2, true, bfsInfos);
|
|
}
|
|
|
|
DrawAreas(parms, curArea, bfsInfos, inMapScreen);
|
|
}
|
|
|
|
void CMapWorld::DoBFS(const IWorld& wld, int startArea, int areaCount,
|
|
float surfDepth, float outlineDepth,
|
|
bool checkLoad, std::vector<CMapAreaBFSInfo>& bfsInfos) const
|
|
{
|
|
if (areaCount <= 0 || !IsMapAreaValid(wld, startArea, checkLoad))
|
|
return;
|
|
|
|
int size = bfsInfos.size();
|
|
bfsInfos.emplace_back(startArea, 1, surfDepth, outlineDepth);
|
|
const_cast<CMapWorld*>(this)->x20_traversed[startArea] = true;
|
|
|
|
for (; size != bfsInfos.size() ; ++size)
|
|
{
|
|
CMapAreaBFSInfo& testInfo = bfsInfos[size];
|
|
if (testInfo.GetDepth() == areaCount)
|
|
continue;
|
|
|
|
surfDepth = testInfo.GetSurfaceDrawDepth() - 1.f;
|
|
outlineDepth = testInfo.GetOutlineDrawDepth() - 1.f;
|
|
|
|
const IGameArea* area = wld.IGetAreaAlways(testInfo.GetAreaIndex());
|
|
for (int i=0 ; i<area->IGetNumAttachedAreas() ; ++i)
|
|
{
|
|
TAreaId attId = area->IGetAttachedAreaId(i);
|
|
if (IsMapAreaValid(wld, attId, checkLoad) && !x20_traversed[attId])
|
|
{
|
|
bfsInfos.emplace_back(attId, testInfo.GetDepth() + 1, surfDepth, outlineDepth);
|
|
const_cast<CMapWorld*>(this)->x20_traversed[attId] = true;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
bool CMapWorld::IsMapAreaValid(const IWorld& wld, int areaIdx, bool checkLoad) const
|
|
{
|
|
if (!wld.IGetAreaAlways(areaIdx)->IIsActive())
|
|
return false;
|
|
const CMapArea* mapa = GetMapArea(areaIdx);
|
|
if (checkLoad)
|
|
return mapa != nullptr;
|
|
return true;
|
|
}
|
|
|
|
void CMapWorld::DrawAreas(const CMapWorld::CMapWorldDrawParms& parms, int selArea,
|
|
const std::vector<CMapAreaBFSInfo>& bfsInfos, bool inMapScreen) const
|
|
{
|
|
// Alpha blend
|
|
// Line width 1
|
|
|
|
int surfCount = 0;
|
|
int objCount = 0;
|
|
for (const CMapAreaBFSInfo& bfsInfo : bfsInfos)
|
|
{
|
|
const CMapArea* mapa = GetMapArea(bfsInfo.GetAreaIndex());
|
|
surfCount += mapa->GetNumSurfaces();
|
|
objCount += mapa->GetNumMappableObjects();
|
|
}
|
|
|
|
std::vector<CMapObjectSortInfo> sortInfos;
|
|
sortInfos.reserve(surfCount + objCount + (parms.GetIsSortDoorSurfaces() ? objCount * 6 : 0));
|
|
|
|
int playerArea = parms.GetStateManager().GetNextAreaId();
|
|
const CMapWorldInfo& mwInfo = parms.GetMapWorldInfo();
|
|
for (const CMapAreaBFSInfo& bfsInfo : bfsInfos)
|
|
{
|
|
int thisArea = bfsInfo.GetAreaIndex();
|
|
const CMapArea* mapa = GetMapArea(thisArea);
|
|
if (!mapa->GetIsVisibleToAutoMapper(mwInfo.IsWorldVisible(thisArea),
|
|
mwInfo.IsAreaVisible(thisArea)))
|
|
continue;
|
|
|
|
float surfDepth = bfsInfo.GetSurfaceDrawDepth();
|
|
float outlineDepth = bfsInfo.GetOutlineDrawDepth();
|
|
|
|
if (surfDepth >= 1.f)
|
|
surfDepth = 1.f;
|
|
else if (surfDepth < 0.f)
|
|
surfDepth = 0.f;
|
|
else
|
|
surfDepth -= std::floor(surfDepth);
|
|
|
|
if (outlineDepth >= 1.f)
|
|
outlineDepth = 1.f;
|
|
else if (outlineDepth < 0.f)
|
|
outlineDepth = 0.f;
|
|
else
|
|
outlineDepth -= std::floor(outlineDepth);
|
|
|
|
float alphaSurf;
|
|
float alphaOutline;
|
|
const zeus::CColor* surfaceColor;
|
|
const zeus::CColor* outlineColor;
|
|
const zeus::CColor* surfacePlayerColor;
|
|
const zeus::CColor* outlinePlayerColor;
|
|
if (mwInfo.IsAreaVisted(thisArea))
|
|
{
|
|
alphaSurf = parms.GetAlphaSurfaceVisited();
|
|
alphaOutline = parms.GetAlphaOutlineVisited();
|
|
surfaceColor = &g_tweakAutoMapper->GetSurfaceVisitedColor();
|
|
outlineColor = &g_tweakAutoMapper->GetOutlineVisitedColor();
|
|
surfacePlayerColor = &g_tweakAutoMapper->GetSurfaceSelectVisitedColor();
|
|
outlinePlayerColor = &g_tweakAutoMapper->GetOutlineSelectVisitedColor();
|
|
}
|
|
else
|
|
{
|
|
alphaSurf = parms.GetAlphaSurfaceUnvisited();
|
|
alphaOutline = parms.GetAlphaOutlineUnvisited();
|
|
surfaceColor = &g_tweakAutoMapper->GetSurfaceUnvisitedColor();
|
|
outlineColor = &g_tweakAutoMapper->GetOutlineUnvisitedColor();
|
|
surfacePlayerColor = &g_tweakAutoMapper->GetSurfaceSelectUnvisitedColor();
|
|
outlinePlayerColor = &g_tweakAutoMapper->GetOutlineSelectUnvisitedColor();
|
|
}
|
|
|
|
zeus::CColor hintFlashColor =
|
|
zeus::CColor::lerp(zeus::CColor::skClear, zeus::CColor{1.f, 1.f, 1.f, 0.f},
|
|
parms.GetHintAreaFlashIntensity());
|
|
|
|
zeus::CColor finalSurfColor, finalOutlineColor;
|
|
if (thisArea == selArea && inMapScreen)
|
|
{
|
|
finalSurfColor = *surfacePlayerColor + hintFlashColor;
|
|
finalOutlineColor = *outlinePlayerColor + hintFlashColor;
|
|
}
|
|
else
|
|
{
|
|
finalSurfColor = *surfaceColor;
|
|
finalSurfColor.a = surfDepth * alphaSurf;
|
|
finalOutlineColor = *outlineColor;
|
|
finalOutlineColor.a = outlineDepth * alphaOutline;
|
|
}
|
|
|
|
if ((selArea != playerArea || parms.GetHintAreaFlashIntensity() == 0.f) &&
|
|
playerArea == thisArea && this == parms.GetStateManager().GetWorld()->GetMapWorld())
|
|
{
|
|
float pulse = parms.GetPlayerAreaFlashIntensity();
|
|
const zeus::CColor& flashCol = g_tweakAutoMapper->GetAreaFlashPulseColor();
|
|
finalSurfColor = zeus::CColor::lerp(finalSurfColor, flashCol, pulse);
|
|
finalOutlineColor = zeus::CColor::lerp(finalOutlineColor, flashCol, pulse);
|
|
}
|
|
|
|
zeus::CTransform modelView = parms.GetCameraTransform().inverse() *
|
|
mapa->GetAreaPostTransform(parms.GetWorld(), thisArea);
|
|
for (int i=0 ; i<mapa->GetNumSurfaces() ; ++i)
|
|
{
|
|
const CMapArea::CMapAreaSurface& surf = mapa->GetSurface(i);
|
|
zeus::CVector3f pos = modelView * surf.GetCenterPosition();
|
|
sortInfos.emplace_back(pos.y, thisArea, CMapObjectSortInfo::EObjectCode::Surface, i,
|
|
finalSurfColor, finalOutlineColor);
|
|
}
|
|
|
|
int i = 0;
|
|
int si = 0;
|
|
for (; i<mapa->GetNumMappableObjects() ; ++i, si+=6)
|
|
{
|
|
const CMappableObject& obj = mapa->GetMappableObject(i);
|
|
if (!obj.IsVisibleToAutoMapper(mwInfo.IsWorldVisible(thisArea), mwInfo))
|
|
continue;
|
|
|
|
bool doorType = CMappableObject::IsDoorType(obj.GetType());
|
|
if (doorType)
|
|
{
|
|
if (!mwInfo.IsAreaVisible(thisArea))
|
|
continue;
|
|
if (parms.GetIsSortDoorSurfaces())
|
|
{
|
|
for (int s=0 ; s<6 ; ++s)
|
|
{
|
|
zeus::CVector3f center = obj.BuildSurfaceCenterPoint(s);
|
|
zeus::CVector3f pos = modelView *
|
|
(CMapArea::GetAreaPostTranslate(parms.GetWorld(), thisArea) + center);
|
|
sortInfos.emplace_back(pos.y, thisArea, CMapObjectSortInfo::EObjectCode::DoorSurface, si+s,
|
|
zeus::CColor{1.f, 0.f, 1.f, 1.f}, zeus::CColor{1.f, 0.f, 1.f, 1.f});
|
|
}
|
|
continue;
|
|
}
|
|
}
|
|
|
|
zeus::CVector3f pos = modelView * (obj.GetTransform().origin +
|
|
CMapArea::GetAreaPostTranslate(parms.GetWorld(), thisArea));
|
|
sortInfos.emplace_back(pos.y, thisArea, doorType ? CMapObjectSortInfo::EObjectCode::Door :
|
|
CMapObjectSortInfo::EObjectCode::Object,
|
|
i, zeus::CColor{1.f, 0.f, 1.f, 1.f}, zeus::CColor{1.f, 0.f, 1.f, 1.f});
|
|
}
|
|
}
|
|
|
|
std::sort(sortInfos.begin(), sortInfos.end(),
|
|
[](const CMapObjectSortInfo& a, const CMapObjectSortInfo& b)
|
|
{
|
|
return a.GetZDistance() < b.GetZDistance();
|
|
});
|
|
|
|
int lastAreaIdx = -1;
|
|
CMapObjectSortInfo::EObjectCode lastType = CMapObjectSortInfo::EObjectCode::Invalid;
|
|
for (const CMapObjectSortInfo& info : sortInfos)
|
|
{
|
|
const CMapArea* mapa = GetMapArea(info.GetAreaIndex());
|
|
zeus::CTransform areaPostXf = mapa->GetAreaPostTransform(parms.GetWorld(), info.GetAreaIndex());
|
|
if (info.GetObjectCode() == CMapObjectSortInfo::EObjectCode::Surface)
|
|
{
|
|
const CMapArea::CMapAreaSurface& surf = mapa->GetSurface(info.GetLocalObjectIndex());
|
|
zeus::CColor color(std::max(0.f, (-parms.GetCameraTransform().basis[1]).dot(
|
|
areaPostXf.rotate(surf.GetNormal()))) * g_tweakAutoMapper->GetMapSurfaceNormColorLinear() +
|
|
g_tweakAutoMapper->GetMapSurfaceNormColorConstant());
|
|
color *= info.GetSurfaceColor();
|
|
if (lastAreaIdx != info.GetAreaIndex() || lastType != CMapObjectSortInfo::EObjectCode::Surface)
|
|
CGraphics::SetModelMatrix(parms.GetPlaneProjectionTransform() * areaPostXf);
|
|
surf.Draw(mapa->GetVertices(), color, info.GetOutlineColor(), parms.GetOutlineWidthScale());
|
|
}
|
|
else if (info.GetObjectCode() == CMapObjectSortInfo::EObjectCode::Door ||
|
|
info.GetObjectCode() == CMapObjectSortInfo::EObjectCode::Object)
|
|
{
|
|
const CMappableObject& mapObj = mapa->GetMappableObject(info.GetLocalObjectIndex());
|
|
zeus::CTransform objXf =
|
|
zeus::CTransform::Translate(CMapArea::GetAreaPostTranslate(parms.GetWorld(), info.GetAreaIndex())) *
|
|
mapObj.GetTransform();
|
|
if (info.GetObjectCode() == CMapObjectSortInfo::EObjectCode::Door)
|
|
{
|
|
CGraphics::SetModelMatrix(parms.GetPlaneProjectionTransform() * objXf);
|
|
}
|
|
else
|
|
{
|
|
CGraphics::SetModelMatrix(parms.GetPlaneProjectionTransform() * objXf *
|
|
zeus::CTransform(parms.GetCameraTransform().buildMatrix3f() *
|
|
zeus::CMatrix3f(parms.GetObjectScale())));
|
|
}
|
|
mapObj.Draw(selArea, mwInfo, parms.GetAlpha(), lastType != info.GetObjectCode());
|
|
}
|
|
else if (info.GetObjectCode() == CMapObjectSortInfo::EObjectCode::DoorSurface)
|
|
{
|
|
const CMappableObject& mapObj = mapa->GetMappableObject(info.GetLocalObjectIndex() / 6);
|
|
zeus::CTransform objXf = parms.GetPlaneProjectionTransform() *
|
|
zeus::CTransform::Translate(CMapArea::GetAreaPostTranslate(
|
|
parms.GetWorld(), info.GetAreaIndex())) * mapObj.GetTransform();
|
|
CGraphics::SetModelMatrix(objXf);
|
|
mapObj.DrawDoorSurface(selArea, mwInfo, parms.GetAlpha(), info.GetLocalObjectIndex() % 6,
|
|
lastType != info.GetObjectCode());
|
|
}
|
|
lastAreaIdx = info.GetAreaIndex();
|
|
lastType = info.GetObjectCode();
|
|
}
|
|
}
|
|
|
|
struct Support
|
|
{
|
|
int x0_;
|
|
int x4_[3];
|
|
};
|
|
|
|
struct Circle2
|
|
{
|
|
zeus::CVector2f x0_point;
|
|
float x8_radiusSq;
|
|
};
|
|
|
|
struct Circle
|
|
{
|
|
zeus::CVector2f x0_point;
|
|
float x8_radius;
|
|
Circle(const Circle2& circ2)
|
|
: x0_point(circ2.x0_point), x8_radius(std::sqrt(circ2.x8_radiusSq)) {}
|
|
};
|
|
|
|
static Circle2 ExactCircle1(const zeus::CVector2f* a)
|
|
{
|
|
return {*a, 0.f};
|
|
}
|
|
|
|
static Circle2 ExactCircle2(const zeus::CVector2f* a, const zeus::CVector2f* b)
|
|
{
|
|
Circle2 ret = {};
|
|
ret.x0_point = 0.5f * (*a + *b);
|
|
ret.x8_radiusSq = (*b - *a).magSquared() * 0.25f;
|
|
return ret;
|
|
}
|
|
|
|
static Circle2 ExactCircle3(const zeus::CVector2f* a, const zeus::CVector2f* b, const zeus::CVector2f* c)
|
|
{
|
|
Circle2 ret = {};
|
|
zeus::CVector2f d1 = *b - *a;
|
|
zeus::CVector2f d2 = *c - *a;
|
|
float cross = d1.cross(d2);
|
|
zeus::CVector2f magVec(d1.magSquared() * 0.5f, d2.magSquared() * 0.5f);
|
|
if (std::fabs(cross) > 0.01f)
|
|
{
|
|
zeus::CVector2f tmp((d2.y * magVec.x - d1.y * magVec.y) / cross,
|
|
(d1.x * magVec.y - d2.x * magVec.x) / cross);
|
|
ret.x0_point = *a + tmp;
|
|
ret.x8_radiusSq = tmp.magSquared();
|
|
}
|
|
else
|
|
{
|
|
ret.x8_radiusSq = FLT_MAX;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
static bool PointInsideCircle(const zeus::CVector2f& point, const Circle2& circ, float& intersect)
|
|
{
|
|
intersect = (point - circ.x0_point).magSquared() - circ.x8_radiusSq;
|
|
return intersect <= 0.f;
|
|
}
|
|
|
|
static Circle2 UpdateSupport1(int idx, zeus::CVector2f** list, Support& support)
|
|
{
|
|
Circle2 ret = ExactCircle2(list[support.x4_[0]], list[idx]);
|
|
support.x0_ = 2;
|
|
support.x4_[1] = idx;
|
|
return ret;
|
|
}
|
|
|
|
static Circle2 UpdateSupport2(int idx, zeus::CVector2f** list, Support& support)
|
|
{
|
|
Circle2 circs[3] = {};
|
|
float intersect;
|
|
int circIdx = -1;
|
|
float minRad = FLT_MAX;
|
|
|
|
circs[0] = ExactCircle2(list[support.x4_[0]], list[idx]);
|
|
if (PointInsideCircle(*list[support.x4_[1]], circs[0], intersect))
|
|
{
|
|
minRad = circs[0].x8_radiusSq;
|
|
circIdx = 0;
|
|
}
|
|
|
|
circs[1] = ExactCircle2(list[support.x4_[1]], list[idx]);
|
|
if (circs[1].x8_radiusSq < minRad && PointInsideCircle(*list[support.x4_[1]], circs[1], intersect))
|
|
{
|
|
minRad = circs[1].x8_radiusSq;
|
|
circIdx = 1;
|
|
}
|
|
|
|
Circle2 ret = {};
|
|
if (circIdx != -1)
|
|
{
|
|
ret = circs[circIdx];
|
|
support.x4_[1 - circIdx] = idx;
|
|
}
|
|
else
|
|
{
|
|
ret = ExactCircle3(list[support.x4_[0]], list[support.x4_[1]], list[idx]);
|
|
support.x0_ = 3;
|
|
support.x4_[2] = idx;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
static Circle2 UpdateSupport3(int idx, zeus::CVector2f** list, Support& support)
|
|
{
|
|
Circle2 circs[6] = {};
|
|
float intersect;
|
|
int circIdxA = -1;
|
|
int circIdxB = -1;
|
|
float minRadA = FLT_MAX;
|
|
float minRadB = FLT_MAX;
|
|
|
|
circs[0] = ExactCircle2(list[support.x4_[0]], list[idx]);
|
|
if (PointInsideCircle(*list[support.x4_[1]], circs[0], intersect))
|
|
{
|
|
if (PointInsideCircle(*list[support.x4_[2]], circs[0], intersect))
|
|
{
|
|
minRadA = circs[0].x8_radiusSq;
|
|
circIdxA = 0;
|
|
}
|
|
else
|
|
{
|
|
minRadB = intersect;
|
|
circIdxB = 0;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
minRadB = intersect;
|
|
circIdxB = 0;
|
|
}
|
|
|
|
circs[1] = ExactCircle2(list[support.x4_[1]], list[idx]);
|
|
if (circs[1].x8_radiusSq < minRadA)
|
|
{
|
|
if (PointInsideCircle(*list[support.x4_[0]], circs[1], intersect))
|
|
{
|
|
if (PointInsideCircle(*list[support.x4_[2]], circs[1], intersect))
|
|
{
|
|
minRadA = circs[1].x8_radiusSq;
|
|
circIdxA = 1;
|
|
}
|
|
else if (intersect < minRadB)
|
|
{
|
|
minRadB = intersect;
|
|
circIdxB = 1;
|
|
}
|
|
}
|
|
else if (intersect < minRadB)
|
|
{
|
|
minRadB = intersect;
|
|
circIdxB = 1;
|
|
}
|
|
}
|
|
|
|
circs[2] = ExactCircle2(list[support.x4_[2]], list[idx]);
|
|
if (circs[2].x8_radiusSq < minRadA)
|
|
{
|
|
if (PointInsideCircle(*list[support.x4_[0]], circs[2], intersect))
|
|
{
|
|
if (PointInsideCircle(*list[support.x4_[1]], circs[2], intersect))
|
|
{
|
|
minRadA = circs[2].x8_radiusSq;
|
|
circIdxA = 2;
|
|
}
|
|
else if (intersect < minRadB)
|
|
{
|
|
minRadB = intersect;
|
|
circIdxB = 2;
|
|
}
|
|
}
|
|
else if (intersect < minRadB)
|
|
{
|
|
minRadB = intersect;
|
|
circIdxB = 2;
|
|
}
|
|
}
|
|
|
|
circs[3] = ExactCircle3(list[support.x4_[0]], list[support.x4_[1]], list[idx]);
|
|
if (circs[3].x8_radiusSq < minRadA)
|
|
{
|
|
if (PointInsideCircle(*list[support.x4_[2]], circs[3], intersect))
|
|
{
|
|
minRadA = circs[3].x8_radiusSq;
|
|
circIdxA = 3;
|
|
}
|
|
else if (intersect < minRadB)
|
|
{
|
|
minRadB = intersect;
|
|
circIdxB = 3;
|
|
}
|
|
}
|
|
|
|
circs[4] = ExactCircle3(list[support.x4_[0]], list[support.x4_[2]], list[idx]);
|
|
if (circs[4].x8_radiusSq < minRadA)
|
|
{
|
|
if (PointInsideCircle(*list[support.x4_[1]], circs[4], intersect))
|
|
{
|
|
minRadA = circs[4].x8_radiusSq;
|
|
circIdxA = 4;
|
|
}
|
|
else if (intersect < minRadB)
|
|
{
|
|
minRadB = intersect;
|
|
circIdxB = 4;
|
|
}
|
|
}
|
|
|
|
circs[5] = ExactCircle3(list[support.x4_[1]], list[support.x4_[2]], list[idx]);
|
|
if (circs[5].x8_radiusSq < minRadA)
|
|
{
|
|
if (PointInsideCircle(*list[support.x4_[0]], circs[5], intersect))
|
|
{
|
|
circIdxA = 5;
|
|
}
|
|
else if (intersect < minRadB)
|
|
{
|
|
circIdxB = 5;
|
|
}
|
|
}
|
|
|
|
if (circIdxA == -1)
|
|
circIdxA = circIdxB;
|
|
|
|
switch (circIdxA)
|
|
{
|
|
case 0:
|
|
support.x0_ = 2;
|
|
support.x4_[1] = idx;
|
|
break;
|
|
case 1:
|
|
support.x0_ = 2;
|
|
support.x4_[0] = idx;
|
|
break;
|
|
case 2:
|
|
support.x0_ = 2;
|
|
support.x4_[0] = support.x4_[2];
|
|
support.x4_[1] = idx;
|
|
break;
|
|
case 3:
|
|
support.x4_[2] = idx;
|
|
break;
|
|
case 4:
|
|
support.x4_[1] = idx;
|
|
break;
|
|
case 5:
|
|
support.x4_[0] = idx;
|
|
break;
|
|
default: break;
|
|
}
|
|
|
|
return circs[circIdxA];
|
|
}
|
|
|
|
typedef Circle2(*FSupport)(int idx, zeus::CVector2f** list, Support& support);
|
|
static const FSupport SupportFuncs[] =
|
|
{
|
|
nullptr,
|
|
UpdateSupport1,
|
|
UpdateSupport2,
|
|
UpdateSupport3
|
|
};
|
|
|
|
static Circle MinCircle(const std::vector<zeus::CVector2f>& coords)
|
|
{
|
|
Circle2 ret = {};
|
|
if (coords.size() >= 1)
|
|
{
|
|
std::unique_ptr<zeus::CVector2f*[]> randArr(new zeus::CVector2f*[coords.size()]);
|
|
for (int i=0 ; i<coords.size() ; ++i)
|
|
randArr[i] = const_cast<zeus::CVector2f*>(&coords[i]);
|
|
for (int i=coords.size()-1 ; i>=0 ; --i)
|
|
{
|
|
int shuf = rand() % (i+1);
|
|
if (shuf != i)
|
|
std::swap(randArr[i], randArr[shuf]);
|
|
}
|
|
ret = ExactCircle1(randArr[0]);
|
|
|
|
Support support = {};
|
|
support.x0_ = 1;
|
|
for (int i=1 ; i<coords.size() ;)
|
|
{
|
|
bool broke = false;
|
|
for (int j=0 ; j<support.x0_ ; ++j)
|
|
{
|
|
if ((*randArr[i] - *randArr[support.x4_[j]]).magSquared() < 0.01f)
|
|
{
|
|
broke = true;
|
|
break;
|
|
}
|
|
}
|
|
float intersect;
|
|
if (!broke && !PointInsideCircle(*randArr[i], ret, intersect))
|
|
{
|
|
Circle2 circ = SupportFuncs[support.x0_](i, randArr.get(), support);
|
|
if (circ.x8_radiusSq > ret.x8_radiusSq)
|
|
{
|
|
i = 0;
|
|
ret = circ;
|
|
continue;
|
|
}
|
|
}
|
|
++i;
|
|
}
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
void CMapWorld::RecalculateWorldSphere(const CMapWorldInfo& mwInfo, const IWorld& wld) const
|
|
{
|
|
std::vector<zeus::CVector2f> coords;
|
|
coords.reserve(x0_areas.size() * 8);
|
|
float zMin = FLT_MAX;
|
|
float zMax = FLT_MIN;
|
|
for (int i=0 ; i<x0_areas.size() ; ++i)
|
|
{
|
|
if (IsMapAreaValid(wld, i, true))
|
|
{
|
|
const CMapArea* mapa = GetMapArea(i);
|
|
if (mapa->GetIsVisibleToAutoMapper(mwInfo.IsWorldVisible(i), mwInfo.IsAreaVisible(i)))
|
|
{
|
|
zeus::CAABox aabb = mapa->GetBoundingBox().getTransformedAABox(mapa->GetAreaPostTransform(wld, i));
|
|
for (int j=0 ; j<8 ; ++j)
|
|
{
|
|
zeus::CVector3f point = aabb.getPoint(j);
|
|
coords.emplace_back(point.x, point.y);
|
|
zMin = std::min(point.z, zMin);
|
|
zMax = std::max(point.z, zMax);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
Circle circle = MinCircle(coords);
|
|
const_cast<CMapWorld*>(this)->x3c_worldSphereRadius = circle.x8_radius;
|
|
const_cast<CMapWorld*>(this)->x30_worldSpherePoint =
|
|
zeus::CVector3f(circle.x0_point.x, circle.x0_point.y, (zMin + zMax) * 0.5f);
|
|
const_cast<CMapWorld*>(this)->x40_worldSphereHalfDepth = (zMax - zMin) * 0.5f;
|
|
}
|
|
|
|
zeus::CVector3f CMapWorld::ConstrainToWorldVolume(const zeus::CVector3f& point, const zeus::CVector3f& lookVec) const
|
|
{
|
|
zeus::CVector3f ret = point;
|
|
if (std::fabs(lookVec.z) > FLT_EPSILON)
|
|
{
|
|
float f2 = point.z - (x40_worldSphereHalfDepth + x30_worldSpherePoint.z);
|
|
float f1 = point.z - (x30_worldSpherePoint.z - x40_worldSphereHalfDepth);
|
|
if (f2 > 0.f)
|
|
ret = point + lookVec * (-f2 / lookVec.z);
|
|
else if (f1 < 0.f)
|
|
ret = point + lookVec * (-f1 / lookVec.z);
|
|
}
|
|
else
|
|
{
|
|
ret.z = zeus::clamp(x30_worldSpherePoint.z - x40_worldSphereHalfDepth, ret.z,
|
|
x40_worldSphereHalfDepth + x30_worldSpherePoint.z);
|
|
}
|
|
|
|
zeus::CVector2f tmp(x30_worldSpherePoint.x, x30_worldSpherePoint.y);
|
|
zeus::CVector2f vec2 = zeus::CVector2f(point.x, point.y) - tmp;
|
|
if (vec2.magnitude() > x3c_worldSphereRadius)
|
|
{
|
|
tmp += vec2.normalized() * x3c_worldSphereRadius;
|
|
ret.x = tmp.x;
|
|
ret.y = tmp.y;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
void CMapWorld::ClearTraversedFlags() const
|
|
{
|
|
std::vector<bool>& flags = const_cast<CMapWorld*>(this)->x20_traversed;
|
|
for (int i=0 ; i<flags.size() ; ++i)
|
|
flags[i] = false;
|
|
}
|
|
|
|
CFactoryFnReturn FMapWorldFactory(const SObjectTag& tag, CInputStream& in, const CVParamTransfer& param,
|
|
CObjectReference* selfRef)
|
|
{
|
|
return TToken<CMapWorld>::GetIObjObjectFor(std::make_unique<CMapWorld>(in));
|
|
}
|
|
|
|
}
|