Optimize control logic, set angular_speed parameter. Bug: always turn left if threshold is met. More parameters should be measured later.