You cannot select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
37 lines
1.3 KiB
C++
37 lines
1.3 KiB
C++
#include "findrandompointaroundcircle.hpp"
|
|
#include "settings.hpp"
|
|
#include "findsmoothpath.hpp"
|
|
|
|
#include <components/misc/rng.hpp>
|
|
|
|
#include <DetourNavMesh.h>
|
|
#include <DetourNavMeshQuery.h>
|
|
|
|
namespace DetourNavigator
|
|
{
|
|
std::optional<osg::Vec3f> findRandomPointAroundCircle(const dtNavMesh& navMesh, const osg::Vec3f& halfExtents,
|
|
const osg::Vec3f& start, const float maxRadius, const Flags includeFlags, const Settings& settings)
|
|
{
|
|
dtNavMeshQuery navMeshQuery;
|
|
if (!initNavMeshQuery(navMeshQuery, navMesh, settings.mMaxNavMeshQueryNodes))
|
|
return std::optional<osg::Vec3f>();
|
|
|
|
dtQueryFilter queryFilter;
|
|
queryFilter.setIncludeFlags(includeFlags);
|
|
|
|
dtPolyRef startRef = findNearestPolyExpanding(navMeshQuery, queryFilter, start, halfExtents);
|
|
if (startRef == 0)
|
|
return std::optional<osg::Vec3f>();
|
|
|
|
dtPolyRef resultRef = 0;
|
|
osg::Vec3f resultPosition;
|
|
navMeshQuery.findRandomPointAroundCircle(startRef, start.ptr(), maxRadius, &queryFilter,
|
|
[]() { return Misc::Rng::rollProbability(); }, &resultRef, resultPosition.ptr());
|
|
|
|
if (resultRef == 0)
|
|
return std::optional<osg::Vec3f>();
|
|
|
|
return std::optional<osg::Vec3f>(resultPosition);
|
|
}
|
|
}
|