from telemetrix_rpi_pico import telemetrix_rpi_pico
from kuukar_config import COLLISION_DETECTOR_PIN

from kuukar_lcd import lcd
from kuukar_leds import leds
class collision:
    def __init__(self, aux: telemetrix_rpi_pico.TelemetrixRpiPico, lcd: lcd, leds: leds) -> None:
        self.aux = aux
        self.lcd = lcd
        self.leds = leds
        aux.set_pin_mode_digital_input(COLLISION_DETECTOR_PIN, self.collision_handle)
        
    def collision_handle(self, data):
        val = data[2]
        if val == 1:
            self.leds.flash(r=255,g=0,b=0,duration_ms=250)
            self.lcd.keke_hurt()