Repository navigation
Expand file tree
/
Copy pathTestFeedforward2Dof.cpp
More file actions
129 lines (98 loc) · 3.8 KB
/
Copy pathTestFeedforward2Dof.cpp
File metadata and controls
129 lines (98 loc) · 3.8 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
#include "numerical/controllers/implementations/Feedforward2Dof.hpp"
#include "numerical/math/Tolerance.hpp"
#include "gmock/gmock.h"
#include "gtest/gtest.h"
namespace
{
class MockFeedforward
: public controllers::Feedforward<float>
{
public:
MOCK_METHOD(float, Evaluate, (float), (override));
MOCK_METHOD(void, Reset, (), (override));
};
class MockFeedbackLaw
: public controllers::FeedbackLaw<float>
{
public:
MOCK_METHOD(float, Process, (float), (override));
MOCK_METHOD(void, Reset, (), (override));
};
class TestFeedforward2Dof
: public ::testing::Test
{
public:
testing::StrictMock<MockFeedforward> ff;
testing::StrictMock<MockFeedbackLaw> fb;
controllers::Saturation<float> clamp{ -1.0f, 1.0f };
controllers::Feedforward2Dof<float> controller{ ff, fb, clamp };
};
}
TEST_F(TestFeedforward2Dof, sums_feedforward_and_feedback)
{
EXPECT_CALL(ff, Evaluate(0.5f)).WillOnce(testing::Return(0.3f));
EXPECT_CALL(fb, Process(0.4f)).WillOnce(testing::Return(0.2f));
float result{ controller.Compute(0.5f, 0.1f) };
EXPECT_NEAR(result, 0.5f, math::Tolerance<float>());
}
TEST_F(TestFeedforward2Dof, passes_correct_error_to_feedback)
{
EXPECT_CALL(ff, Evaluate(0.4f)).WillOnce(testing::Return(0.0f));
EXPECT_CALL(fb, Process(0.3f)).WillOnce(testing::Return(0.3f));
float result{ controller.Compute(0.4f, 0.1f) };
EXPECT_NEAR(result, 0.3f, math::Tolerance<float>());
}
TEST_F(TestFeedforward2Dof, passes_reference_to_feedforward)
{
EXPECT_CALL(ff, Evaluate(0.6f)).WillOnce(testing::Return(0.0f));
EXPECT_CALL(fb, Process(testing::_)).WillOnce(testing::Return(0.0f));
controller.Compute(0.6f, 0.0f);
}
TEST_F(TestFeedforward2Dof, zero_feedforward_reduces_to_feedback)
{
EXPECT_CALL(ff, Evaluate(testing::_)).WillOnce(testing::Return(0.0f));
EXPECT_CALL(fb, Process(testing::_)).WillOnce(testing::Return(0.4f));
float result{ controller.Compute(0.5f, 0.1f) };
EXPECT_NEAR(result, 0.4f, math::Tolerance<float>());
}
TEST_F(TestFeedforward2Dof, output_is_clamped)
{
EXPECT_CALL(ff, Evaluate(testing::_)).WillOnce(testing::Return(0.9f));
EXPECT_CALL(fb, Process(testing::_)).WillOnce(testing::Return(0.9f));
float result{ controller.Compute(1.0f, 0.0f) };
EXPECT_NEAR(result, 1.0f, math::Tolerance<float>());
}
TEST_F(TestFeedforward2Dof, perfect_feedforward_zero_error)
{
EXPECT_CALL(ff, Evaluate(0.7f)).WillOnce(testing::Return(0.7f));
EXPECT_CALL(fb, Process(0.0f)).WillOnce(testing::Return(0.0f));
float result{ controller.Compute(0.7f, 0.7f) };
EXPECT_NEAR(result, 0.7f, math::Tolerance<float>());
}
TEST_F(TestFeedforward2Dof, output_is_clamped_negative)
{
EXPECT_CALL(ff, Evaluate(testing::_)).WillOnce(testing::Return(-0.9f));
EXPECT_CALL(fb, Process(testing::_)).WillOnce(testing::Return(-0.9f));
float result{ controller.Compute(-1.0f, 0.0f) };
EXPECT_NEAR(result, -1.0f, math::Tolerance<float>());
}
TEST_F(TestFeedforward2Dof, zero_feedback_reduces_to_feedforward)
{
EXPECT_CALL(ff, Evaluate(0.5f)).WillOnce(testing::Return(0.4f));
EXPECT_CALL(fb, Process(testing::_)).WillOnce(testing::Return(0.0f));
float result{ controller.Compute(0.5f, 0.1f) };
EXPECT_NEAR(result, 0.4f, math::Tolerance<float>());
}
TEST_F(TestFeedforward2Dof, reset_delegates_to_feedforward_and_feedback)
{
EXPECT_CALL(ff, Reset()).Times(1);
EXPECT_CALL(fb, Reset()).Times(1);
controller.Reset();
}
TEST_F(TestFeedforward2Dof, negative_reference_handled)
{
EXPECT_CALL(ff, Evaluate(-0.3f)).WillOnce(testing::Return(-0.2f));
EXPECT_CALL(fb, Process(-0.3f)).WillOnce(testing::Return(-0.1f));
float result{ controller.Compute(-0.3f, 0.0f) };
EXPECT_NEAR(result, -0.3f, math::Tolerance<float>());
}