import time
import board
import digitalio
import pwmio
from adafruit_motor import servo

pwm = pwmio.PWMOut(board.GP15, duty_cycle = 2**15, frequency=50)
my_servo = servo.Servo(pwm)

button = digitalio.DigitalInOut(board.GP7)
button.direction = digitalio.Direction.INPUT
button.pull = digitalio.Pull.DOWN

teller = 0

while True:
  if button.value:
    teller += 1
    print(" druk de knop 3 seconde in voor een volledige schoonmaak, als object x vies is")
    my_servo.angle = 5
    time.sleep(2) 

  else:
    teller = 0
    print("0 graden, de knop wordt niet of niet goed ingedrukt")
    my_servo.angle = 0
    time.sleep(2)
  
  if teller > 1:
    print("stop met drukken")
    my_servo.angle = 180
    time.sleep(1)