import utime
from servo import Servo
 
s1 = Servo(15) 
 
def servo_Map(x, in_min, in_max, out_min, out_max):
    return (x - in_min) * (out_max - out_min) / (in_max - in_min) + out_min
 
def servo_Angle(angle):
    if angle < 0:
        angle = 0
    if angle > 180:
        angle = 180
    s1.goto(round(servo_Map(angle,0,180,0,1024))) # Convert range value to angle value
    

while True:
    for i in range(0,180,10):
        servo_Angle(i)
        utime.sleep(0.05) 

    for i in range(180,0,-10):
        servo_Angle(i)
        utime.sleep(0.05)
    
    servo_Angle(0)
    utime.sleep(1)
    servo_Angle(70)
    utime.sleep(1)
    servo_Angle(140)
    utime.sleep(1)
    servo_Angle(180)
    utime.sleep(1)