SVD rotation added & odometry procedure re writed