forked from atolab/dds-ishapes
-
Notifications
You must be signed in to change notification settings - Fork 0
/
BouncingShapeDynamics.cpp
94 lines (83 loc) · 2.26 KB
/
BouncingShapeDynamics.cpp
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
/**
* @file
*/
#include "BouncingShapeDynamics.hpp"
#include <math.h>
#include <stdlib.h>
#include <iostream>
static const float PI = 3.1415926535F;
#ifdef TESTBUILD
#include <QtCore/QDebug>
#include "os_time.h"
#endif
#ifdef WIN32
#define roundf(a) ((a)>0?floor((a)+0.5):ceil((a)-0.5))
#endif
namespace demo { namespace ishapes {
BouncingShapeDynamics::BouncingShapeDynamics(int x0, int y0,
const QRect& shapeBounds,
const QRect& constraint,
float angle,
float speed,
const ShapeType& shape,
dds::pub::DataWriter<ShapeType> shapeWriter)
: ShapeDynamics(x0, y0, constraint),
shapeBounds_(shapeBounds),
alpha_(angle),
angle_(angle),
speed_(speed),
shape_(shape),
shapeWriter_(shapeWriter)
{ }
BouncingShapeDynamics::~BouncingShapeDynamics()
{ }
bool
BouncingShapeDynamics::flip()
{
bool doflip = false;
if (rand() <= RAND_MAX/2)
doflip = true;
return doflip;
}
void
BouncingShapeDynamics::simulate()
{
pos_.rx() = roundf(pos_.rx() + speed_*cosf(angle_));
pos_.ry() = roundf(pos_.ry() + speed_*sinf(angle_));
if (pos_.x() <= 0)
{
angle_ = this->flip() ? -alpha_ : alpha_;
pos_.rx() = 0;
}
else if (pos_.x() >= (constraint_.width() - (shapeBounds_.width())))
{
angle_ = this->flip() ? (PI + alpha_) : (PI - alpha_);
pos_.rx() = constraint_.width() - shapeBounds_.width();
}
else if (pos_.y() <= 0)
{
angle_ = this->flip() ? alpha_ : PI - alpha_;
pos_.ry() = 0;
}
else if (pos_.y() >= (constraint_.height() - shapeBounds_.height()))
{
angle_ = this->flip() ? (PI+alpha_) : -alpha_;
pos_.ry() = constraint_.height() - shapeBounds_.height();
}
shape_.x() = pos_.x();
shape_.y() = pos_.y();
shapeWriter_.write(shape_);
plist_.erase(plist_.begin(), plist_.end());
plist_.push_back(pos_);
#ifdef TESTBUILD
qDebug() << "Time:"
<< os_timeGet().tv_sec
<< os_timeGet().tv_nsec
<< "Colour:"
<< shape_.color().c_str()
<< "Size:" << shape_.shapesize()
<< "x:" << shape_.x()
<< "y:" << shape_.y();
#endif
}
}}