135 lines
2.9 KiB
C++
135 lines
2.9 KiB
C++
/*
|
|
* Copyright (C) 2012 Open Source Robotics Foundation
|
|
*
|
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
|
* you may not use this file except in compliance with the License.
|
|
* You may obtain a copy of the License at
|
|
*
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
* See the License for the specific language governing permissions and
|
|
* limitations under the License.
|
|
*
|
|
*/
|
|
|
|
#include <gtest/gtest.h>
|
|
|
|
#include "gazebo/math/Helpers.hh"
|
|
#include "gazebo/math/Vector2d.hh"
|
|
|
|
using namespace gazebo;
|
|
|
|
class Vector2dTest : public ::testing::Test { };
|
|
|
|
TEST_F(Vector2dTest, Vector2d)
|
|
{
|
|
{
|
|
math::Vector2d v;
|
|
EXPECT_DOUBLE_EQ(0, v.x);
|
|
EXPECT_DOUBLE_EQ(0, v.y);
|
|
}
|
|
|
|
// Constructor
|
|
math::Vector2d v(1, 2);
|
|
EXPECT_DOUBLE_EQ(1, v.x);
|
|
EXPECT_DOUBLE_EQ(2, v.y);
|
|
|
|
// ::Distance
|
|
EXPECT_TRUE(math::equal(2.236, v.Distance(math::Vector2d(0, 0)), 1e-2));
|
|
|
|
// ::Normalize
|
|
v.Normalize();
|
|
EXPECT_TRUE(v == math::Vector2d(0.447214, 0.894427));
|
|
|
|
// ::Set
|
|
v.Set(4, 5);
|
|
EXPECT_TRUE(v == math::Vector2d(4, 5));
|
|
|
|
// ::operator=
|
|
v = math::Vector2d(6, 7);
|
|
EXPECT_TRUE(v == math::Vector2d(6, 7));
|
|
|
|
// ::operator= int
|
|
v = 5;
|
|
EXPECT_TRUE(v == math::Vector2d(5, 5));
|
|
|
|
// ::operator+
|
|
v = v + math::Vector2d(1, 2);
|
|
EXPECT_TRUE(v == math::Vector2d(6, 7));
|
|
|
|
// ::operator +=
|
|
v += math::Vector2d(5, 6);
|
|
EXPECT_TRUE(v == math::Vector2d(11, 13));
|
|
|
|
// ::operator -
|
|
v = v - math::Vector2d(2, 4);
|
|
EXPECT_TRUE(v == math::Vector2d(9, 9));
|
|
|
|
// ::operator -=
|
|
v.Set(2, 4);
|
|
v -= math::Vector2d(1, 6);
|
|
EXPECT_TRUE(v == math::Vector2d(1, -2));
|
|
|
|
// ::operator /
|
|
v.Set(10, 6);
|
|
v = v / math::Vector2d(2, 3);
|
|
EXPECT_TRUE(v == math::Vector2d(5, 2));
|
|
|
|
// ::operator /=
|
|
v.Set(10, 6);
|
|
v /= math::Vector2d(2, 3);
|
|
EXPECT_TRUE(v == math::Vector2d(5, 2));
|
|
|
|
// ::operator / int
|
|
v.Set(10, 6);
|
|
v = v / 2;
|
|
EXPECT_TRUE(v == math::Vector2d(5, 3));
|
|
|
|
// ::operator /= int
|
|
v.Set(10, 6);
|
|
v /= 2;
|
|
EXPECT_TRUE(v == math::Vector2d(5, 3));
|
|
|
|
// ::operator * int
|
|
v.Set(10, 6);
|
|
v = v * 2;
|
|
EXPECT_TRUE(v == math::Vector2d(20, 12));
|
|
|
|
// ::operator *= int
|
|
v.Set(10, 6);
|
|
v *= 2;
|
|
EXPECT_TRUE(v == math::Vector2d(20, 12));
|
|
|
|
// ::operator * vector2i
|
|
v.Set(10, 6);
|
|
v = v * math::Vector2d(2, 4);
|
|
EXPECT_TRUE(v == math::Vector2d(20, 24));
|
|
|
|
// ::operator *= vector2i
|
|
v.Set(10, 6);
|
|
v *= math::Vector2d(2, 4);
|
|
EXPECT_TRUE(v == math::Vector2d(20, 24));
|
|
|
|
|
|
// ::IsFinite
|
|
EXPECT_TRUE(v.IsFinite());
|
|
|
|
// ::operator[]
|
|
v.Set(6, 7);
|
|
EXPECT_DOUBLE_EQ(6, v[0]);
|
|
EXPECT_DOUBLE_EQ(7, v[1]);
|
|
}
|
|
|
|
/////////////////////////////////////////////////
|
|
TEST_F(Vector2dTest, Dot)
|
|
{
|
|
math::Vector2d v1(1, 2);
|
|
math::Vector2d v2(3, 4);
|
|
|
|
EXPECT_DOUBLE_EQ(v1.Dot(v2), (v1.x*v2.x) + (v1.y*v2.y));
|
|
EXPECT_DOUBLE_EQ(v1.Dot(v2), 11.0);
|
|
}
|