Fix inline error
Get BaseLocalTests to Compile
Merge in Dave's fixes
Merge pull request #55 from DLu/testing

Base Local Planner fixes