added important regular RRT functions rrt_choose_target, rrt_nearest, rrt_extend, backtrace and limit check. Also added constants to the top of the file. Currently, todo still needs to be written.