import board, time, pwmio
from adafruit_motor import servo
import adafruit_mpr121

i2c = board.STEMMA_I2C()

pwm1 = pwmio.PWMOut(board.GP14, frequency=50)
pwm2 = pwmio.PWMOut(board.GP15, frequency=50)
servo_1 = servo.Servo(pwm1, min_pulse=750, max_pulse=2250)
servo_2 = servo.Servo(pwm2, min_pulse=750, max_pulse=2250)

touch_pad = adafruit_mpr121.MPR121(i2c)

pads = [] # array that will hold our debounced pads (Buttons)

touch_pad = adafruit_mpr121.MPR121(i2c)

while True:
    if touch_pad [1].value:
        for i in reversed(range(120,160)):
            servo_1.angle = i
            servo_2.angle = i
            time.sleep(0.001)
        time.sleep(3)
        for i in range(120,160):
            servo_1.angle = i
            servo_2.angle = i
            time.sleep(0.001)