def camera_x(angle):
global Current_x
Current_x = angle + home_x # Add offset
clamp(Current_x, Xmin, Xmax)
pwm.setPWM(14, 0, Current_x)
text = "%s" % (Current_x)
return text
def camera_y(angle):
global Current_y
Current_y = angle + home_y # Add offset
clamp(Current_y, Ymin, Ymax)
pwm.setPWM(15, 0, Current_y)
text = "%s" % (Current_y)
return text
def turn(angle):
angle_original = angle
angle *= -1 #Reverse value
angle = clamp(angle, -100, 100)
angle = angle + turn_offset + 450 #Add offset and middle number
pwm.setPWM(0, 0, angle)
text = "%s -> %s" % (angle_original, angle)
return text
