Added function to break until the car got a specified speed.
Trying to adjust the mapped data while in drivemode. Probably not
stable, commented out for now