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 | /**
* @file SituationPriorProvider.h
*
* @author <a href="mailto:schlottb@informatik.hu-berlin.de">Stella Alice Schlotter</a>
* Declaration of class SituationPriorProvider
*/
#ifndef _SituationPriorProvider_H
#define _SituationPriorProvider_H
#include <ModuleFramework/Module.h>
#include "Tools/Math/Geometry.h"
#include "Tools/Math/Probabilistics.h"
// basic info
#include "Representations/Infrastructure/FieldInfo.h"
#include "Representations/Infrastructure/FrameInfo.h"
#include "Representations/Infrastructure/GameData.h"
#include "Representations/Modeling/PlayerInfo.h"
// situation
#include "Representations/Motion/MotionStatus.h"
#include "Representations/Modeling/BodyState.h"
#include "Representations/Modeling/SituationPrior.h"
// debug
#include "Tools/Debug/DebugPlot.h"
#include "Tools/Debug/DebugRequest.h"
#include "Tools/Debug/DebugModify.h"
#include "Tools/Debug/DebugDrawings.h"
BEGIN_DECLARE_MODULE(SituationPriorProvider)
PROVIDE(DebugRequest)
PROVIDE(DebugPlot)
PROVIDE(DebugModify)
PROVIDE(DebugDrawings)
REQUIRE(FieldInfo)
REQUIRE(FrameInfo)
REQUIRE(PlayerInfo)
REQUIRE(GameData)
REQUIRE(MotionStatus)
REQUIRE(BodyState)
PROVIDE(SituationPrior)
END_DECLARE_MODULE(SituationPriorProvider)
class SituationPriorProvider: public SituationPriorProviderBase
{
public:
SituationPriorProvider();
~SituationPriorProvider();
virtual void execute();
private:
class LineDensity {
private:
Math::LineSegment segment;
double angle;
//double distDeviation;
//double angleDeviation;
public:
LineDensity()<--- Member variable 'LineDensity::angle' is not initialized in the constructor.
{
}
LineDensity(
const Vector2d& start, const Vector2d& end,
double angle)
:
segment(start, end),
angle(angle)/*,
distDeviation(distDeviation),
angleDeviation(angleDeviation)*/
{
}
/*double update(const Sample& sample) const {
double distDiff = segment.minDistance(sample.translation);
double angleDiff = Math::normalize(angle - sample.rotation);
return Math::gaussianProbability(distDiff, distDeviation) *
Math::gaussianProbability(angleDiff, angleDeviation);
}*/
void draw(DrawingCanvas2D& canvas)
{
canvas.pen("000000", 10);
canvas.drawLine(segment.begin().x, segment.begin().y, segment.end().x, segment.end().y);
canvas.drawArrow(
segment.begin().x, segment.begin().y,
segment.begin().x + 100*cos(angle),
segment.begin().y + 100*sin(angle));
canvas.drawArrow(
segment.end().x, segment.end().y,
segment.end().x + 100*cos(angle),
segment.end().y + 100*sin(angle));
}
};
PlayerInfo::RobotState lastRobotState;
PlayerInfo::RobotState currentRobotState;
GameData::GameState gameStateWhenPenalized;
GameData::Penalty reasonForLastPenalized;
bool walked_after_penalized_or_init;
bool wasLiftedUp;
};
#endif /* _SituationPriorProvider_H */
|