Merge jointopt-lfd util into here
Move planning.py from jointopt-lfd
Remove tps testing scripts from planning.py
Add custom ArgumentParser for doing hierarchical parsing
Finalize implementation of save/load args separately