diff --git a/src/lite6_controller/src/lite6_controller.cpp b/src/lite6_controller/src/lite6_controller.cpp index f8cfbc7..96f4614 100644 --- a/src/lite6_controller/src/lite6_controller.cpp +++ b/src/lite6_controller/src/lite6_controller.cpp @@ -184,8 +184,13 @@ public: { 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; } /**