Added more future functionality goals

-Added localization and orientation goals