import machine
from machine import Pin, PWM
import utime, math
import urequests
import network
import time

print("Connecting to WiFi", end="")
sta_if = network.WLAN(network.STA_IF)
sta_if.active(True)
sta_if.connect('Wokwi-GUEST', '')
while not sta_if.isconnected():
  print(".", end="")
  time.sleep(0.1)
print(" Connected!")

# Test GET request
print("Making a test GET request...")
url = 'https://curious-living-lizard.ngrok-free.app/angulos/' # Replace with your URL
response = urequests.get(url)

if response.status_code == 200:
    print("Response received:")
    print(response.text)
else:
    print(f"Failed to get data. Status code: {response.status_code}")

response.close()

# Definir los pines GPIO para los servomotores
servo_pins = [23, 22, 21, 19, 18, 5]

# Crear objetos PWM para los servomotores
servos = []
for pin in servo_pins:
    servo = PWM(Pin(pin), freq=50, duty=0)
    servos.append(servo)

def Servo(servo, angle):
    # angle / 180（ \* 2（0°-180°） + 0.5（）/ 20ms \* 1023
    duty = int(((angle)/180 * 2 + 0.5) / 20 * 1023)
    servo.duty(duty)

def moveServos(positions):
    for servo, position in zip(servos, positions):
        Servo(servo, position)
        utime.sleep(1)
        print(f"Servo Angle: {position}")

# Posiciones iniciales de los servomotores
angles = [120, 90, 60, 30, 150, 180]

# Mover los servomotores a las posiciones iniciales
moveServos(angles)