Odometry scale fixed + wallfollowing improved by applying cascade P controllers