Update pos2pos.m