Browse Source

first simple servo tilt driving.

Signed-off-by: Georgios Gerontakis <giwrgosgprog@gmail.com>
master
Georgios Gerontakis 5 years ago
parent
commit
d7c2b215f7
  1. 4
      camera module/main.py
  2. 34
      camera module/servo.py

4
camera module/main.py

@ -0,0 +1,4 @@
import servo
servo.SetAngleUp(180)
servo.SetAngleDown(180)

34
camera module/servo.py

@ -0,0 +1,34 @@
import RPi.GPIO as GPIO #import GPIO Module
from time import sleep #sleep command
def SetAngleUp(angle):
GPIO.setmode(GPIO.BOARD) #pins naming
GPIO.setup(03, GPIO.OUT) #PWM signal output (GPIO2)
pwm=GPIO.PWM(03, 50) #50Hz PWM on pin
pwm.start(0) # start with 0 duty ccle (sets no angles on startup)
duty = angle / 18 + 2
GPIO.output(03, True)
pwm.ChangeDutyCycle(duty)
sleep(1)
GPIO.output(03, False)
pwm.ChangeDutyCycle(0)
pwm.stop()
GPIO.cleanup()
def SetAngleDown(angle):
GPIO.setmode(GPIO.BOARD) #pins naming
GPIO.setup(05, GPIO.OUT) #PWM signal output (GPIO3)
pwm=GPIO.PWM(05, 50) #50Hz PWM on pin
pwm.start(0) # start with 0 duty ccle (sets no angles on startup)
duty = angle / 18 + 2
GPIO.output(05, True)
pwm.ChangeDutyCycle(duty)
sleep(1)
GPIO.output(05, False)
pwm.ChangeDutyCycle(0)
pwm.stop()
GPIO.cleanup()
SetAngleDown(100)
SetAngleUp(100)
Loading…
Cancel
Save