Files
        @ 8775d177fa1d
    
        
              Branch filter: 
        
    Location: HydroBot/hydrobot-software/hydrobot.py - annotation
        
            
            8775d177fa1d
            8.9 KiB
            text/x-python
        
        
    
    merge
    1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214  | d1142fbbace4 1aa7eed26cdb 1aa7eed26cdb 22b6999f8bdd 22b6999f8bdd 653da092aa96 a5b830d92afd d1142fbbace4 d1142fbbace4 1aa7eed26cdb 514bbf7bb55e a5b830d92afd a5b830d92afd a5b830d92afd 981a1d0baca8 a5b830d92afd d1142fbbace4 22b6999f8bdd a5b830d92afd 1aa7eed26cdb 1aa7eed26cdb cec321b6b72c d1142fbbace4 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c 22b6999f8bdd daaed5044a8c 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e daaed5044a8c daaed5044a8c daaed5044a8c 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e daaed5044a8c 981a1d0baca8 981a1d0baca8 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e 590eff6f7ddc 514bbf7bb55e 514bbf7bb55e 514bbf7bb55e daaed5044a8c daaed5044a8c daaed5044a8c d1142fbbace4 daaed5044a8c daaed5044a8c daaed5044a8c 1aa7eed26cdb daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c a5b830d92afd a5b830d92afd daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c 981a1d0baca8 1aa7eed26cdb daaed5044a8c daaed5044a8c a5b830d92afd a5b830d92afd a5b830d92afd a5b830d92afd a5b830d92afd a5b830d92afd a5b830d92afd daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c daaed5044a8c a5b830d92afd a5b830d92afd 22b6999f8bdd 22b6999f8bdd 22b6999f8bdd 653da092aa96 981a1d0baca8 981a1d0baca8 981a1d0baca8 981a1d0baca8 981a1d0baca8 981a1d0baca8 981a1d0baca8 981a1d0baca8 981a1d0baca8 514bbf7bb55e 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 cec321b6b72c cec321b6b72c 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 653da092aa96 cec321b6b72c cec321b6b72c 653da092aa96 514bbf7bb55e 653da092aa96 653da092aa96 653da092aa96 1aa7eed26cdb 1aa7eed26cdb d1142fbbace4 daaed5044a8c 981a1d0baca8 daaed5044a8c daaed5044a8c daaed5044a8c a5b830d92afd 653da092aa96 a5b830d92afd d1142fbbace4 1aa7eed26cdb 1aa7eed26cdb 1aa7eed26cdb 1aa7eed26cdb 1aa7eed26cdb 1aa7eed26cdb 1aa7eed26cdb  | import sys
import time
import _thread
import ast
import configparser
import datetime
from canard import can, messaging
from canard.hw import socketcan
from canard.file import jsondb
from influxdb import InfluxDBClient
from influxdb import SeriesHelper
from apscheduler.schedulers.background import BackgroundScheduler
#TODO
#fix temperature offsets
#database time interval logging
config = configparser.ConfigParser(allow_no_value = True)
config.read("hydrobot.conf")
DEBUG_CAN = config.getboolean("debug", "can")
DEBUG_CAN_DETAIL = config.getboolean("debug", "can_detail")
DEBUG_TIMER = config.getboolean("debug", "timer")
    
class MySeriesHelper(SeriesHelper):
    
    # Meta class stores time series helper configuration.
    class Meta:
        # The client should be an instance of InfluxDBClient.
        #client = myclient
        # The series name must be a string. Add dependent fields/tags in curly brackets.
        series_name = '{measurement}'
        # Defines all the fields in this time series.
        fields = ['value']
        # Defines all the tags for the series.
        tags = ['measurement']
        # Defines the number of data points to store prior to writing on the wire.
        bulk_size = 5
        # autocommit must be set to True when using bulk_size
        autocommit = True
class Database:
    
    def __init__(self):
        host = config.get("database", "host")
        port = config.get("database", "port")
        username = config.get("database", "username")
        password = config.get("database", "password")
        database = config.get("database", "database")
        self.name = config.get("system", "name")
        self.client = InfluxDBClient(host, port, username, password, database)
        MySeriesHelper.Meta.client = self.client
        MySeriesHelper.Meta.series_name = self.name + '.{measurement}'
        
        # To manually submit data points which are not yet written, call commit:
        #MySeriesHelper.commit()
    def log_data(self, msgdb, message):
        if message == msgdb.AirSense:
            MySeriesHelper(measurement='air_temp', value=(float)(message.Temperature.value))
            MySeriesHelper(measurement='air_humidity', value=(float)(message.Humidity.value))
            MySeriesHelper(measurement='air_pressure', value=(float)(message.Pressure.value))
        if message == msgdb.RelayDriveIn:
            MySeriesHelper(measurement='water_flow_rate', value=(float)(message.FlowRate.value))
            print(message.FlowRate.value)
            MySeriesHelper(measurement='input_1', value=(float)(message.Input1.value))
            MySeriesHelper(measurement='input_2', value=(float)(message.Input2.value))
            MySeriesHelper(measurement='input_3', value=(float)(message.Input3.value))
            MySeriesHelper(measurement='input_4', value=(float)(message.Input4.value))
        if message == msgdb.WaterSense:
            MySeriesHelper(measurement='water_level', value=(float)(message.PercentFull.value))
            MySeriesHelper(measurement='water_temp', value=(float)(message.Temperature.value))
            MySeriesHelper(measurement='water_raw_debug', value=(float)(message.RawDebug.value))
class CanBus:
    
    def __init__(self, database):
        
        self.database = database
        self.dev = socketcan.SocketCanDev("can0")
        
        parser = jsondb.JsonDbParser()
        self.msgdb = parser.parse('hydrobot_can.json')
        
        self.temp_msg = self.msgdb.AirSense
        self.relay_msg = self.msgdb.RelayDriveIn
        self.relay_send_msg = self.msgdb.RelayDriveOut
        
    def start(self):
        self.dev.start()
        
    def start_receive(self):
        _thread.start_new_thread(self.process_can, ())
    def process_can(self):
        while True:
            frame = self.dev.recv()
            message = self.msgdb.decode(frame)
            if message:
                if DEBUG_CAN:
                    print("Received CAN message! ID: " + hex(message.id))
                for s in message._signals.values():
                    if DEBUG_CAN_DETAIL:
                        print(s)
                        print(s.value)
                self.database.log_data(self.msgdb, message)
                
    def send_can(self):
        self.relay_send_msg.Nothing.value = 0
        if self.relay_send_msg.Output1.value == 0:
            self.relay_send_msg.Output1.value = 1
        else:
            self.relay_send_msg.Output1.value = 0
        self.relay_send_msg.Output2.value = 1
        self.relay_send_msg.Output3.value = 1
        self.relay_send_msg.Output4.value = 1
        if DEBUG_CAN:
            print("Send CAN message! ID: " + hex(self.relay_send_msg.id))
        if DEBUG_CAN_DETAIL:
            print(self.relay_send_msg)
        self.dev.send(self.relay_send_msg.encode())
        
    def set_output(self, module, output, state):
        msg = self.msgdb.lookup_message(module)
        msg.lookup_signal(output).value = state
        self.dev.send(msg.encode())
        
        if msg.lookup_signal(output) == msg.Output1:
            MySeriesHelper(measurement='output_1', value=state)
        if msg.lookup_signal(output) == msg.Output2:
            MySeriesHelper(measurement='output_2', value=state)
        if msg.lookup_signal(output) == msg.Output3:
            MySeriesHelper(measurement='output_3', value=state)
        if msg.lookup_signal(output) == msg.Output4:
            MySeriesHelper(measurement='output_4', value=state)
        
        
class Scheduler:
    
    def __init__(self, canbus):
        self.canbus = canbus
        self.apscheduler = BackgroundScheduler()
        
    def start(self):
        self.apscheduler.start()
        
        for section in config.sections():
            if "timer" in section:
                items = config.items(section)
                for item in items:
                    if item[0] == 'trigger':
                        trigger = item[1]
                    if item[0] == 'module':
                        module = item[1]
                    if item[0] == 'output':
                        output = item[1]
                    if item[0] == 'on_time':
                        on_time = ast.literal_eval(item[1])
                    if item[0] == 'off_time':
                        off_time = ast.literal_eval(item[1])
                    if item[0] == 'on_duration':
                        on_duration = ast.literal_eval(item[1])
                    if item[0] == 'off_duration':
                        off_duration = ast.literal_eval(item[1])
                if trigger == 'cron':
                    self.apscheduler.add_job(self.canbus.set_output, trigger, [module, output, 1], day = on_time[0], day_of_week = on_time[1], hour = on_time[2], minute = on_time[3], second = on_time[4])
                    self.apscheduler.add_job(self.canbus.set_output, trigger, [module, output, 0], day = off_time[0], day_of_week = off_time[1], hour = off_time[2], minute = off_time[3], second = off_time[4])
                if trigger == 'interval':
                    self.apscheduler.add_job(self.interval_off, trigger, [module, output, section + "_off", section + "_on", on_duration], id = section + "_off", weeks = off_duration[0], days = off_duration[1], hours = off_duration[2], minutes = off_duration[3], seconds = off_duration[4])
                    timer = self.apscheduler.add_job(self.interval_on, trigger, [module, output, section + "_off", section + "_on", off_duration], id = section + "_on", weeks = on_duration[0], days = on_duration[1], hours = on_duration[2], minutes = on_duration[3], seconds = on_duration[4])
                    timer.pause()
        
    def interval_off(self, module, output, timer_off, timer_on, on_duration):
        self.canbus.set_output(module, output, 1)
        self.apscheduler.get_job(timer_on).reschedule("interval", weeks = on_duration[0], days = on_duration[1], hours = on_duration[2], minutes = on_duration[3], seconds = on_duration[4])
        self.apscheduler.get_job(timer_on).resume()
        self.apscheduler.get_job(timer_off).pause()
        if DEBUG_TIMER:
            print("Turning " + timer_on + "! " + str(datetime.datetime.now().time()))
        
    def interval_on(self, module, output, timer_off, timer_on, off_duration):
        self.canbus.set_output(module, output, 0)
        self.apscheduler.get_job(timer_off).reschedule("interval", weeks = off_duration[0], days = off_duration[1], hours = off_duration[2], minutes = off_duration[3], seconds = off_duration[4])
        self.apscheduler.get_job(timer_off).resume()
        self.apscheduler.get_job(timer_on).pause()
        if DEBUG_TIMER:
            print("Turning " + timer_off + "! " + str(datetime.datetime.now().time()))
    
    
def func():
    print(1)
    
def main():
    
    database = Database()
    
    canbus = CanBus(database)
    canbus.start()
    canbus.start_receive()
    
    scheduler = Scheduler(canbus)
    scheduler.start()
    while True:
        
        time.sleep(1)
        
if __name__ == "__main__":
    main()
 |