diff --git a/ros2rag.starter/src/main/jastadd/Definitions.ros2rag b/ros2rag.starter/src/main/jastadd/Definitions.ros2rag index 87062199e2dcceb03b9dbb3317c88022cb0f4c1a..0498332aca45281fac34347dfa1800f85e26efb4 100644 --- a/ros2rag.starter/src/main/jastadd/Definitions.ros2rag +++ b/ros2rag.starter/src/main/jastadd/Definitions.ros2rag @@ -19,7 +19,7 @@ SerializeRobotConfig maps config.Robotconfig.RobotConfig rc to byte[] {: LinkStateToIntPosition maps panda.Linkstate.PandaLinkState pls to IntPosition {: panda.Linkstate.PandaLinkState.Position p = pls.getPos(); - return IntPosition.of((int) (p.getPositionX() * 10), (int) (p.getPositionY() * 10), (int) (p.getPositionZ() * 10)); + return IntPosition.of((int) (Math.round(p.getPositionX() * 2)), (int) (Math.round(p.getPositionY() * 2)), (int) (Math.round(p.getPositionZ() * 2 + 0.5))); :} CreateSpeedMessage maps double speed to config.Robotconfig.RobotConfig {: diff --git a/ros2rag.starter/src/main/java/de/tudresden/inf/st/ros2rag/starter/StarterMain.java b/ros2rag.starter/src/main/java/de/tudresden/inf/st/ros2rag/starter/StarterMain.java index d43ce49d9dd0f3d9354fe3f9bd78af0ff518e6cf..8c8919d739552e30cad512e8e5cd9bfb1ff832f0 100644 --- a/ros2rag.starter/src/main/java/de/tudresden/inf/st/ros2rag/starter/StarterMain.java +++ b/ros2rag.starter/src/main/java/de/tudresden/inf/st/ros2rag/starter/StarterMain.java @@ -102,7 +102,7 @@ public class StarterMain { .setEnableOrientation(false) .setEnableTwistAngular(false) .setEnableTwistLinear(false) - .setPublishRate(1000) + .setPublishRate(100) .build(); mainHandler.publish(dataConfigTopic, dataConfig.toByteArray()); }