Design and test o a pose estiamtion algorithm for railway vehicles based on odometers and ins