Shortcut can now take multiple goals
Update controller for RRT shortcut
Fixed _DipolarRRT multi goal bugs
New specs and ThetaStar smoothing
DipolarRRTController _DipolarRRT

Added inputs for handlers plotting

Fixed bugs with ThetaStar