RG_RRT fully implemented, homework 3 completed