Navigation fixed, odometry fixed, client's code up