Done: able to run RRT for 3 link arm. The problem before is: dividing 2 doesn't equivalent dividing 2.0
Clean Up
Update Log
Done: Plot rectangular arms in octave
3 link arm test
able to rotate rectangular respect to center point