Improved robot behavior. Changed speed limits a little bit.