Add path profile to plan and move instruction and modify simple plan profile interface#159

Merged

Levi-Armstrong merged 4 commits intotesseract-robotics:masterfrom Levi-Armstrong:feature/PathProfile

Jan 12, 2022

+965-140