Debian Codegraph @

unittests/integration/test_VskParser.cpp

raw
1 /*
2 * Copyright (c) 2011-2022, The DART development contributors
3 * All rights reserved.
4 *
5 * The list of contributors can be found at:
6 * https://github.com/dartsim/dart/blob/master/LICENSE
7 *
8 * This file is provided under the following "BSD-style" License:
9 * Redistribution and use in source and binary forms, with or
10 * without modification, are permitted provided that the following
11 * conditions are met:
12 * * Redistributions of source code must retain the above copyright
13 * notice, this list of conditions and the following disclaimer.
14 * * Redistributions in binary form must reproduce the above
15 * copyright notice, this list of conditions and the following
16 * disclaimer in the documentation and/or other materials provided
17 * with the distribution.
18 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND
19 * CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES,
20 * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
21 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
22 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
23 * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
24 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
25 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
26 * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
27 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
29 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
30 * POSSIBILITY OF SUCH DAMAGE.
31 */
32
33 #include <iostream>
34
35 #include <gtest/gtest.h>
36
37 #include "dart/config.hpp"
38 #include "dart/dynamics/PlanarJoint.hpp"
39 #include "dart/dynamics/RevoluteJoint.hpp"
40 #include "dart/dynamics/Skeleton.hpp"
41 #include "dart/dynamics/SoftBodyNode.hpp"
42 #include "dart/simulation/World.hpp"
43 #include "dart/utils/VskParser.hpp"
44
45 #include "TestHelpers.hpp"
46
47 using namespace dart;
48 using namespace math;
49 using namespace dynamics;
50 using namespace simulation;
51 using namespace utils;
52
53 //==============================================================================
54 TEST(VskParser, EmptySkeleton)
55 {
56 WorldPtr world = World::create();
57 EXPECT_TRUE(world != nullptr);
58
59 SkeletonPtr skeleton
60 = VskParser::readSkeleton("dart://sample/vsk/test/empty.vsk");
61 EXPECT_TRUE(skeleton == nullptr);
62
63 world->addSkeleton(skeleton);
64 EXPECT_EQ(world->getNumSkeletons(), 0u);
65
66 world->step();
67 }
68
69 //==============================================================================
70 TEST(VskParser, LoadFromFileURI)
71 {
72 const std::string prefix = "file://" DART_DATA_LOCAL_PATH "vsk/";
73
74 EXPECT_EQ(VskParser::readSkeleton(prefix + "test/empty.vsk"), nullptr);
75 EXPECT_NE(VskParser::readSkeleton(prefix + "Nick01.vsk"), nullptr);
76 EXPECT_NE(VskParser::readSkeleton(prefix + "Yuting.vsk"), nullptr);
77 }
78
79 //==============================================================================
80 TEST(VskParser, SingleStepSimulations)
81 {
82 WorldPtr world = World::create();
83 EXPECT_NE(world, nullptr);
84
85 SkeletonPtr nick = VskParser::readSkeleton("dart://sample/vsk/Nick01.vsk");
86 EXPECT_NE(nick, nullptr);
87 EXPECT_EQ(nick->getNumMarkers(), 53u);
88
89 SkeletonPtr sehoon
90 = VskParser::readSkeleton("dart://sample/vsk/SehoonVSK3.vsk");
91 EXPECT_NE(sehoon, nullptr);
92 EXPECT_EQ(nick->getNumMarkers(), 53u);
93
94 SkeletonPtr yuting = VskParser::readSkeleton("dart://sample/vsk/Yuting.vsk");
95 EXPECT_NE(yuting, nullptr);
96 EXPECT_EQ(nick->getNumMarkers(), 53u);
97
98 world->removeAllSkeletons();
99 world->addSkeleton(nick);
100 EXPECT_EQ(world->getNumSkeletons(), 1u);
101 world->step();
102
103 world->removeAllSkeletons();
104 world->addSkeleton(sehoon);
105 EXPECT_EQ(world->getNumSkeletons(), 1u);
106 world->step();
107
108 world->removeAllSkeletons();
109 world->addSkeleton(yuting);
110 EXPECT_EQ(world->getNumSkeletons(), 1u);
111 world->step();
112 }