8th Feb, 2014

1. Moved all interfaces to use ompl::control
2. Initiated updating test code