mirror of
https://github.com/undera/pylgbst.git
synced 2020-11-18 19:37:26 -08:00
16b1612cc6
* Cosmetics * Harmonograph demo * Cleanup * Original * Original * Cosmetics * Original file * Fixes * cosmetics * separate classes * Cosmetics * Cosmetics * fix tests * Remove plotter tests * Add bluegiga * Rename it * Progress * Fix tests * Cosmetics * Found a way for pygatt! * Playing with gatt * Fix hung subscribe * rename class * add test * skeleton for autodetect * safer order * Fix tests * Fix test * Add dbus install * another try * 2 * 3 * 34 * 6 * 7 * Isolate some tests * 8 * back to roots * Try more * 9 * Help * rep * site-packs * Fix? * Py3 come on * dbus * busss * dev null! * Fix test * Cleanup * Fix tests * Fix after review * add package * FIx package paths * Cosmetics * Update * More doc
37 lines
894 B
Python
37 lines
894 B
Python
from pylgbst.constants import COLOR_GREEN, COLOR_NONE
|
|
from . import *
|
|
|
|
robot = Vernie()
|
|
running = True
|
|
|
|
|
|
def callback(color, distance):
|
|
robot.led.set_color(color)
|
|
speed = (10 - distance + 1) / 10.0
|
|
secs = (10 - distance + 1) / 10.0
|
|
print("Distance is %.1f inches, I'm running back with %s%% speed!" % (distance, int(speed * 100)))
|
|
if speed <= 1:
|
|
robot.motor_AB.timed(secs / 1, -speed, async=True)
|
|
robot.say("Ouch")
|
|
|
|
|
|
def on_btn(pressed):
|
|
global running
|
|
if pressed:
|
|
running = False
|
|
|
|
|
|
robot.led.set_color(COLOR_GREEN)
|
|
robot.button.subscribe(on_btn)
|
|
robot.color_distance_sensor.subscribe(callback)
|
|
robot.say("Place your hand in front of sensor")
|
|
|
|
while running:
|
|
time.sleep(1)
|
|
|
|
robot.color_distance_sensor.unsubscribe(callback)
|
|
robot.button.unsubscribe(on_btn)
|
|
robot.led.set_color(COLOR_NONE)
|
|
while robot.led.in_progress():
|
|
time.sleep(1)
|