Add new branch and add the new velocity planning for high radio frequency.

Add new branch and add the new velocity planning for high radio frequency. #459