Made the front stop treshold depend on the currently calculated speed from the motor controller
Moved prints to obstacle functions
Fixed some stuff in the lost state
Made params of the front obstacle sensors. Updated values to new sensor positions. Removed all turning sleeps. Removed while loop in lost state when it's going forward