51 lines
1.2 KiB
Python
51 lines
1.2 KiB
Python
# SPDX-FileCopyrightText: 2018 Dave Astels for Adafruit Industries
|
|
#
|
|
# SPDX-License-Identifier: MIT
|
|
|
|
"""
|
|
Circuit Playground Express head-tilt activated ears.
|
|
|
|
Adafruit invests time and resources providing this open source code.
|
|
Please support Adafruit and open source hardware by purchasing
|
|
products from Adafruit!
|
|
|
|
Written by Dave Astels for Adafruit Industries
|
|
Copyright (c) 2018 Adafruit Industries
|
|
Licensed under the MIT license.
|
|
|
|
All text above must be included in any redistribution.
|
|
"""
|
|
|
|
import time
|
|
import busio
|
|
import board
|
|
import adafruit_lis3dh
|
|
import pwmio
|
|
from adafruit_motor import servo
|
|
|
|
|
|
# Setup accelerometer
|
|
i2c = busio.I2C(board.ACCELEROMETER_SCL, board.ACCELEROMETER_SDA)
|
|
sensor = adafruit_lis3dh.LIS3DH_I2C(i2c, address=0x19)
|
|
|
|
# Setup servos
|
|
left_pwm = pwmio.PWMOut(board.A1, frequency=50)
|
|
right_pwm = pwmio.PWMOut(board.A2, frequency=50)
|
|
|
|
left_ear = servo.Servo(left_pwm)
|
|
right_ear = servo.Servo(right_pwm)
|
|
|
|
#initialize things
|
|
left_ear.angle = 0
|
|
right_ear.angle = 0
|
|
|
|
while True:
|
|
x, _, _ = sensor.acceleration
|
|
if x < -5.0:
|
|
left_ear.angle = 90
|
|
elif x > 5.0:
|
|
right_ear.angle = 90
|
|
elif abs(x) < 4.0:
|
|
left_ear.angle = 0
|
|
right_ear.angle = 0
|
|
time.sleep(0.1)
|