full odometry convergence! adding constant block worked great.