Fixed infinite loop issue in RRTstar for Dubins. Added appropriate testing for RRTstar applied to Dubins.