|
|
|
@@ -3,7 +3,9 @@ Created on Dec 19, 2016
|
|
|
|
|
|
|
|
|
|
@author: klaehn
|
|
|
|
|
'''
|
|
|
|
|
from time import time, sleep
|
|
|
|
|
import sys
|
|
|
|
|
sys.path.append('source/')
|
|
|
|
|
import time
|
|
|
|
|
import mqtt
|
|
|
|
|
import data_buffer
|
|
|
|
|
import light_sensor
|
|
|
|
@@ -44,8 +46,8 @@ class Gate(object):
|
|
|
|
|
STATE_OPENING:self.__opening_handler, \
|
|
|
|
|
STATE_CLOSING:self.__closing_handler, \
|
|
|
|
|
STATE_ERROR:self.__error_handler}
|
|
|
|
|
self.__next_state = "init"
|
|
|
|
|
self.__last_state = "error"
|
|
|
|
|
self.__next_state = STATE_INIT
|
|
|
|
|
self.__last_state = STATE_ERROR
|
|
|
|
|
|
|
|
|
|
self.__light_sensor = light_sensor.LightSensor(LIGHT_SENSOR_I2C_BUS, \
|
|
|
|
|
LIGHT_SENSOR_I2C_ADDRESS)
|
|
|
|
@@ -62,7 +64,7 @@ class Gate(object):
|
|
|
|
|
self.__runtime_close = 0
|
|
|
|
|
|
|
|
|
|
def poll(self):
|
|
|
|
|
current_time = time()
|
|
|
|
|
current_time = time.time()
|
|
|
|
|
if current_time >= self.__light_read_timeout:
|
|
|
|
|
self.__light_read_timeout = current_time + LIGHT_READ_DELAY_S
|
|
|
|
|
self.__light_data.push(self.__light_sensor.read())
|
|
|
|
@@ -82,11 +84,11 @@ class Gate(object):
|
|
|
|
|
def __init_handler(self, light_avg):
|
|
|
|
|
'''
|
|
|
|
|
In init we don't know anything neither about gate state nor about
|
|
|
|
|
light. So first we try to reach STATE_CLOSED.
|
|
|
|
|
light. So first we try to reach STATE_OPENED.
|
|
|
|
|
'''
|
|
|
|
|
#pylint: disable=unused-argument
|
|
|
|
|
self.__comserver.connect()
|
|
|
|
|
self.__comserver.transmit(MQTT_TOPIC, str(time()) + \
|
|
|
|
|
self.__comserver.transmit(MQTT_TOPIC, str(time.time()) + \
|
|
|
|
|
" gate gard initiated")
|
|
|
|
|
self.__comserver.disconnect()
|
|
|
|
|
self.__update_state(STATE_OPENING)
|
|
|
|
@@ -96,13 +98,14 @@ class Gate(object):
|
|
|
|
|
next_state = self.__next_state
|
|
|
|
|
if self.__is_transition():
|
|
|
|
|
self.__engine.down()
|
|
|
|
|
sleep(5)
|
|
|
|
|
time.sleep(5)
|
|
|
|
|
self.__engine.stop()
|
|
|
|
|
self.__comserver.transmit(MQTT_TOPIC, str(time()) + " Opened " + \
|
|
|
|
|
self.__comserver.transmit(MQTT_TOPIC, str(time.time()) + \
|
|
|
|
|
" Opened " + \
|
|
|
|
|
str(self.__power_data.average()) + " mW")
|
|
|
|
|
self.__power_data.clear()
|
|
|
|
|
|
|
|
|
|
if light_avg <= LIGHT_LX_THRESHOLD["close"]:
|
|
|
|
|
if (light_avg != None) and (light_avg <= LIGHT_LX_THRESHOLD["close"]):
|
|
|
|
|
next_state = STATE_CLOSING
|
|
|
|
|
|
|
|
|
|
self.__update_state(next_state)
|
|
|
|
@@ -112,13 +115,14 @@ class Gate(object):
|
|
|
|
|
next_state = self.__next_state
|
|
|
|
|
if self.__is_transition():
|
|
|
|
|
self.__engine.up()
|
|
|
|
|
sleep(5)
|
|
|
|
|
time.sleep(5)
|
|
|
|
|
self.__engine.stop()
|
|
|
|
|
self.__comserver.transmit(MQTT_TOPIC, str(time()) + " Closed " + \
|
|
|
|
|
self.__comserver.transmit(MQTT_TOPIC, str(time.time()) + \
|
|
|
|
|
" Closed " + \
|
|
|
|
|
str(self.__power_data.average()) + " mW")
|
|
|
|
|
self.__power_data.clear()
|
|
|
|
|
|
|
|
|
|
if light_avg > LIGHT_LX_THRESHOLD["open"]:
|
|
|
|
|
if (light_avg != None) and (light_avg > LIGHT_LX_THRESHOLD["open"]):
|
|
|
|
|
next_state = STATE_OPENING
|
|
|
|
|
|
|
|
|
|
self.__update_state(next_state)
|
|
|
|
@@ -127,20 +131,20 @@ class Gate(object):
|
|
|
|
|
def __opening_handler(self, light_avg):
|
|
|
|
|
next_state = self.__next_state
|
|
|
|
|
if self.__is_transition():
|
|
|
|
|
self.__runtime_open = time() + MIN_GATE_RUNTIME["open"]
|
|
|
|
|
self.__runtime_open = time.time() + MIN_GATE_RUNTIME["open"]
|
|
|
|
|
self.__engine.up()
|
|
|
|
|
self.__gate_move_timeout = time() + MAX_GATE_RUNTIME["open"]
|
|
|
|
|
self.__comserver.transmit(MQTT_TOPIC, str(time()) + \
|
|
|
|
|
self.__gate_move_timeout = time.time() + MAX_GATE_RUNTIME["open"]
|
|
|
|
|
self.__comserver.transmit(MQTT_TOPIC, str(time.time()) + \
|
|
|
|
|
" Opening " + str(light_avg) + " lx")
|
|
|
|
|
|
|
|
|
|
if time() > self.__gate_move_timeout:
|
|
|
|
|
if time.time() > self.__gate_move_timeout:
|
|
|
|
|
next_state = STATE_ERROR
|
|
|
|
|
else:
|
|
|
|
|
self.__power_data.push(self.__power_sensor.power_mw())
|
|
|
|
|
current_avg = self.__power_data.average()
|
|
|
|
|
if current_avg != None:
|
|
|
|
|
if current_avg > MAX_ENGINE_POWER["up"]:
|
|
|
|
|
if time() > self.__runtime_open:
|
|
|
|
|
if time.time() > self.__runtime_open:
|
|
|
|
|
next_state = STATE_OPENED
|
|
|
|
|
|
|
|
|
|
self.__update_state(next_state)
|
|
|
|
@@ -148,20 +152,20 @@ class Gate(object):
|
|
|
|
|
def __closing_handler(self, light_avg):
|
|
|
|
|
next_state = self.__next_state
|
|
|
|
|
if self.__is_transition():
|
|
|
|
|
self.__runtime_close = time() + MIN_GATE_RUNTIME["close"]
|
|
|
|
|
self.__runtime_close = time.time() + MIN_GATE_RUNTIME["close"]
|
|
|
|
|
self.__engine.down()
|
|
|
|
|
self.__gate_move_timeout = time() + MAX_GATE_RUNTIME["close"]
|
|
|
|
|
self.__comserver.transmit(MQTT_TOPIC, str(time()) + \
|
|
|
|
|
self.__gate_move_timeout = time.time() + MAX_GATE_RUNTIME["close"]
|
|
|
|
|
self.__comserver.transmit(MQTT_TOPIC, str(time.time()) + \
|
|
|
|
|
" Closing " + str(light_avg) + " lx")
|
|
|
|
|
|
|
|
|
|
if time() > self.__gate_move_timeout:
|
|
|
|
|
if time.time() > self.__gate_move_timeout:
|
|
|
|
|
next_state = STATE_ERROR
|
|
|
|
|
else:
|
|
|
|
|
self.__power_data.push(self.__power_sensor.power_mw())
|
|
|
|
|
current_avg = self.__power_data.average()
|
|
|
|
|
if current_avg != None:
|
|
|
|
|
if current_avg > MAX_ENGINE_POWER["down"]:
|
|
|
|
|
if time() > self.__runtime_close:
|
|
|
|
|
if time.time() > self.__runtime_close:
|
|
|
|
|
next_state = STATE_CLOSED
|
|
|
|
|
|
|
|
|
|
self.__update_state(next_state)
|
|
|
|
@@ -171,6 +175,6 @@ class Gate(object):
|
|
|
|
|
#pylint: disable=unused-argument
|
|
|
|
|
if self.__is_transition():
|
|
|
|
|
self.__engine.stop()
|
|
|
|
|
self.__comserver.transmit(MQTT_TOPIC, str(time()) + \
|
|
|
|
|
self.__comserver.transmit(MQTT_TOPIC, str(time.time()) + \
|
|
|
|
|
" Error handler!!!")
|
|
|
|
|
self.__update_state(STATE_INIT)
|
|
|
|
|