Gaussian Process library used GPML Toolbox
Uses Graph framework from Dr.Peter Corke's Robotics Toolbox
Explanation of algorithm in Description.pdf.
rrtStar2.m runs the main algorithm without obstacles. You can add obstacles before running this.
Switched mode is implemented in switchedRRTstar.m.