forked from platypush/platypush
- Added IR sensor backend
- Fixed default power offsets - Changed threshold distance for ultrasound sensor - Fixed power multiplier coefficient
This commit is contained in:
parent
0f97678a78
commit
8b733fb859
8 changed files with 79 additions and 11 deletions
0
platypush/backend/sensor/__init__.py
Normal file
0
platypush/backend/sensor/__init__.py
Normal file
0
platypush/backend/sensor/distance/__init__.py
Normal file
0
platypush/backend/sensor/distance/__init__.py
Normal file
0
platypush/backend/sensor/ir/__init__.py
Normal file
0
platypush/backend/sensor/ir/__init__.py
Normal file
48
platypush/backend/sensor/ir/zeroborg.py
Normal file
48
platypush/backend/sensor/ir/zeroborg.py
Normal file
|
@ -0,0 +1,48 @@
|
||||||
|
import logging
|
||||||
|
import time
|
||||||
|
|
||||||
|
import platypush.plugins.gpio.zeroborg.lib as ZeroBorg
|
||||||
|
|
||||||
|
from platypush.backend import Backend
|
||||||
|
from platypush.message.event.sensor.ir import IrKeyUpEvent, IrKeyDownEvent
|
||||||
|
|
||||||
|
class SensorIrZeroborgBackend(Backend):
|
||||||
|
last_message =None
|
||||||
|
last_message_timestamp = None
|
||||||
|
|
||||||
|
def __init__(self, no_message_timeout=0.37, **kwargs):
|
||||||
|
super().__init__(**kwargs)
|
||||||
|
self.no_message_timeout = no_message_timeout
|
||||||
|
self.zb = ZeroBorg.ZeroBorg()
|
||||||
|
self.zb.Init()
|
||||||
|
logging.info('Initialized Zeroborg infrared sensor backend')
|
||||||
|
|
||||||
|
|
||||||
|
def send_message(self, message):
|
||||||
|
pass
|
||||||
|
|
||||||
|
|
||||||
|
def run(self):
|
||||||
|
super().run()
|
||||||
|
|
||||||
|
while True:
|
||||||
|
self.zb.GetIrMessage()
|
||||||
|
if self.zb.HasNewIrMessage():
|
||||||
|
message = self.zb.GetIrMessage()
|
||||||
|
if message != self.last_message:
|
||||||
|
logging.info('Received key down event on the IR sensor: {}'.format(message))
|
||||||
|
self.bus.post(IrKeyDownEvent(message=message))
|
||||||
|
|
||||||
|
self.last_message = message
|
||||||
|
self.last_message_timestamp = time.time()
|
||||||
|
elif self.last_message_timestamp and \
|
||||||
|
time.time() - self.last_message_timestamp > self.no_message_timeout:
|
||||||
|
logging.info('Received key up event on the IR sensor')
|
||||||
|
self.bus.post(IrKeyUpEvent(message=self.last_message))
|
||||||
|
|
||||||
|
self.last_message = None
|
||||||
|
self.last_message_timestamp = None
|
||||||
|
|
||||||
|
|
||||||
|
# vim:sw=4:ts=4:et:
|
||||||
|
|
|
@ -1,4 +1,3 @@
|
||||||
import functools
|
|
||||||
import importlib
|
import importlib
|
||||||
import logging
|
import logging
|
||||||
|
|
||||||
|
@ -29,10 +28,10 @@ def register_backends(bus=None, global_scope=False, **kwargs):
|
||||||
module = importlib.import_module('platypush.backend.' + name)
|
module = importlib.import_module('platypush.backend.' + name)
|
||||||
|
|
||||||
# e.g. backend.pushbullet main class: PushbulletBackend
|
# e.g. backend.pushbullet main class: PushbulletBackend
|
||||||
cls_name = functools.reduce(
|
cls_name = ''
|
||||||
lambda a,b: a.title() + b.title(),
|
for token in module.__name__.title().split('.')[2:]:
|
||||||
(module.__name__.title().split('.')[2:])
|
cls_name += token.title()
|
||||||
) + 'Backend'
|
cls_name += 'Backend'
|
||||||
|
|
||||||
try:
|
try:
|
||||||
b = getattr(module, cls_name)(bus=bus, **cfg, **kwargs)
|
b = getattr(module, cls_name)(bus=bus, **cfg, **kwargs)
|
||||||
|
|
0
platypush/message/event/sensor/__init__.py
Normal file
0
platypush/message/event/sensor/__init__.py
Normal file
20
platypush/message/event/sensor/ir/__init__.py
Normal file
20
platypush/message/event/sensor/ir/__init__.py
Normal file
|
@ -0,0 +1,20 @@
|
||||||
|
from platypush.message.event import Event
|
||||||
|
|
||||||
|
|
||||||
|
class IrSensorEvent(Event):
|
||||||
|
def __init__(self, *args, **kwargs):
|
||||||
|
super().__init__(*args, **kwargs)
|
||||||
|
|
||||||
|
|
||||||
|
class IrKeyUpEvent(IrSensorEvent):
|
||||||
|
def __init__(self, *args, **kwargs):
|
||||||
|
super().__init__(*args, **kwargs)
|
||||||
|
|
||||||
|
|
||||||
|
class IrKeyDownEvent(IrSensorEvent):
|
||||||
|
def __init__(self, *args, **kwargs):
|
||||||
|
super().__init__(*args, **kwargs)
|
||||||
|
|
||||||
|
|
||||||
|
# vim:sw=4:ts=4:et:
|
||||||
|
|
|
@ -23,7 +23,7 @@ class GpioZeroborgPlugin(Plugin):
|
||||||
_direction = None
|
_direction = None
|
||||||
_power_offsets = {
|
_power_offsets = {
|
||||||
Direction.DIR_LEFT: {
|
Direction.DIR_LEFT: {
|
||||||
Direction.DIR_UP: 0.242,
|
Direction.DIR_UP: 0.315,
|
||||||
Direction.DIR_DOWN: 0.285,
|
Direction.DIR_DOWN: 0.285,
|
||||||
},
|
},
|
||||||
|
|
||||||
|
@ -76,8 +76,9 @@ class GpioZeroborgPlugin(Plugin):
|
||||||
distance = None
|
distance = None
|
||||||
while distance is None:
|
while distance is None:
|
||||||
distance = self.get_distance()
|
distance = self.get_distance()
|
||||||
|
print(distance)
|
||||||
|
|
||||||
if distance > 250.0: # distance in mm
|
if distance > 300.0: # distance in mm
|
||||||
self._direction = Direction.DIR_UP.value
|
self._direction = Direction.DIR_UP.value
|
||||||
else:
|
else:
|
||||||
logging.info('Physical obstacle detected at {} mm'.
|
logging.info('Physical obstacle detected at {} mm'.
|
||||||
|
@ -93,16 +94,16 @@ class GpioZeroborgPlugin(Plugin):
|
||||||
left = -1.0 - self._power_offsets[Direction.DIR_LEFT][Direction.DIR_DOWN]
|
left = -1.0 - self._power_offsets[Direction.DIR_LEFT][Direction.DIR_DOWN]
|
||||||
right = -1.0 - self._power_offsets[Direction.DIR_RIGHT][Direction.DIR_DOWN]
|
right = -1.0 - self._power_offsets[Direction.DIR_RIGHT][Direction.DIR_DOWN]
|
||||||
elif self._direction == Direction.DIR_LEFT.value:
|
elif self._direction == Direction.DIR_LEFT.value:
|
||||||
left = 2.0 + self._power_offsets[Direction.DIR_LEFT][Direction.DIR_UP]
|
|
||||||
right = -1.25 - self._power_offsets[Direction.DIR_RIGHT][Direction.DIR_DOWN]
|
|
||||||
elif self._direction == Direction.DIR_RIGHT.value:
|
|
||||||
left = -1.25 - self._power_offsets[Direction.DIR_LEFT][Direction.DIR_DOWN]
|
left = -1.25 - self._power_offsets[Direction.DIR_LEFT][Direction.DIR_DOWN]
|
||||||
right = 2.0 + self._power_offsets[Direction.DIR_RIGHT][Direction.DIR_UP]
|
right = 2.0 + self._power_offsets[Direction.DIR_RIGHT][Direction.DIR_UP]
|
||||||
|
elif self._direction == Direction.DIR_RIGHT.value:
|
||||||
|
left = 2.0 + self._power_offsets[Direction.DIR_LEFT][Direction.DIR_UP]
|
||||||
|
right = -1.25 - self._power_offsets[Direction.DIR_RIGHT][Direction.DIR_DOWN]
|
||||||
elif self._direction is not None:
|
elif self._direction is not None:
|
||||||
logging.warning('Invalid direction: {}'.format(direction))
|
logging.warning('Invalid direction: {}'.format(direction))
|
||||||
self.stop()
|
self.stop()
|
||||||
|
|
||||||
power = 0.6 # Still debugging the right power range
|
power = 0.75 # Still debugging the right power range
|
||||||
|
|
||||||
self.zb.SetMotor1(power * left * self.max_power)
|
self.zb.SetMotor1(power * left * self.max_power)
|
||||||
self.zb.SetMotor2(power * left * self.max_power)
|
self.zb.SetMotor2(power * left * self.max_power)
|
||||||
|
|
Loading…
Reference in a new issue