NetAccelerationLimit.h

 
#pragma once
 
#include <cmath>
 
inline void LimitAccelerationMagnitude(double acceleration[3], double maxAcceleration)
{
   const double magnitude = std::sqrt(acceleration[0] * acceleration[0] + acceleration[1] * acceleration[1] + acceleration[2] * acceleration[2]);
   if (magnitude > maxAcceleration) {
      const double scale = maxAcceleration / magnitude;
      for (int index = 0; index < 3; index++) {
         acceleration[index] *= scale;
      }
   }
}