Angle speed planning