summaryrefslogtreecommitdiffhomepage
diff options
context:
space:
mode:
-rw-r--r--tracker-udp/ftnoir_tracker_udp.cpp7
1 files changed, 5 insertions, 2 deletions
diff --git a/tracker-udp/ftnoir_tracker_udp.cpp b/tracker-udp/ftnoir_tracker_udp.cpp
index e2d6fc93..b3df5e60 100644
--- a/tracker-udp/ftnoir_tracker_udp.cpp
+++ b/tracker-udp/ftnoir_tracker_udp.cpp
@@ -11,6 +11,8 @@
#include "compat/nan.hpp"
#include "compat/util.hpp"
+#include <iterator>
+
udp::udp() :
last_recv_pose { 0,0,0, 0,0,0 },
last_recv_pose2 { 0,0,0, 0,0,0 }
@@ -94,8 +96,9 @@ void udp::data(double *data)
for (int i = 0; i < 3; i++)
{
- const unsigned k = clamp(unsigned(indices[i]), 0u, sizeof(values)/sizeof(*values) - 1u);
- data[Yaw + i] += values[k];
+ const int k = indices[i];
+ if (k >= 0 && k < std::distance(std::begin(values), std::end(values)))
+ data[Yaw + i] += values[k];
}
}