Set max value for translate

2023-03-09 12:43:37 +02:00
parent 77ecb063d5
commit e1ba43e324
1 changed files with 7 additions and 2 deletions
--- a/src/axidraw_controller/src/cpp/axidraw_controller.cpp
+++ b/src/axidraw_controller/src/cpp/axidraw_controller.cpp
@@ -78,8 +78,13 @@ class AxidrawController : public RobotController
  {
    float lspan = lmax - lmin;
    float rspan = rmax - rmin;
-    val = (val - lmin) / lspan;
-    return rmin + (val * rspan);
+    float out = (val - lmin) / lspan;
+    out = rmin + (val * rspan);
+
+    // Ensure that output is within bounds
+    out = std::max(rmin, out);
+    out = std::min(rmax, out);
+    return out;
  }

  /**