Fix for Dubins RRTstar issue

Fix for the following bitbucket issue:

https://bitbucket.org/ompl/ompl/issue/78/segmentation-fault-in-rrt

I also added testing for RRTstar applied to Dubins. Honestly, the additional testing code just isn't very pretty, but doing it better would probably take significantly more time and refactoring.