# -*- coding: utf-8 -*-
# Raspberry Pi GPIO Package
import RPi.GPIO as GPIO
from time import sleep
import time
import sys
import pygame
import os
from adafruit_servokit import ServoKit
os.system("sudo i2cdetect -y 1")
kit = ServoKit(channels=8)
pipe = None
yaw=0 # Vertical.
pitch=1 # Horizontal.
yawValue = 90 # Yaw percentage value. Never use over 50%.
pitchValue= 90 # Pitch percentage value.
# Reset servo motor position
kit.servo[0].angle = 90
time.sleep(0.1)
kit.servo[1].angle = 90
time.sleep(0.1)
# Motor Status
STOP = 0
FORWARD = 1
BACKWARD = 2
# Mortor Channel
CH1 = 0 # Left Wheel
CH2 = 1 # Right Wheel
# PIN Input, Output Setting
OUTPUT = 1
INPUT = 0
# PIN Setting
HIGH = 1
LOW = 0
#PWM PIN
ENA = 26 #37 pin
ENB = 0 #27 pin
#GPIO PIN
IN1 = 19 #37 pin
IN2 = 13 #35 pin
IN3 = 6 #31 pin
IN4 = 5 #29 pin
# 핀 설정 함수
def setPinConfig(EN, INA, INB):
GPIO.setup(EN, GPIO.OUT)
GPIO.setup(INA, GPIO.OUT)
GPIO.setup(INB, GPIO.OUT)
# Active PWM with...