Mades tweaks to the cycle frequencies to make trajectory execution
better. The robot still overshoots the goal and will spin
past the target orientation to reach the goal sometimes.