RRT algorithm
precise QP equation
misspelling fixes