import time
from machine import PWM,Pin
time.sleep(0.1)
 # Wait for USB to become ready
servo_pin=PWM(Pin(22), freq = 50)
stepper_Pin = Pin(0,Pin.OUT)
stepper_direction = Pin(1,Pin.OUT)

def move_servo(angel):
    angel_time = 0.5 + (angel/180*2)
    angel_duty = (angel_time / 20)*(65025)
    servo_pin.duty_u16(int(angel_duty))
    time.sleep(0.02)

def move_stepper():
    stepper_pin.toggle()
    time.sleep(0.001)
    stepper_pin.toggle()
    time.sleep(0.02)


print("Hello, Pi Pico!")
servo_angel = 0
stepper_direction.on()

while True:
    move_servo(servo_angel)
    servo_angel = (servo_angel +1) %180
    move_stepper()