Added ramping between setpoints so there are no more quick jumps to the forces