updated experiments for complexity scaling, cleaned up box slightly
updated planning example to enforce max step in y axis
running rrt and added geometry and graph datastructures
Refactored geometry