Complete Smoother

[SteveMacenski]

Items from sheet:

• [x] todo's in code
• [x] tan-1() to get angles for waypoints orientation of smoothed path after upsampling, not orientation-less
• [x] Use 1/min turning radius not separate smoother max_curvature value
• [x] Add unit testing
• [ ] tune defaults