added mandatory ikfast test
add mandatory ikfast tests
added new linearsmoother, made parabolicsmoother faster, many other fixes for smoothing trajectories