SBPL test using only eight angles instead of sixteen
Fixed angles of 1/16 motion primitives
Test fix for spline curvature computation
Fixed typo in ComputeTNB and added rviz marker for circle of curvature

Changed the motion primitives to use only increments of 45 degrees for
testing since they line up with the search lattice perfectly