added locomotion_mode publisher, changed speeds for teleop