Improove paths.

Calculate more accurate? coordinates of points.
Simplify cartesian path using similar number of points as in other
paths.
Use predefined, non-step-dependant simplify distance.