first implementation with trajopt. WIP
use pose as trajopt target
WIP Trajopt
refactoring
implement two-part approach
refactor trajectory generation
add caching
delete old code
undo cache
implement dropping
bugfixing
ankush's library
ros fixes