|
|
|
@ -11,10 +11,16 @@
|
|
|
|
|
#include <boost/optional/optional_io.hpp>
|
|
|
|
|
|
|
|
|
|
#include <gtest/gtest.h>
|
|
|
|
|
#include <gmock/gmock.h>
|
|
|
|
|
|
|
|
|
|
#include <iterator>
|
|
|
|
|
#include <deque>
|
|
|
|
|
|
|
|
|
|
MATCHER_P3(Vec3fEq, x, y, z, "")
|
|
|
|
|
{
|
|
|
|
|
return std::abs(arg.x() - x) < 1e-4 && std::abs(arg.y() - y) < 1e-4 && std::abs(arg.z() - z) < 1e-4;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
namespace
|
|
|
|
|
{
|
|
|
|
|
using namespace testing;
|
|
|
|
@ -113,31 +119,31 @@ namespace
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(mNavigator->findPath(mAgentHalfExtents, mStepSize, mStart, mEnd, Flag_walk, mOut), Status::Success);
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(mPath, std::deque<osg::Vec3f>({
|
|
|
|
|
osg::Vec3f(-215, 215, 1.85963428020477294921875),
|
|
|
|
|
osg::Vec3f(-194.9653167724609375, 194.9653167724609375, -6.57602214813232421875),
|
|
|
|
|
osg::Vec3f(-174.930633544921875, 174.930633544921875, -15.01167774200439453125),
|
|
|
|
|
osg::Vec3f(-154.8959503173828125, 154.8959503173828125, -23.4473361968994140625),
|
|
|
|
|
osg::Vec3f(-134.86126708984375, 134.86126708984375, -31.8829936981201171875),
|
|
|
|
|
osg::Vec3f(-114.82657623291015625, 114.82657623291015625, -40.3186492919921875),
|
|
|
|
|
osg::Vec3f(-94.7918853759765625, 94.7918853759765625, -47.3990631103515625),
|
|
|
|
|
osg::Vec3f(-74.75719451904296875, 74.75719451904296875, -53.7258148193359375),
|
|
|
|
|
osg::Vec3f(-54.722499847412109375, 54.722499847412109375, -60.052555084228515625),
|
|
|
|
|
osg::Vec3f(-34.68780517578125, 34.68780517578125, -66.37931060791015625),
|
|
|
|
|
osg::Vec3f(-14.6531162261962890625, 14.6531162261962890625, -72.70604705810546875),
|
|
|
|
|
osg::Vec3f(5.3815765380859375, -5.3815765380859375, -75.35065460205078125),
|
|
|
|
|
osg::Vec3f(25.41626739501953125, -25.41626739501953125, -67.9694671630859375),
|
|
|
|
|
osg::Vec3f(45.450958251953125, -45.450958251953125, -60.5882568359375),
|
|
|
|
|
osg::Vec3f(65.48564910888671875, -65.48564910888671875, -53.20705413818359375),
|
|
|
|
|
osg::Vec3f(85.5203399658203125, -85.5203399658203125, -45.8258514404296875),
|
|
|
|
|
osg::Vec3f(105.55503082275390625, -105.55503082275390625, -38.44464874267578125),
|
|
|
|
|
osg::Vec3f(125.5897216796875, -125.5897216796875, -31.063449859619140625),
|
|
|
|
|
osg::Vec3f(145.6244049072265625, -145.6244049072265625, -23.6822509765625),
|
|
|
|
|
osg::Vec3f(165.659088134765625, -165.659088134765625, -16.3010501861572265625),
|
|
|
|
|
osg::Vec3f(185.6937713623046875, -185.6937713623046875, -8.91985416412353515625),
|
|
|
|
|
osg::Vec3f(205.7284698486328125, -205.7284698486328125, -1.5386505126953125),
|
|
|
|
|
osg::Vec3f(215, -215, 1.87718021869659423828125),
|
|
|
|
|
})) << mPath;
|
|
|
|
|
EXPECT_THAT(mPath, ElementsAre(
|
|
|
|
|
Vec3fEq(-215, 215, 1.85963428020477294921875),
|
|
|
|
|
Vec3fEq(-194.9653167724609375, 194.9653167724609375, -6.57602214813232421875),
|
|
|
|
|
Vec3fEq(-174.930633544921875, 174.930633544921875, -15.01167774200439453125),
|
|
|
|
|
Vec3fEq(-154.8959503173828125, 154.8959503173828125, -23.4473361968994140625),
|
|
|
|
|
Vec3fEq(-134.86126708984375, 134.86126708984375, -31.8829936981201171875),
|
|
|
|
|
Vec3fEq(-114.82657623291015625, 114.82657623291015625, -40.3186492919921875),
|
|
|
|
|
Vec3fEq(-94.7918853759765625, 94.7918853759765625, -47.3990631103515625),
|
|
|
|
|
Vec3fEq(-74.75719451904296875, 74.75719451904296875, -53.7258148193359375),
|
|
|
|
|
Vec3fEq(-54.722499847412109375, 54.722499847412109375, -60.052555084228515625),
|
|
|
|
|
Vec3fEq(-34.68780517578125, 34.68780517578125, -66.37931060791015625),
|
|
|
|
|
Vec3fEq(-14.6531162261962890625, 14.6531162261962890625, -72.70604705810546875),
|
|
|
|
|
Vec3fEq(5.3815765380859375, -5.3815765380859375, -75.35065460205078125),
|
|
|
|
|
Vec3fEq(25.41626739501953125, -25.41626739501953125, -67.9694671630859375),
|
|
|
|
|
Vec3fEq(45.450958251953125, -45.450958251953125, -60.5882568359375),
|
|
|
|
|
Vec3fEq(65.48564910888671875, -65.48564910888671875, -53.20705413818359375),
|
|
|
|
|
Vec3fEq(85.5203399658203125, -85.5203399658203125, -45.8258514404296875),
|
|
|
|
|
Vec3fEq(105.55503082275390625, -105.55503082275390625, -38.44464874267578125),
|
|
|
|
|
Vec3fEq(125.5897216796875, -125.5897216796875, -31.063449859619140625),
|
|
|
|
|
Vec3fEq(145.6244049072265625, -145.6244049072265625, -23.6822509765625),
|
|
|
|
|
Vec3fEq(165.659088134765625, -165.659088134765625, -16.3010501861572265625),
|
|
|
|
|
Vec3fEq(185.6937713623046875, -185.6937713623046875, -8.91985416412353515625),
|
|
|
|
|
Vec3fEq(205.7284698486328125, -205.7284698486328125, -1.5386505126953125),
|
|
|
|
|
Vec3fEq(215, -215, 1.87718021869659423828125)
|
|
|
|
|
));
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
TEST_F(DetourNavigatorNavigatorTest, add_object_should_change_navmesh)
|
|
|
|
@ -163,31 +169,31 @@ namespace
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(mNavigator->findPath(mAgentHalfExtents, mStepSize, mStart, mEnd, Flag_walk, mOut), Status::Success);
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(mPath, std::deque<osg::Vec3f>({
|
|
|
|
|
osg::Vec3f(-215, 215, 1.85963428020477294921875),
|
|
|
|
|
osg::Vec3f(-194.9653167724609375, 194.9653167724609375, -6.57602214813232421875),
|
|
|
|
|
osg::Vec3f(-174.930633544921875, 174.930633544921875, -15.01167774200439453125),
|
|
|
|
|
osg::Vec3f(-154.8959503173828125, 154.8959503173828125, -23.4473361968994140625),
|
|
|
|
|
osg::Vec3f(-134.86126708984375, 134.86126708984375, -31.8829936981201171875),
|
|
|
|
|
osg::Vec3f(-114.82657623291015625, 114.82657623291015625, -40.3186492919921875),
|
|
|
|
|
osg::Vec3f(-94.7918853759765625, 94.7918853759765625, -47.3990631103515625),
|
|
|
|
|
osg::Vec3f(-74.75719451904296875, 74.75719451904296875, -53.7258148193359375),
|
|
|
|
|
osg::Vec3f(-54.722499847412109375, 54.722499847412109375, -60.052555084228515625),
|
|
|
|
|
osg::Vec3f(-34.68780517578125, 34.68780517578125, -66.37931060791015625),
|
|
|
|
|
osg::Vec3f(-14.6531162261962890625, 14.6531162261962890625, -72.70604705810546875),
|
|
|
|
|
osg::Vec3f(5.3815765380859375, -5.3815765380859375, -75.35065460205078125),
|
|
|
|
|
osg::Vec3f(25.41626739501953125, -25.41626739501953125, -67.9694671630859375),
|
|
|
|
|
osg::Vec3f(45.450958251953125, -45.450958251953125, -60.5882568359375),
|
|
|
|
|
osg::Vec3f(65.48564910888671875, -65.48564910888671875, -53.20705413818359375),
|
|
|
|
|
osg::Vec3f(85.5203399658203125, -85.5203399658203125, -45.8258514404296875),
|
|
|
|
|
osg::Vec3f(105.55503082275390625, -105.55503082275390625, -38.44464874267578125),
|
|
|
|
|
osg::Vec3f(125.5897216796875, -125.5897216796875, -31.063449859619140625),
|
|
|
|
|
osg::Vec3f(145.6244049072265625, -145.6244049072265625, -23.6822509765625),
|
|
|
|
|
osg::Vec3f(165.659088134765625, -165.659088134765625, -16.3010501861572265625),
|
|
|
|
|
osg::Vec3f(185.6937713623046875, -185.6937713623046875, -8.91985416412353515625),
|
|
|
|
|
osg::Vec3f(205.7284698486328125, -205.7284698486328125, -1.5386505126953125),
|
|
|
|
|
osg::Vec3f(215, -215, 1.87718021869659423828125),
|
|
|
|
|
})) << mPath;
|
|
|
|
|
EXPECT_THAT(mPath, ElementsAre(
|
|
|
|
|
Vec3fEq(-215, 215, 1.85963428020477294921875),
|
|
|
|
|
Vec3fEq(-194.9653167724609375, 194.9653167724609375, -6.57602214813232421875),
|
|
|
|
|
Vec3fEq(-174.930633544921875, 174.930633544921875, -15.01167774200439453125),
|
|
|
|
|
Vec3fEq(-154.8959503173828125, 154.8959503173828125, -23.4473361968994140625),
|
|
|
|
|
Vec3fEq(-134.86126708984375, 134.86126708984375, -31.8829936981201171875),
|
|
|
|
|
Vec3fEq(-114.82657623291015625, 114.82657623291015625, -40.3186492919921875),
|
|
|
|
|
Vec3fEq(-94.7918853759765625, 94.7918853759765625, -47.3990631103515625),
|
|
|
|
|
Vec3fEq(-74.75719451904296875, 74.75719451904296875, -53.7258148193359375),
|
|
|
|
|
Vec3fEq(-54.722499847412109375, 54.722499847412109375, -60.052555084228515625),
|
|
|
|
|
Vec3fEq(-34.68780517578125, 34.68780517578125, -66.37931060791015625),
|
|
|
|
|
Vec3fEq(-14.6531162261962890625, 14.6531162261962890625, -72.70604705810546875),
|
|
|
|
|
Vec3fEq(5.3815765380859375, -5.3815765380859375, -75.35065460205078125),
|
|
|
|
|
Vec3fEq(25.41626739501953125, -25.41626739501953125, -67.9694671630859375),
|
|
|
|
|
Vec3fEq(45.450958251953125, -45.450958251953125, -60.5882568359375),
|
|
|
|
|
Vec3fEq(65.48564910888671875, -65.48564910888671875, -53.20705413818359375),
|
|
|
|
|
Vec3fEq(85.5203399658203125, -85.5203399658203125, -45.8258514404296875),
|
|
|
|
|
Vec3fEq(105.55503082275390625, -105.55503082275390625, -38.44464874267578125),
|
|
|
|
|
Vec3fEq(125.5897216796875, -125.5897216796875, -31.063449859619140625),
|
|
|
|
|
Vec3fEq(145.6244049072265625, -145.6244049072265625, -23.6822509765625),
|
|
|
|
|
Vec3fEq(165.659088134765625, -165.659088134765625, -16.3010501861572265625),
|
|
|
|
|
Vec3fEq(185.6937713623046875, -185.6937713623046875, -8.91985416412353515625),
|
|
|
|
|
Vec3fEq(205.7284698486328125, -205.7284698486328125, -1.5386505126953125),
|
|
|
|
|
Vec3fEq(215, -215, 1.87718021869659423828125)
|
|
|
|
|
));
|
|
|
|
|
|
|
|
|
|
mNavigator->addObject(ObjectId(&compoundShape), compoundShape, btTransform::getIdentity());
|
|
|
|
|
mNavigator->update(mPlayerPosition);
|
|
|
|
@ -197,31 +203,31 @@ namespace
|
|
|
|
|
mOut = std::back_inserter(mPath);
|
|
|
|
|
EXPECT_EQ(mNavigator->findPath(mAgentHalfExtents, mStepSize, mStart, mEnd, Flag_walk, mOut), Status::Success);
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(mPath, std::deque<osg::Vec3f>({
|
|
|
|
|
osg::Vec3f(-215, 215, 1.87826788425445556640625),
|
|
|
|
|
osg::Vec3f(-199.7968292236328125, 191.09100341796875, -3.54876613616943359375),
|
|
|
|
|
osg::Vec3f(-184.5936431884765625, 167.1819915771484375, -8.97847843170166015625),
|
|
|
|
|
osg::Vec3f(-169.3904571533203125, 143.2729949951171875, -14.408184051513671875),
|
|
|
|
|
osg::Vec3f(-154.1872711181640625, 119.36397552490234375, -19.837890625),
|
|
|
|
|
osg::Vec3f(-138.9840850830078125, 95.45496368408203125, -25.2675991058349609375),
|
|
|
|
|
osg::Vec3f(-123.78090667724609375, 71.54595184326171875, -30.6973056793212890625),
|
|
|
|
|
osg::Vec3f(-108.57772064208984375, 47.636936187744140625, -36.12701416015625),
|
|
|
|
|
osg::Vec3f(-93.3745269775390625, 23.7279262542724609375, -40.754688262939453125),
|
|
|
|
|
osg::Vec3f(-78.17134857177734375, -0.18108306825160980224609375, -37.128787994384765625),
|
|
|
|
|
osg::Vec3f(-62.968158721923828125, -24.0900936126708984375, -33.50289154052734375),
|
|
|
|
|
osg::Vec3f(-47.764972686767578125, -47.999103546142578125, -30.797946929931640625),
|
|
|
|
|
osg::Vec3f(-23.852447509765625, -63.196765899658203125, -33.97112274169921875),
|
|
|
|
|
osg::Vec3f(0.0600789971649646759033203125, -78.39443206787109375, -37.14543914794921875),
|
|
|
|
|
osg::Vec3f(23.97260284423828125, -93.5920867919921875, -40.774089813232421875),
|
|
|
|
|
osg::Vec3f(47.885128021240234375, -108.78974151611328125, -36.05129241943359375),
|
|
|
|
|
osg::Vec3f(71.7976531982421875, -123.98740386962890625, -30.6235561370849609375),
|
|
|
|
|
osg::Vec3f(95.71018218994140625, -139.18505859375, -25.1958255767822265625),
|
|
|
|
|
osg::Vec3f(119.6226959228515625, -154.382720947265625, -19.7680912017822265625),
|
|
|
|
|
osg::Vec3f(143.53521728515625, -169.58038330078125, -14.34035205841064453125),
|
|
|
|
|
osg::Vec3f(167.4477386474609375, -184.778045654296875, -8.9126186370849609375),
|
|
|
|
|
osg::Vec3f(191.360260009765625, -199.9757080078125, -3.4848802089691162109375),
|
|
|
|
|
osg::Vec3f(215, -215, 1.87826788425445556640625),
|
|
|
|
|
})) << mPath;
|
|
|
|
|
EXPECT_THAT(mPath, ElementsAre(
|
|
|
|
|
Vec3fEq(-215, 215, 1.87826788425445556640625),
|
|
|
|
|
Vec3fEq(-199.7968292236328125, 191.09100341796875, -3.54876613616943359375),
|
|
|
|
|
Vec3fEq(-184.5936431884765625, 167.1819915771484375, -8.97847843170166015625),
|
|
|
|
|
Vec3fEq(-169.3904571533203125, 143.2729949951171875, -14.408184051513671875),
|
|
|
|
|
Vec3fEq(-154.1872711181640625, 119.36397552490234375, -19.837890625),
|
|
|
|
|
Vec3fEq(-138.9840850830078125, 95.45496368408203125, -25.2675991058349609375),
|
|
|
|
|
Vec3fEq(-123.78090667724609375, 71.54595184326171875, -30.6973056793212890625),
|
|
|
|
|
Vec3fEq(-108.57772064208984375, 47.636936187744140625, -36.12701416015625),
|
|
|
|
|
Vec3fEq(-93.3745269775390625, 23.7279262542724609375, -40.754688262939453125),
|
|
|
|
|
Vec3fEq(-78.17134857177734375, -0.18108306825160980224609375, -37.128787994384765625),
|
|
|
|
|
Vec3fEq(-62.968158721923828125, -24.0900936126708984375, -33.50289154052734375),
|
|
|
|
|
Vec3fEq(-47.764972686767578125, -47.999103546142578125, -30.797946929931640625),
|
|
|
|
|
Vec3fEq(-23.852447509765625, -63.196765899658203125, -33.97112274169921875),
|
|
|
|
|
Vec3fEq(0.0600789971649646759033203125, -78.39443206787109375, -37.14543914794921875),
|
|
|
|
|
Vec3fEq(23.97260284423828125, -93.5920867919921875, -40.774089813232421875),
|
|
|
|
|
Vec3fEq(47.885128021240234375, -108.78974151611328125, -36.05129241943359375),
|
|
|
|
|
Vec3fEq(71.7976531982421875, -123.98740386962890625, -30.6235561370849609375),
|
|
|
|
|
Vec3fEq(95.71018218994140625, -139.18505859375, -25.1958255767822265625),
|
|
|
|
|
Vec3fEq(119.6226959228515625, -154.382720947265625, -19.7680912017822265625),
|
|
|
|
|
Vec3fEq(143.53521728515625, -169.58038330078125, -14.34035205841064453125),
|
|
|
|
|
Vec3fEq(167.4477386474609375, -184.778045654296875, -8.9126186370849609375),
|
|
|
|
|
Vec3fEq(191.360260009765625, -199.9757080078125, -3.4848802089691162109375),
|
|
|
|
|
Vec3fEq(215, -215, 1.87826788425445556640625)
|
|
|
|
|
));
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
TEST_F(DetourNavigatorNavigatorTest, update_changed_object_should_change_navmesh)
|
|
|
|
@ -248,31 +254,31 @@ namespace
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(mNavigator->findPath(mAgentHalfExtents, mStepSize, mStart, mEnd, Flag_walk, mOut), Status::Success);
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(mPath, std::deque<osg::Vec3f>({
|
|
|
|
|
osg::Vec3f(-215, 215, 1.87826788425445556640625),
|
|
|
|
|
osg::Vec3f(-199.7968292236328125, 191.09100341796875, -3.54876613616943359375),
|
|
|
|
|
osg::Vec3f(-184.5936431884765625, 167.1819915771484375, -8.97847843170166015625),
|
|
|
|
|
osg::Vec3f(-169.3904571533203125, 143.2729949951171875, -14.408184051513671875),
|
|
|
|
|
osg::Vec3f(-154.1872711181640625, 119.36397552490234375, -19.837890625),
|
|
|
|
|
osg::Vec3f(-138.9840850830078125, 95.45496368408203125, -25.2675991058349609375),
|
|
|
|
|
osg::Vec3f(-123.78090667724609375, 71.54595184326171875, -30.6973056793212890625),
|
|
|
|
|
osg::Vec3f(-108.57772064208984375, 47.636936187744140625, -36.12701416015625),
|
|
|
|
|
osg::Vec3f(-93.3745269775390625, 23.7279262542724609375, -40.754688262939453125),
|
|
|
|
|
osg::Vec3f(-78.17134857177734375, -0.18108306825160980224609375, -37.128787994384765625),
|
|
|
|
|
osg::Vec3f(-62.968158721923828125, -24.0900936126708984375, -33.50289154052734375),
|
|
|
|
|
osg::Vec3f(-47.764972686767578125, -47.999103546142578125, -30.797946929931640625),
|
|
|
|
|
osg::Vec3f(-23.852447509765625, -63.196765899658203125, -33.97112274169921875),
|
|
|
|
|
osg::Vec3f(0.0600789971649646759033203125, -78.39443206787109375, -37.14543914794921875),
|
|
|
|
|
osg::Vec3f(23.97260284423828125, -93.5920867919921875, -40.774089813232421875),
|
|
|
|
|
osg::Vec3f(47.885128021240234375, -108.78974151611328125, -36.05129241943359375),
|
|
|
|
|
osg::Vec3f(71.7976531982421875, -123.98740386962890625, -30.6235561370849609375),
|
|
|
|
|
osg::Vec3f(95.71018218994140625, -139.18505859375, -25.1958255767822265625),
|
|
|
|
|
osg::Vec3f(119.6226959228515625, -154.382720947265625, -19.7680912017822265625),
|
|
|
|
|
osg::Vec3f(143.53521728515625, -169.58038330078125, -14.34035205841064453125),
|
|
|
|
|
osg::Vec3f(167.4477386474609375, -184.778045654296875, -8.9126186370849609375),
|
|
|
|
|
osg::Vec3f(191.360260009765625, -199.9757080078125, -3.4848802089691162109375),
|
|
|
|
|
osg::Vec3f(215, -215, 1.87826788425445556640625),
|
|
|
|
|
})) << mPath;
|
|
|
|
|
EXPECT_THAT(mPath, ElementsAre(
|
|
|
|
|
Vec3fEq(-215, 215, 1.87826788425445556640625),
|
|
|
|
|
Vec3fEq(-199.7968292236328125, 191.09100341796875, -3.54876613616943359375),
|
|
|
|
|
Vec3fEq(-184.5936431884765625, 167.1819915771484375, -8.97847843170166015625),
|
|
|
|
|
Vec3fEq(-169.3904571533203125, 143.2729949951171875, -14.408184051513671875),
|
|
|
|
|
Vec3fEq(-154.1872711181640625, 119.36397552490234375, -19.837890625),
|
|
|
|
|
Vec3fEq(-138.9840850830078125, 95.45496368408203125, -25.2675991058349609375),
|
|
|
|
|
Vec3fEq(-123.78090667724609375, 71.54595184326171875, -30.6973056793212890625),
|
|
|
|
|
Vec3fEq(-108.57772064208984375, 47.636936187744140625, -36.12701416015625),
|
|
|
|
|
Vec3fEq(-93.3745269775390625, 23.7279262542724609375, -40.754688262939453125),
|
|
|
|
|
Vec3fEq(-78.17134857177734375, -0.18108306825160980224609375, -37.128787994384765625),
|
|
|
|
|
Vec3fEq(-62.968158721923828125, -24.0900936126708984375, -33.50289154052734375),
|
|
|
|
|
Vec3fEq(-47.764972686767578125, -47.999103546142578125, -30.797946929931640625),
|
|
|
|
|
Vec3fEq(-23.852447509765625, -63.196765899658203125, -33.97112274169921875),
|
|
|
|
|
Vec3fEq(0.0600789971649646759033203125, -78.39443206787109375, -37.14543914794921875),
|
|
|
|
|
Vec3fEq(23.97260284423828125, -93.5920867919921875, -40.774089813232421875),
|
|
|
|
|
Vec3fEq(47.885128021240234375, -108.78974151611328125, -36.05129241943359375),
|
|
|
|
|
Vec3fEq(71.7976531982421875, -123.98740386962890625, -30.6235561370849609375),
|
|
|
|
|
Vec3fEq(95.71018218994140625, -139.18505859375, -25.1958255767822265625),
|
|
|
|
|
Vec3fEq(119.6226959228515625, -154.382720947265625, -19.7680912017822265625),
|
|
|
|
|
Vec3fEq(143.53521728515625, -169.58038330078125, -14.34035205841064453125),
|
|
|
|
|
Vec3fEq(167.4477386474609375, -184.778045654296875, -8.9126186370849609375),
|
|
|
|
|
Vec3fEq(191.360260009765625, -199.9757080078125, -3.4848802089691162109375),
|
|
|
|
|
Vec3fEq(215, -215, 1.87826788425445556640625)
|
|
|
|
|
));
|
|
|
|
|
|
|
|
|
|
compoundShape.updateChildTransform(0, btTransform(btMatrix3x3::getIdentity(), btVector3(1000, 0, 0)));
|
|
|
|
|
|
|
|
|
@ -284,31 +290,31 @@ namespace
|
|
|
|
|
mOut = std::back_inserter(mPath);
|
|
|
|
|
EXPECT_EQ(mNavigator->findPath(mAgentHalfExtents, mStepSize, mStart, mEnd, Flag_walk, mOut), Status::Success);
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(mPath, std::deque<osg::Vec3f>({
|
|
|
|
|
osg::Vec3f(-215, 215, 1.85963428020477294921875),
|
|
|
|
|
osg::Vec3f(-194.9653167724609375, 194.9653167724609375, -6.57602214813232421875),
|
|
|
|
|
osg::Vec3f(-174.930633544921875, 174.930633544921875, -15.01167774200439453125),
|
|
|
|
|
osg::Vec3f(-154.8959503173828125, 154.8959503173828125, -23.4473361968994140625),
|
|
|
|
|
osg::Vec3f(-134.86126708984375, 134.86126708984375, -31.8829936981201171875),
|
|
|
|
|
osg::Vec3f(-114.82657623291015625, 114.82657623291015625, -40.3186492919921875),
|
|
|
|
|
osg::Vec3f(-94.7918853759765625, 94.7918853759765625, -47.3990631103515625),
|
|
|
|
|
osg::Vec3f(-74.75719451904296875, 74.75719451904296875, -53.7258148193359375),
|
|
|
|
|
osg::Vec3f(-54.722499847412109375, 54.722499847412109375, -60.052555084228515625),
|
|
|
|
|
osg::Vec3f(-34.68780517578125, 34.68780517578125, -66.37931060791015625),
|
|
|
|
|
osg::Vec3f(-14.6531162261962890625, 14.6531162261962890625, -72.70604705810546875),
|
|
|
|
|
osg::Vec3f(5.3815765380859375, -5.3815765380859375, -75.35065460205078125),
|
|
|
|
|
osg::Vec3f(25.41626739501953125, -25.41626739501953125, -67.9694671630859375),
|
|
|
|
|
osg::Vec3f(45.450958251953125, -45.450958251953125, -60.5882568359375),
|
|
|
|
|
osg::Vec3f(65.48564910888671875, -65.48564910888671875, -53.20705413818359375),
|
|
|
|
|
osg::Vec3f(85.5203399658203125, -85.5203399658203125, -45.8258514404296875),
|
|
|
|
|
osg::Vec3f(105.55503082275390625, -105.55503082275390625, -38.44464874267578125),
|
|
|
|
|
osg::Vec3f(125.5897216796875, -125.5897216796875, -31.063449859619140625),
|
|
|
|
|
osg::Vec3f(145.6244049072265625, -145.6244049072265625, -23.6822509765625),
|
|
|
|
|
osg::Vec3f(165.659088134765625, -165.659088134765625, -16.3010501861572265625),
|
|
|
|
|
osg::Vec3f(185.6937713623046875, -185.6937713623046875, -8.91985416412353515625),
|
|
|
|
|
osg::Vec3f(205.7284698486328125, -205.7284698486328125, -1.5386505126953125),
|
|
|
|
|
osg::Vec3f(215, -215, 1.87718021869659423828125),
|
|
|
|
|
})) << mPath;
|
|
|
|
|
EXPECT_THAT(mPath, ElementsAre(
|
|
|
|
|
Vec3fEq(-215, 215, 1.85963428020477294921875),
|
|
|
|
|
Vec3fEq(-194.9653167724609375, 194.9653167724609375, -6.57602214813232421875),
|
|
|
|
|
Vec3fEq(-174.930633544921875, 174.930633544921875, -15.01167774200439453125),
|
|
|
|
|
Vec3fEq(-154.8959503173828125, 154.8959503173828125, -23.4473361968994140625),
|
|
|
|
|
Vec3fEq(-134.86126708984375, 134.86126708984375, -31.8829936981201171875),
|
|
|
|
|
Vec3fEq(-114.82657623291015625, 114.82657623291015625, -40.3186492919921875),
|
|
|
|
|
Vec3fEq(-94.7918853759765625, 94.7918853759765625, -47.3990631103515625),
|
|
|
|
|
Vec3fEq(-74.75719451904296875, 74.75719451904296875, -53.7258148193359375),
|
|
|
|
|
Vec3fEq(-54.722499847412109375, 54.722499847412109375, -60.052555084228515625),
|
|
|
|
|
Vec3fEq(-34.68780517578125, 34.68780517578125, -66.37931060791015625),
|
|
|
|
|
Vec3fEq(-14.6531162261962890625, 14.6531162261962890625, -72.70604705810546875),
|
|
|
|
|
Vec3fEq(5.3815765380859375, -5.3815765380859375, -75.35065460205078125),
|
|
|
|
|
Vec3fEq(25.41626739501953125, -25.41626739501953125, -67.9694671630859375),
|
|
|
|
|
Vec3fEq(45.450958251953125, -45.450958251953125, -60.5882568359375),
|
|
|
|
|
Vec3fEq(65.48564910888671875, -65.48564910888671875, -53.20705413818359375),
|
|
|
|
|
Vec3fEq(85.5203399658203125, -85.5203399658203125, -45.8258514404296875),
|
|
|
|
|
Vec3fEq(105.55503082275390625, -105.55503082275390625, -38.44464874267578125),
|
|
|
|
|
Vec3fEq(125.5897216796875, -125.5897216796875, -31.063449859619140625),
|
|
|
|
|
Vec3fEq(145.6244049072265625, -145.6244049072265625, -23.6822509765625),
|
|
|
|
|
Vec3fEq(165.659088134765625, -165.659088134765625, -16.3010501861572265625),
|
|
|
|
|
Vec3fEq(185.6937713623046875, -185.6937713623046875, -8.91985416412353515625),
|
|
|
|
|
Vec3fEq(205.7284698486328125, -205.7284698486328125, -1.5386505126953125),
|
|
|
|
|
Vec3fEq(215, -215, 1.87718021869659423828125)
|
|
|
|
|
));
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
TEST_F(DetourNavigatorNavigatorTest, for_overlapping_heightfields_should_use_higher)
|
|
|
|
@ -341,31 +347,31 @@ namespace
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(mNavigator->findPath(mAgentHalfExtents, mStepSize, mStart, mEnd, Flag_walk, mOut), Status::Success);
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(mPath, std::deque<osg::Vec3f>({
|
|
|
|
|
osg::Vec3f(-215, 215, 1.96328866481781005859375),
|
|
|
|
|
osg::Vec3f(-194.9653167724609375, 194.9653167724609375, -0.242215454578399658203125),
|
|
|
|
|
osg::Vec3f(-174.930633544921875, 174.930633544921875, -2.447719097137451171875),
|
|
|
|
|
osg::Vec3f(-154.8959503173828125, 154.8959503173828125, -4.65322399139404296875),
|
|
|
|
|
osg::Vec3f(-134.86126708984375, 134.86126708984375, -6.858726978302001953125),
|
|
|
|
|
osg::Vec3f(-114.82657623291015625, 114.82657623291015625, -9.06423282623291015625),
|
|
|
|
|
osg::Vec3f(-94.7918853759765625, 94.7918853759765625, -11.26973628997802734375),
|
|
|
|
|
osg::Vec3f(-74.75719451904296875, 74.75719451904296875, -13.26497173309326171875),
|
|
|
|
|
osg::Vec3f(-54.722499847412109375, 54.722499847412109375, -15.24860477447509765625),
|
|
|
|
|
osg::Vec3f(-34.68780517578125, 34.68780517578125, -17.23223876953125),
|
|
|
|
|
osg::Vec3f(-14.6531162261962890625, 14.6531162261962890625, -19.215869903564453125),
|
|
|
|
|
osg::Vec3f(5.3815765380859375, -5.3815765380859375, -20.1338443756103515625),
|
|
|
|
|
osg::Vec3f(25.41626739501953125, -25.41626739501953125, -18.1502132415771484375),
|
|
|
|
|
osg::Vec3f(45.450958251953125, -45.450958251953125, -16.1665802001953125),
|
|
|
|
|
osg::Vec3f(65.48564910888671875, -65.48564910888671875, -14.18294620513916015625),
|
|
|
|
|
osg::Vec3f(85.5203399658203125, -85.5203399658203125, -12.199314117431640625),
|
|
|
|
|
osg::Vec3f(105.55503082275390625, -105.55503082275390625, -10.08488368988037109375),
|
|
|
|
|
osg::Vec3f(125.5897216796875, -125.5897216796875, -7.87938022613525390625),
|
|
|
|
|
osg::Vec3f(145.6244049072265625, -145.6244049072265625, -5.673875331878662109375),
|
|
|
|
|
osg::Vec3f(165.659088134765625, -165.659088134765625, -3.468370914459228515625),
|
|
|
|
|
osg::Vec3f(185.6937713623046875, -185.6937713623046875, -1.26286637783050537109375),
|
|
|
|
|
osg::Vec3f(205.7284698486328125, -205.7284698486328125, 0.942641556262969970703125),
|
|
|
|
|
osg::Vec3f(215, -215, 1.96328866481781005859375),
|
|
|
|
|
})) << mPath;
|
|
|
|
|
EXPECT_THAT(mPath, ElementsAre(
|
|
|
|
|
Vec3fEq(-215, 215, 1.96328866481781005859375),
|
|
|
|
|
Vec3fEq(-194.9653167724609375, 194.9653167724609375, -0.242215454578399658203125),
|
|
|
|
|
Vec3fEq(-174.930633544921875, 174.930633544921875, -2.447719097137451171875),
|
|
|
|
|
Vec3fEq(-154.8959503173828125, 154.8959503173828125, -4.65322399139404296875),
|
|
|
|
|
Vec3fEq(-134.86126708984375, 134.86126708984375, -6.858726978302001953125),
|
|
|
|
|
Vec3fEq(-114.82657623291015625, 114.82657623291015625, -9.06423282623291015625),
|
|
|
|
|
Vec3fEq(-94.7918853759765625, 94.7918853759765625, -11.26973628997802734375),
|
|
|
|
|
Vec3fEq(-74.75719451904296875, 74.75719451904296875, -13.26497173309326171875),
|
|
|
|
|
Vec3fEq(-54.722499847412109375, 54.722499847412109375, -15.24860477447509765625),
|
|
|
|
|
Vec3fEq(-34.68780517578125, 34.68780517578125, -17.23223876953125),
|
|
|
|
|
Vec3fEq(-14.6531162261962890625, 14.6531162261962890625, -19.215869903564453125),
|
|
|
|
|
Vec3fEq(5.3815765380859375, -5.3815765380859375, -20.1338443756103515625),
|
|
|
|
|
Vec3fEq(25.41626739501953125, -25.41626739501953125, -18.1502132415771484375),
|
|
|
|
|
Vec3fEq(45.450958251953125, -45.450958251953125, -16.1665802001953125),
|
|
|
|
|
Vec3fEq(65.48564910888671875, -65.48564910888671875, -14.18294620513916015625),
|
|
|
|
|
Vec3fEq(85.5203399658203125, -85.5203399658203125, -12.199314117431640625),
|
|
|
|
|
Vec3fEq(105.55503082275390625, -105.55503082275390625, -10.08488368988037109375),
|
|
|
|
|
Vec3fEq(125.5897216796875, -125.5897216796875, -7.87938022613525390625),
|
|
|
|
|
Vec3fEq(145.6244049072265625, -145.6244049072265625, -5.673875331878662109375),
|
|
|
|
|
Vec3fEq(165.659088134765625, -165.659088134765625, -3.468370914459228515625),
|
|
|
|
|
Vec3fEq(185.6937713623046875, -185.6937713623046875, -1.26286637783050537109375),
|
|
|
|
|
Vec3fEq(205.7284698486328125, -205.7284698486328125, 0.942641556262969970703125),
|
|
|
|
|
Vec3fEq(215, -215, 1.96328866481781005859375)
|
|
|
|
|
));
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
TEST_F(DetourNavigatorNavigatorTest, path_should_be_around_avoid_shape)
|
|
|
|
@ -397,32 +403,32 @@ namespace
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(mNavigator->findPath(mAgentHalfExtents, mStepSize, mStart, mEnd, Flag_walk, mOut), Status::Success);
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(mPath, std::deque<osg::Vec3f>({
|
|
|
|
|
osg::Vec3f(-215, 215, 1.9393787384033203125),
|
|
|
|
|
osg::Vec3f(-200.8159637451171875, 190.47265625, -0.639537751674652099609375),
|
|
|
|
|
osg::Vec3f(-186.6319427490234375, 165.9453125, -3.2184507846832275390625),
|
|
|
|
|
osg::Vec3f(-172.447906494140625, 141.41796875, -5.797363758087158203125),
|
|
|
|
|
osg::Vec3f(-158.263885498046875, 116.8906097412109375, -8.37627696990966796875),
|
|
|
|
|
osg::Vec3f(-144.079864501953125, 92.3632659912109375, -10.9551906585693359375),
|
|
|
|
|
osg::Vec3f(-129.89581298828125, 67.83591461181640625, -13.53410625457763671875),
|
|
|
|
|
osg::Vec3f(-115.7117919921875, 43.308563232421875, -16.1130199432373046875),
|
|
|
|
|
osg::Vec3f(-101.5277557373046875, 18.7812137603759765625, -18.6919345855712890625),
|
|
|
|
|
osg::Vec3f(-87.34372711181640625, -5.7461376190185546875, -20.4680538177490234375),
|
|
|
|
|
osg::Vec3f(-67.02922821044921875, -25.4970550537109375, -20.514247894287109375),
|
|
|
|
|
osg::Vec3f(-46.714717864990234375, -45.2479705810546875, -20.560443878173828125),
|
|
|
|
|
osg::Vec3f(-26.40021514892578125, -64.99889373779296875, -20.6066417694091796875),
|
|
|
|
|
osg::Vec3f(-6.085712432861328125, -84.74980926513671875, -20.652835845947265625),
|
|
|
|
|
osg::Vec3f(14.22879505157470703125, -104.50072479248046875, -18.151397705078125),
|
|
|
|
|
osg::Vec3f(39.05098724365234375, -118.16222381591796875, -15.66748714447021484375),
|
|
|
|
|
osg::Vec3f(63.87317657470703125, -131.82373046875, -13.18358135223388671875),
|
|
|
|
|
osg::Vec3f(88.69537353515625, -145.4852142333984375, -10.699672698974609375),
|
|
|
|
|
osg::Vec3f(113.51757049560546875, -159.146697998046875, -8.21576786041259765625),
|
|
|
|
|
osg::Vec3f(138.3397674560546875, -172.808197021484375, -5.731859683990478515625),
|
|
|
|
|
osg::Vec3f(163.1619720458984375, -186.469696044921875, -3.2479507923126220703125),
|
|
|
|
|
osg::Vec3f(187.984161376953125, -200.1311798095703125, -0.764044821262359619140625),
|
|
|
|
|
osg::Vec3f(212.8063507080078125, -213.7926788330078125, 1.719865322113037109375),
|
|
|
|
|
osg::Vec3f(215, -215, 1.9393787384033203125),
|
|
|
|
|
})) << mPath;
|
|
|
|
|
EXPECT_THAT(mPath, ElementsAre(
|
|
|
|
|
Vec3fEq(-215, 215, 1.9393787384033203125),
|
|
|
|
|
Vec3fEq(-200.8159637451171875, 190.47265625, -0.639537751674652099609375),
|
|
|
|
|
Vec3fEq(-186.6319427490234375, 165.9453125, -3.2184507846832275390625),
|
|
|
|
|
Vec3fEq(-172.447906494140625, 141.41796875, -5.797363758087158203125),
|
|
|
|
|
Vec3fEq(-158.263885498046875, 116.8906097412109375, -8.37627696990966796875),
|
|
|
|
|
Vec3fEq(-144.079864501953125, 92.3632659912109375, -10.9551906585693359375),
|
|
|
|
|
Vec3fEq(-129.89581298828125, 67.83591461181640625, -13.53410625457763671875),
|
|
|
|
|
Vec3fEq(-115.7117919921875, 43.308563232421875, -16.1130199432373046875),
|
|
|
|
|
Vec3fEq(-101.5277557373046875, 18.7812137603759765625, -18.6919345855712890625),
|
|
|
|
|
Vec3fEq(-87.34372711181640625, -5.7461376190185546875, -20.4680538177490234375),
|
|
|
|
|
Vec3fEq(-67.02922821044921875, -25.4970550537109375, -20.514247894287109375),
|
|
|
|
|
Vec3fEq(-46.714717864990234375, -45.2479705810546875, -20.560443878173828125),
|
|
|
|
|
Vec3fEq(-26.40021514892578125, -64.99889373779296875, -20.6066417694091796875),
|
|
|
|
|
Vec3fEq(-6.085712432861328125, -84.74980926513671875, -20.652835845947265625),
|
|
|
|
|
Vec3fEq(14.22879505157470703125, -104.50072479248046875, -18.151397705078125),
|
|
|
|
|
Vec3fEq(39.05098724365234375, -118.16222381591796875, -15.66748714447021484375),
|
|
|
|
|
Vec3fEq(63.87317657470703125, -131.82373046875, -13.18358135223388671875),
|
|
|
|
|
Vec3fEq(88.69537353515625, -145.4852142333984375, -10.699672698974609375),
|
|
|
|
|
Vec3fEq(113.51757049560546875, -159.146697998046875, -8.21576786041259765625),
|
|
|
|
|
Vec3fEq(138.3397674560546875, -172.808197021484375, -5.731859683990478515625),
|
|
|
|
|
Vec3fEq(163.1619720458984375, -186.469696044921875, -3.2479507923126220703125),
|
|
|
|
|
Vec3fEq(187.984161376953125, -200.1311798095703125, -0.764044821262359619140625),
|
|
|
|
|
Vec3fEq(212.8063507080078125, -213.7926788330078125, 1.719865322113037109375),
|
|
|
|
|
Vec3fEq(215, -215, 1.9393787384033203125)
|
|
|
|
|
));
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
TEST_F(DetourNavigatorNavigatorTest, path_should_be_over_water_ground_lower_than_water_with_only_swim_flag)
|
|
|
|
@ -590,26 +596,26 @@ namespace
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(mNavigator->findPath(mAgentHalfExtents, mStepSize, mStart, mEnd, Flag_walk, mOut), Status::Success);
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(mPath, std::deque<osg::Vec3f>({
|
|
|
|
|
osg::Vec3f(0, 215, -94.75363922119140625),
|
|
|
|
|
osg::Vec3f(9.8083515167236328125, 188.4185333251953125, -105.199951171875),
|
|
|
|
|
osg::Vec3f(19.6167049407958984375, 161.837066650390625, -114.25495147705078125),
|
|
|
|
|
osg::Vec3f(29.42505645751953125, 135.255615234375, -123.309967041015625),
|
|
|
|
|
osg::Vec3f(39.23340606689453125, 108.674163818359375, -132.3649749755859375),
|
|
|
|
|
osg::Vec3f(49.04175567626953125, 82.09270477294921875, -137.2874755859375),
|
|
|
|
|
osg::Vec3f(58.8501129150390625, 55.5112457275390625, -139.2451171875),
|
|
|
|
|
osg::Vec3f(68.6584625244140625, 28.9297885894775390625, -141.2027740478515625),
|
|
|
|
|
osg::Vec3f(78.4668121337890625, 2.3483295440673828125, -143.1604156494140625),
|
|
|
|
|
osg::Vec3f(88.27516937255859375, -24.233127593994140625, -141.3894805908203125),
|
|
|
|
|
osg::Vec3f(83.73651885986328125, -52.2005767822265625, -142.3761444091796875),
|
|
|
|
|
osg::Vec3f(79.19786834716796875, -80.16802978515625, -143.114837646484375),
|
|
|
|
|
osg::Vec3f(64.8477935791015625, -104.598602294921875, -137.840911865234375),
|
|
|
|
|
osg::Vec3f(50.497714996337890625, -129.0291748046875, -131.45831298828125),
|
|
|
|
|
osg::Vec3f(36.147632598876953125, -153.459747314453125, -121.42321014404296875),
|
|
|
|
|
osg::Vec3f(21.7975559234619140625, -177.8903350830078125, -111.38811492919921875),
|
|
|
|
|
osg::Vec3f(7.44747829437255859375, -202.3209075927734375, -101.19382476806640625),
|
|
|
|
|
osg::Vec3f(0, -215, -94.75363922119140625),
|
|
|
|
|
})) << mPath;
|
|
|
|
|
EXPECT_THAT(mPath, ElementsAre(
|
|
|
|
|
Vec3fEq(0, 215, -94.75363922119140625),
|
|
|
|
|
Vec3fEq(9.8083515167236328125, 188.4185333251953125, -105.199951171875),
|
|
|
|
|
Vec3fEq(19.6167049407958984375, 161.837066650390625, -114.25495147705078125),
|
|
|
|
|
Vec3fEq(29.42505645751953125, 135.255615234375, -123.309967041015625),
|
|
|
|
|
Vec3fEq(39.23340606689453125, 108.674163818359375, -132.3649749755859375),
|
|
|
|
|
Vec3fEq(49.04175567626953125, 82.09270477294921875, -137.2874755859375),
|
|
|
|
|
Vec3fEq(58.8501129150390625, 55.5112457275390625, -139.2451171875),
|
|
|
|
|
Vec3fEq(68.6584625244140625, 28.9297885894775390625, -141.2027740478515625),
|
|
|
|
|
Vec3fEq(78.4668121337890625, 2.3483295440673828125, -143.1604156494140625),
|
|
|
|
|
Vec3fEq(88.27516937255859375, -24.233127593994140625, -141.3894805908203125),
|
|
|
|
|
Vec3fEq(83.73651885986328125, -52.2005767822265625, -142.3761444091796875),
|
|
|
|
|
Vec3fEq(79.19786834716796875, -80.16802978515625, -143.114837646484375),
|
|
|
|
|
Vec3fEq(64.8477935791015625, -104.598602294921875, -137.840911865234375),
|
|
|
|
|
Vec3fEq(50.497714996337890625, -129.0291748046875, -131.45831298828125),
|
|
|
|
|
Vec3fEq(36.147632598876953125, -153.459747314453125, -121.42321014404296875),
|
|
|
|
|
Vec3fEq(21.7975559234619140625, -177.8903350830078125, -111.38811492919921875),
|
|
|
|
|
Vec3fEq(7.44747829437255859375, -202.3209075927734375, -101.19382476806640625),
|
|
|
|
|
Vec3fEq(0, -215, -94.75363922119140625)
|
|
|
|
|
));
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
TEST_F(DetourNavigatorNavigatorTest, update_remove_and_update_then_find_path_should_return_path)
|
|
|
|
@ -639,31 +645,31 @@ namespace
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(mNavigator->findPath(mAgentHalfExtents, mStepSize, mStart, mEnd, Flag_walk, mOut), Status::Success);
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(mPath, std::deque<osg::Vec3f>({
|
|
|
|
|
osg::Vec3f(-215, 215, 1.85963428020477294921875),
|
|
|
|
|
osg::Vec3f(-194.9653167724609375, 194.9653167724609375, -6.57602214813232421875),
|
|
|
|
|
osg::Vec3f(-174.930633544921875, 174.930633544921875, -15.01167774200439453125),
|
|
|
|
|
osg::Vec3f(-154.8959503173828125, 154.8959503173828125, -23.4473361968994140625),
|
|
|
|
|
osg::Vec3f(-134.86126708984375, 134.86126708984375, -31.8829936981201171875),
|
|
|
|
|
osg::Vec3f(-114.82657623291015625, 114.82657623291015625, -40.3186492919921875),
|
|
|
|
|
osg::Vec3f(-94.7918853759765625, 94.7918853759765625, -47.3990631103515625),
|
|
|
|
|
osg::Vec3f(-74.75719451904296875, 74.75719451904296875, -53.7258148193359375),
|
|
|
|
|
osg::Vec3f(-54.722499847412109375, 54.722499847412109375, -60.052555084228515625),
|
|
|
|
|
osg::Vec3f(-34.68780517578125, 34.68780517578125, -66.37931060791015625),
|
|
|
|
|
osg::Vec3f(-14.6531162261962890625, 14.6531162261962890625, -72.70604705810546875),
|
|
|
|
|
osg::Vec3f(5.3815765380859375, -5.3815765380859375, -75.35065460205078125),
|
|
|
|
|
osg::Vec3f(25.41626739501953125, -25.41626739501953125, -67.9694671630859375),
|
|
|
|
|
osg::Vec3f(45.450958251953125, -45.450958251953125, -60.5882568359375),
|
|
|
|
|
osg::Vec3f(65.48564910888671875, -65.48564910888671875, -53.20705413818359375),
|
|
|
|
|
osg::Vec3f(85.5203399658203125, -85.5203399658203125, -45.8258514404296875),
|
|
|
|
|
osg::Vec3f(105.55503082275390625, -105.55503082275390625, -38.44464874267578125),
|
|
|
|
|
osg::Vec3f(125.5897216796875, -125.5897216796875, -31.063449859619140625),
|
|
|
|
|
osg::Vec3f(145.6244049072265625, -145.6244049072265625, -23.6822509765625),
|
|
|
|
|
osg::Vec3f(165.659088134765625, -165.659088134765625, -16.3010501861572265625),
|
|
|
|
|
osg::Vec3f(185.6937713623046875, -185.6937713623046875, -8.91985416412353515625),
|
|
|
|
|
osg::Vec3f(205.7284698486328125, -205.7284698486328125, -1.5386505126953125),
|
|
|
|
|
osg::Vec3f(215, -215, 1.87718021869659423828125),
|
|
|
|
|
})) << mPath;
|
|
|
|
|
EXPECT_THAT(mPath, ElementsAre(
|
|
|
|
|
Vec3fEq(-215, 215, 1.85963428020477294921875),
|
|
|
|
|
Vec3fEq(-194.9653167724609375, 194.9653167724609375, -6.57602214813232421875),
|
|
|
|
|
Vec3fEq(-174.930633544921875, 174.930633544921875, -15.01167774200439453125),
|
|
|
|
|
Vec3fEq(-154.8959503173828125, 154.8959503173828125, -23.4473361968994140625),
|
|
|
|
|
Vec3fEq(-134.86126708984375, 134.86126708984375, -31.8829936981201171875),
|
|
|
|
|
Vec3fEq(-114.82657623291015625, 114.82657623291015625, -40.3186492919921875),
|
|
|
|
|
Vec3fEq(-94.7918853759765625, 94.7918853759765625, -47.3990631103515625),
|
|
|
|
|
Vec3fEq(-74.75719451904296875, 74.75719451904296875, -53.7258148193359375),
|
|
|
|
|
Vec3fEq(-54.722499847412109375, 54.722499847412109375, -60.052555084228515625),
|
|
|
|
|
Vec3fEq(-34.68780517578125, 34.68780517578125, -66.37931060791015625),
|
|
|
|
|
Vec3fEq(-14.6531162261962890625, 14.6531162261962890625, -72.70604705810546875),
|
|
|
|
|
Vec3fEq(5.3815765380859375, -5.3815765380859375, -75.35065460205078125),
|
|
|
|
|
Vec3fEq(25.41626739501953125, -25.41626739501953125, -67.9694671630859375),
|
|
|
|
|
Vec3fEq(45.450958251953125, -45.450958251953125, -60.5882568359375),
|
|
|
|
|
Vec3fEq(65.48564910888671875, -65.48564910888671875, -53.20705413818359375),
|
|
|
|
|
Vec3fEq(85.5203399658203125, -85.5203399658203125, -45.8258514404296875),
|
|
|
|
|
Vec3fEq(105.55503082275390625, -105.55503082275390625, -38.44464874267578125),
|
|
|
|
|
Vec3fEq(125.5897216796875, -125.5897216796875, -31.063449859619140625),
|
|
|
|
|
Vec3fEq(145.6244049072265625, -145.6244049072265625, -23.6822509765625),
|
|
|
|
|
Vec3fEq(165.659088134765625, -165.659088134765625, -16.3010501861572265625),
|
|
|
|
|
Vec3fEq(185.6937713623046875, -185.6937713623046875, -8.91985416412353515625),
|
|
|
|
|
Vec3fEq(205.7284698486328125, -205.7284698486328125, -1.5386505126953125),
|
|
|
|
|
Vec3fEq(215, -215, 1.87718021869659423828125)
|
|
|
|
|
));
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
TEST_F(DetourNavigatorNavigatorTest, update_then_find_random_point_around_circle_should_return_position)
|
|
|
|
@ -687,10 +693,10 @@ namespace
|
|
|
|
|
|
|
|
|
|
const auto result = mNavigator->findRandomPointAroundCircle(mAgentHalfExtents, mStart, 100.0, Flag_walk);
|
|
|
|
|
|
|
|
|
|
ASSERT_EQ(result, boost::optional<osg::Vec3f>(osg::Vec3f(-209.95985412597656, 129.89768981933594, -0.26253718137741089)));
|
|
|
|
|
ASSERT_THAT(result, Optional(Vec3fEq(-209.95985412597656, 129.89768981933594, -0.26253718137741089)));
|
|
|
|
|
|
|
|
|
|
const auto distance = (*result - mStart).length();
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(distance, 85.260780334472656) << distance;
|
|
|
|
|
EXPECT_FLOAT_EQ(distance, 85.260780334472656);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|