From 9851dccc54071b9837f08009cd0980ce61e9bc30 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Joan=20Sol=C3=A0?= <jsola@iri.upc.edu>
Date: Sat, 3 Aug 2019 23:55:25 +0200
Subject: [PATCH] Use pi2pi in StateAngle constructor
---
include/core/state_block/state_angle.h | 2 +-
1 file changed, 1 insertion(+), 1 deletion(-)
diff --git a/include/core/state_block/state_angle.h b/include/core/state_block/state_angle.h
index 635fd6be7..2f1a03f0b 100644
--- a/include/core/state_block/state_angle.h
+++ b/include/core/state_block/state_angle.h
@@ -25,7 +25,7 @@ class StateAngle : public StateBlock
inline StateAngle::StateAngle(Scalar _angle, bool _fixed) :
StateBlock(1, _fixed, std::make_shared<LocalParametrizationAngle>())
{
- state_(0) = _angle;
+ state_(0) = pi2pi(_angle);
}
inline StateAngle::~StateAngle()
--
GitLab