syntax and logic port, untested

This commit is contained in:
Mikey Sklar 2018-10-31 10:50:01 -06:00
parent a1e5b95764
commit 570296656a
3 changed files with 40 additions and 15 deletions

View file

@ -1,24 +1,49 @@
# Laser Dog Goggles
# https://learn.adafruit.com/laser-dog-goggles
# Bionic Eye sketch for Adafruit Trinket.
#
# written by Bill Earl for Arduino
# ported to CircuitPython by Mikey Sklar
# for Adafruit Industries
#
# Required library is the Adafruit_SoftServo library
# available at https://github.com/adafruit/Adafruit_SoftServo
# The standard Arduino IDE servo library will not work with 8 bit
# AVR microcontrollers like Trinket and Gemma due to differences
# in available timer hardware and programming. We simply refresh
# by piggy-backing on the timer0 millis() counter
#
# Trinket: Bat+ Gnd Pin #0 Pin #1
# Connection: Servo+ Servo- Tilt Rotate
# (Red) (Brown) Servo Servo
# (Orange)(Orange)
import time
import random
import board
import pulseio
from adafruit_motor import servo
# servo pin for the M0 boards:
pwm = pulseio.PWMOut(board.A2, duty_cycle=2 ** 15, frequency=50)
my_servo = servo.Servo(pwm)
speed = .04 # 40ms lower value means faster movement
max_turn = 180 # rotation range 180 degree, half a circle
# we are intentionally avoiding Trinket Pin #1 (board.A0)
# as it does not have PWM capability
tilt_servo_pin = board.A2 # servo control line (orange) Trinket Pin #0
rotate_servo_pin = board.A1 # servo control line (orange) Trinket Pin #2
# servo object setup for the M0 boards:
tilt_pwm = pulseio.PWMOut(tilt_servo_pin, duty_cycle=2 ** 15, frequency=50)
rotate_pwm = pulseio.PWMOut(rotate_servo_pin, duty_cycle=2 ** 15, frequency=50)
tilt_servo = servo.Servo(tilt_pwm)
rotate_servo = servo.Servo(rotate_pwm)
# servo timing and angle range
speed = .04 # 40ms lower value means faster movement
tilt_min = 120 # lower limit to tilt rotation range
max_rotate = 180 # rotation range limited to half circle
while True:
# move stepper max_turn degrees clockwise
for angle in range(0, max_turn, 1):
my_servo.angle = angle
time.sleep(speed)
# move stepper max_turn degrees counter clockwise
for angle in range(max_turn, 0, -1):
my_servo.angle = angle
time.sleep(speed)
# servo tilt - on average move every 500ms
if random.randint(100) > 80:
tilt_servo = angle(random.randint(tilt_min, max_rotate))
# servo rotate - on average move every 500ms
if random.randint(100) > 90:
rotate_servo = (random.randint(0, max_rotate)