Update km_update to consider a max_speed.
Update orientation properly
Update max rotation
update km_update calls.