def init_robot():
print("Imported Libraries")
print("Initializing...")
# Turn on Light
led = Pin(25, Pin.OUT)
led.high()
# DRIVER INITIALIZATION
btn = button.Button(BUTTON_PIN)
bzz = buzzer.Buzzer(BUZZER_PIN)
motors = motor.TwoWheel(MOTOR_PINS, AXIL_LENGTH)
threshold = max(UNIT_SIZE) - MIN_SENSOR_WIDTH
ping_sensors = list(
map(lambda pins: ping.PingProximitySensor(pins, threshold), PING_PINS))
ping_collection = ping.PingProxCollection(ping_sensors)
dht_sensor = dht.DHT11(Pin(20))
# MAZE INITIALIZATION
maze = Maze(MAZE_SIZE)
# ROBOT INITIALIZATION
robot = Robot(btn, bzz, motors, ping_collection, dht_sensor, maze,
UNIT_SIZE, SOLUTIONS, threshold)
utime.sleep_ms(100)
led.low()
print("Pico Initialized")
robot.Start()
