#Movement not working correctly.  Adjust angles of movement.

import time
import pi_servo_hat
from picamera import PiCamera

servo = pi_servo_hat.PiServoHat()
servo.restart()

camera = PiCamera()
camera.resolution = (1024, 768)

def center_camera():
    servo.move_servo_positon(1,0,180)
    servo.move_servo_position(0,0,180)
    
def left_camera():
    servo.move_servo_position(1,0,180)
    servo.move_servo_position(0,-90,180)

def right_camera():
    servo.move_servo_position(1,0,180)
    servo.move_servo_position(0,90,180)

def up_camera():
    servo.move_servo_position(1,90,180)
    servo.move_servo_position(0,0,180)
    
while True:
    camera.start_preview()
    time.sleep(1)
    print('centering')
    center_camera()
    time.sleep(1)
    print('left')
    left_camera()
    time.sleep(1)
    print('right')
    right_camera()
    time.sleep(1)
    print('up')
    up_camera()
    center_camera()
