Created
May 15, 2018 03:35
-
-
Save alex-dow/f797d038259a8eb6d2fe9a481c9c86a1 to your computer and use it in GitHub Desktop.
Sweeping a servo on a raspberry pi
This file contains hidden or bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
import time | |
import pigpio | |
# GPIO number. On a rapsberry pi 1, the hardware PWM pin is | |
# GPIO 18 | |
SERVO_PIN = 18 | |
# Delay in seconds to wait after sending an angle to the servo | |
# motor | |
DELAY = 0.02 | |
# Minimum angle (usually 0) | |
MIN_ANGLE = 0 | |
# Maximum angle | |
MAX_ANGLE = 180 | |
# Minimum duty cycle, in milliseconds | |
MIN_DUTYCYCLE = 500 | |
# Maximum duty cycle, in milliseconds | |
MAX_DUTYCYCLE = 2500 | |
def remap(v, oMin, oMax, nMin, nMax): | |
""" | |
Take a number v, that's within the range oMin and oMax | |
Figure out what that number would actually be if the range | |
is nMin and nMax | |
""" | |
return (((v - oMin) * (nMax - nMin)) / (oMax - oMin)) + nMin | |
def set_angle(pi, angle): | |
""" | |
Sets the angle on the motor. A max range of 0 to 180 degrees | |
o | |
""" | |
if angle < MIN_ANGLE: | |
angle = 0 | |
elif angle > MAX_ANGLE: | |
angle = 180 | |
pulse = remap(angle, MIN_ANGLE, MAX_ANGLE, MIN_DUTYCYCLE, MAX_DUTYCYCLE) | |
pi.set_servo_pulsewidth(SERVO_PIN, pulse) | |
time.sleep(DELAY) | |
pi = pigpio.pi() | |
pi.set_mode(SERVO_PIN, pigpio.OUTPUT) | |
time.sleep(2) | |
try: | |
while True: | |
for pos in range(0, 180): | |
pulse = set_angle(pi, pos) | |
for pos in range(180, 0, -1): | |
pulse = set_angle(pi, pos) | |
except Exception as e: | |
print e | |
pi.stop() |
Sign up for free
to join this conversation on GitHub.
Already have an account?
Sign in to comment