diff --git a/source/RobotAPI/components/units/ObstacleAwarePlatformUnit/ObstacleAwarePlatformUnit.cpp b/source/RobotAPI/components/units/ObstacleAwarePlatformUnit/ObstacleAwarePlatformUnit.cpp index c3f5760e943670e87918e0d0554cc591bb34c302..b15b4c7bf08e1d192616b7e62c1fa38f8678faac 100644 --- a/source/RobotAPI/components/units/ObstacleAwarePlatformUnit/ObstacleAwarePlatformUnit.cpp +++ b/source/RobotAPI/components/units/ObstacleAwarePlatformUnit/ObstacleAwarePlatformUnit.cpp @@ -607,7 +607,7 @@ armarx::ObstacleAwarePlatformUnit::visualize(const velocities& vels) l_prog.add(Cylinder{"boundingCylinder"} .position(agent_pos) .color(Color::cyan(255, 64)) - .pose(simox::math::pos_rpy_to_mat4f(agent_pos, -M_PI_2, 0, 0)) + .pose(simox::math::pos_rpy_to_mat4f(agent_pos, -M_PI_2, 0, 0) * Eigen::Isometry3f(Eigen::Translation3f(0, 0, 1000)).matrix()) .radius(m_viz.boundingCircle.radius) .height(2000)); }