Z movement added, E to be integrated in interpolation