Advanced path interpolation in high performance motion control systems