fixed a problem with the return map interpolation