-
Notifications
You must be signed in to change notification settings - Fork 0
/
servo.py
47 lines (42 loc) · 987 Bytes
/
servo.py
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
import RPi.GPIO as GPIO
import time
import numpy as np
import cv2
servoPIN = 17
GPIO.setmode(GPIO.BCM)
GPIO.setup(servoPIN, GPIO.OUT)
p = GPIO.PWM(servoPIN, 50) # GPIO 17 for PWM with 50Hz
p.start(1) # Initialization
rate = 1
inc = 1
cap = cv2.VideoCapture(0)
count = 0
try:
while True:
p.ChangeDutyCycle(rate)
rate = rate + inc
print(rate)
if rate == 12:
inc = -1
elif rate ==1:
inc = 1
time.sleep(0.2)
ret, frame = cap.read()
#time.sleep(0.2)
cv2.imwrite("/home/pi/Desktop/frames/frame%d.jpg" % count, frame)
count+=1
except KeyboardInterrupt:
p.stop()
GPIO.cleanup()
cap.release()
cv2.destroyAllWindows()
#while count<20:
# Capture frame-by-frame
# ret, frame = cap.read()
# Our operations on the frame come here
# cv2.imwrite("/home/pi/Desktop/frames/frame%d.jpg" % count, frame)
# Display the resulting frame
# count=count +1
# When everything done, release the capture
#cap.release()
#cv2.