Modify finite differences interval for angles and angular velocities