Skip to content
Snippets Groups Projects
Commit eb9c9a14 authored by Fabian Reister's avatar Fabian Reister
Browse files

avoiding unnecessary copy

parent 1741ed76
No related branches found
No related tags found
2 merge requests!170ArMem Viewer: Resolve Memory IDs,!169bugfix: platform position controller is turning into wrong direction
...@@ -22,7 +22,9 @@ ...@@ -22,7 +22,9 @@
* GNU General Public License * GNU General Public License
*/ */
#include "NJointHolonomicPlatformGlobalPositionController.h" #include "NJointHolonomicPlatformGlobalPositionController.h"
#include <cmath> #include <cmath>
#include <SimoxUtility/math/periodic/periodic_clamp.h> #include <SimoxUtility/math/periodic/periodic_clamp.h>
namespace armarx namespace armarx
...@@ -87,7 +89,7 @@ namespace armarx ...@@ -87,7 +89,7 @@ namespace armarx
const Eigen::Rotation2Df global_R_local(-measuredOrientation); const Eigen::Rotation2Df global_R_local(-measuredOrientation);
Eigen::Vector2f velocities = global_R_local * Eigen::Vector2f(pid.getControlValue()[0], pid.getControlValue()[1]); Eigen::Vector2f velocities = global_R_local * pid.getControlValue();
target->velocityX = velocities.x(); target->velocityX = velocities.x();
target->velocityY = velocities.y(); target->velocityY = velocities.y();
target->velocityRotation = static_cast<float>(opid.getControlValue()); target->velocityRotation = static_cast<float>(opid.getControlValue());
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment