From ForwardLimitCompensation(), could probably run backwardLimitCompensation() just once #72
Description
We run it at many waypoints:
successful_velocity_comp = backwardLimitCompensation(index, -(delta_v + position_error / configuration_.timestep));
Could probably run it just once, after looping over all the waypoints