diff --git a/rm_shooter_controllers/src/standard.cpp b/rm_shooter_controllers/src/standard.cpp
index 046e4d61..1a88d8c0 100644
--- a/rm_shooter_controllers/src/standard.cpp
+++ b/rm_shooter_controllers/src/standard.cpp
@@ -275,7 +275,7 @@ void Controller::normalize()
 {
   double push_angle = 2. * M_PI / static_cast<double>(push_per_rotation_);
   if (cmd_.hz >= freq_threshold_)
-    ctrl_trigger_.setCommand(push_angle * std::floor((ctrl_trigger_.joint_.getPosition() + 0.01) / push_angle));
+    ctrl_trigger_.setCommand(push_angle * std::floor(ctrl_trigger_.joint_.getPosition() / push_angle));
   else
     ctrl_trigger_.setCommand(
         push_angle * std::floor((ctrl_trigger_.joint_.getPosition() + 0.01 + config_.exit_push_threshold) / push_angle));