# coding=utf-8 import config as cfg from convert import mean, read_float, read_led_state, read_bool, read_bool_inverted, count_bits, comma_separated from data import BatterySignal, Battery, LedColor, ServiceSignal, BatteryStatus, LedState from python_libs.ie_dbus.dbus_service import DBusService # noinspection PyUnreachableCode if False: from typing import List, Iterable def init_service_signals(batteries): # type: (List[Battery]) -> Iterable[ServiceSignal] n_batteries = len(batteries) product_name = cfg.PRODUCT_NAME + ' x' + str(n_batteries) return [ ServiceSignal('/NbOfBatteries', n_batteries), # TODO: nb of operational batteries ServiceSignal('/Mgmt/ProcessName', __file__), ServiceSignal('/Mgmt/ProcessVersion', cfg.SOFTWARE_VERSION), ServiceSignal('/Mgmt/Connection', cfg.CONNECTION), ServiceSignal('/DeviceInstance', cfg.DEVICE_INSTANCE), ServiceSignal('/ProductName', product_name), ServiceSignal('/ProductId', cfg.PRODUCT_ID), ServiceSignal('/Connected', 1) ] def init_battery_signals(): # type: () -> Iterable[BatterySignal] read_voltage = read_float(register=999, scale_factor=0.01, offset=0) read_current = read_float(register=1000, scale_factor=0.01, offset=-10000) read_bus_voltage = read_float(register=1001, scale_factor=0.01, offset=0) read_led_amber = read_led_state(register=1004, led=LedColor.amber) read_led_green = read_led_state(register=1004, led=LedColor.green) read_led_blue = read_led_state(register=1004, led=LedColor.blue) read_led_red = read_led_state(register=1004, led=LedColor.red) read_center_heater_PWM = read_float(register=1018, scale_factor=0.1, offset=0) read_lateral_heater_PWM = read_float(register=1019, scale_factor=0.1, offset=0) read_center_temperature_celcius = read_float(register=1015, scale_factor=0.1, offset=-400) read_lateral1_temperature_celcius = read_float(register=1016, scale_factor=0.1, offset=-400) read_lateral2_temperature_celcius = read_float(register=1017, scale_factor=0.1, offset=-400) def read_total_power(status): # type: (BatteryStatus) -> int return int(read_current(status) * read_voltage(status)) def calculate_lateral_heater_power(status): # type: (BatteryStatus) -> int return round(read_lateral_heater_PWM(status) / 100 * (read_bus_voltage(status) ** 2) / cfg.R_HEATER_LATERAL, 2) def calculate_center_heater_power(status): # type: (BatteryStatus) -> int return round(read_center_heater_PWM(status) / 100 * (read_bus_voltage(status) ** 2) / cfg.R_HEATER_CENTER, 2) def calculate_heating_power(status): # type: (BatteryStatus) -> int return round(calculate_lateral_heater_power(status) + calculate_center_heater_power(status), 2) def calc_power_limit_imposed_by_voltage_limit(v, i, v_limit, r_int): # type: (float, float, float, float) -> float dv = v_limit - v di = dv / r_int p_limit = v_limit * (i + di) return p_limit def calc_power_limit_imposed_by_current_limit(v, i, i_limit, r_int): # type: (float, float, float, float) -> float di = i_limit - i dv = di * r_int p_limit = i_limit * (v + dv) return p_limit def calc_max_charge_power(bs): # type: (BatteryStatus) -> int b = bs.battery v = read_voltage(bs) i = read_current(bs) p_limits = [ calc_power_limit_imposed_by_voltage_limit(v, i, b.v_max, b.r_int_min), calc_power_limit_imposed_by_voltage_limit(v, i, b.v_max, b.r_int_max), calc_power_limit_imposed_by_current_limit(v, i, b.i_max, b.r_int_min), calc_power_limit_imposed_by_current_limit(v, i, b.i_max, b.r_int_max), ] p_limit = min(p_limits) # p_limit is normally positive here (signed) p_limit = max(p_limit, 0) # charge power must not become negative return int(p_limit) def calc_max_discharge_power(bs): # type: (BatteryStatus) -> float b = bs.battery v = read_voltage(bs) i = read_current(bs) p_limits = [ calc_power_limit_imposed_by_voltage_limit(v, i, b.v_min, b.r_int_min), calc_power_limit_imposed_by_voltage_limit(v, i, b.v_min, b.r_int_max), calc_power_limit_imposed_by_current_limit(v, i, -b.i_max, b.r_int_min), calc_power_limit_imposed_by_current_limit(v, i, -b.i_max, b.r_int_max), ] p_limit = max(p_limits) # p_limit is normally negative here (signed) p_limit = min(p_limit, 0) # discharge power must not become positive return int(-p_limit) # make unsigned! def calc_max_discharge_current(status): # type: (BatteryStatus) -> float soc = read_soc(status) if soc < 21: return 0 elif soc > 25: return -status.battery.i_max elif soc < 25: return ((soc-21)/25)*(-status.battery.i_max) def calc_max_charge_current(status): soc = read_soc(status) imax = status.battery.i_max if soc>21 or soc<20: return imax else: return (soc-20)*imax def read_battery_cold(status): return \ read_led_green(status) >= LedState.blinking_slow and \ read_led_blue(status) >= LedState.blinking_slow def read_soc(status): soc = read_float(register=1053, scale_factor=0.1, offset=0)(status) # if the SOC is 100 but EOC is not yet reached, report 99.9 instead of 100 if soc > 99.9 and not read_eoc_reached(status): return 99.9 if soc >= 99.9 and read_eoc_reached(status): return 100 return soc def read_eoc_reached(status): return \ read_led_green(status) == LedState.on and \ read_led_amber(status) == LedState.off and \ read_led_blue(status) == LedState.off return [ BatterySignal('/Dc/0/Voltage', mean, get_value=read_voltage, unit='V'), BatterySignal('/Dc/0/Current', sum, get_value=read_current, unit='A'), BatterySignal('/Dc/0/Power', sum, get_value=read_total_power, unit='W'), BatterySignal('/Dc/0/Temperature', mean, read_float(register=1003, scale_factor=0.1, offset=-400), unit='C'), BatterySignal('/Heating/Center/Power', sum, get_value=calculate_center_heater_power, unit='W'), BatterySignal('/Heating/Center/PWM', sum, get_value=read_center_heater_PWM, unit='%'), BatterySignal('/Heating/Lateral/Power', sum, get_value=calculate_lateral_heater_power, unit='W'), BatterySignal('/Heating/Lateral/PWM', sum, get_value=read_lateral_heater_PWM, unit='%'), BatterySignal('/Heating/Power', sum, get_value=calculate_heating_power, unit='W'), BatterySignal('/Temperature/Center', mean, get_value=read_center_temperature_celcius, unit='C'), BatterySignal('/Temperature/Lateral1', mean, get_value=read_lateral1_temperature_celcius, unit='C'), BatterySignal('/Temperature/Lateral2', mean, get_value=read_lateral2_temperature_celcius, unit='C'), BatterySignal('/BussVoltage', mean, read_float(register=1001, scale_factor=0.01, offset=0), unit='V'), BatterySignal('/Soc', mean, read_soc, unit='%'), BatterySignal('/NumberOfWarningFlags', sum, count_bits(base_register=1005, nb_of_registers=3, nb_of_bits=47)), BatterySignal('/WarningFlags/TaM1', any, read_bool(base_register=1005, bit=1)), BatterySignal('/WarningFlags/TbM1', any, read_bool(base_register=1005, bit=4)), BatterySignal('/WarningFlags/VBm1', any, read_bool(base_register=1005, bit=6)), BatterySignal('/WarningFlags/VBM1', any, read_bool(base_register=1005, bit=8)), BatterySignal('/WarningFlags/IDM1', any, read_bool(base_register=1005, bit=10)), BatterySignal('/WarningFlags/vsM1', any, read_bool(base_register=1005, bit=24)), BatterySignal('/WarningFlags/iCM1', any, read_bool(base_register=1005, bit=26)), BatterySignal('/WarningFlags/iDM1', any, read_bool(base_register=1005, bit=28)), BatterySignal('/WarningFlags/MID1', any, read_bool(base_register=1005, bit=30)), BatterySignal('/WarningFlags/BLPW', any, read_bool(base_register=1005, bit=32)), BatterySignal('/WarningFlags/Ah_W', any, read_bool(base_register=1005, bit=35)), BatterySignal('/WarningFlags/MPMM', any, read_bool(base_register=1005, bit=38)), BatterySignal('/WarningFlags/TCMM', any, read_bool(base_register=1005, bit=39)), BatterySignal('/WarningFlags/TCdi', any, read_bool(base_register=1005, bit=40)), BatterySignal('/WarningFlags/WMTO', any, read_bool(base_register=1005, bit=41)), BatterySignal('/WarningFlags/bit44', any, read_bool(base_register=1005, bit=44)), BatterySignal('/WarningFlags/CELL1', any, read_bool(base_register=1005, bit=46)), BatterySignal('/NumberOfAlarmFlags', sum, count_bits(base_register=1009, nb_of_registers=3, nb_of_bits=47)), BatterySignal('/AlarmFlags/Tam', any, read_bool(base_register=1009, bit=0)), BatterySignal('/AlarmFlags/TaM2', any, read_bool(base_register=1009, bit=2)), BatterySignal('/AlarmFlags/Tbm', any, read_bool(base_register=1009, bit=3)), BatterySignal('/AlarmFlags/TbM2', any, read_bool(base_register=1009, bit=5)), BatterySignal('/AlarmFlags/VBm2', any, read_bool(base_register=1009, bit=7)), BatterySignal('/AlarmFlags/IDM2', any, read_bool(base_register=1009, bit=11)), BatterySignal('/AlarmFlags/ISOB', any, read_bool(base_register=1009, bit=12)), BatterySignal('/AlarmFlags/MSWE', any, read_bool(base_register=1009, bit=13)), BatterySignal('/AlarmFlags/FUSE', any, read_bool(base_register=1009, bit=14)), BatterySignal('/AlarmFlags/HTRE', any, read_bool(base_register=1009, bit=15)), BatterySignal('/AlarmFlags/TCPE', any, read_bool(base_register=1009, bit=16)), BatterySignal('/AlarmFlags/STRE', any, read_bool(base_register=1009, bit=17)), BatterySignal('/AlarmFlags/CME', any, read_bool(base_register=1009, bit=18)), BatterySignal('/AlarmFlags/HWFL', any, read_bool(base_register=1009, bit=19)), BatterySignal('/AlarmFlags/HWEM', any, read_bool(base_register=1009, bit=20)), BatterySignal('/AlarmFlags/ThM', any, read_bool(base_register=1009, bit=21)), BatterySignal('/AlarmFlags/vsm1', any, read_bool(base_register=1009, bit=22)), BatterySignal('/AlarmFlags/vsm2', any, read_bool(base_register=1009, bit=23)), BatterySignal('/AlarmFlags/vsM2', any, read_bool(base_register=1009, bit=25)), BatterySignal('/AlarmFlags/iCM2', any, read_bool(base_register=1009, bit=27)), BatterySignal('/AlarmFlags/iDM2', any, read_bool(base_register=1009, bit=29)), BatterySignal('/AlarmFlags/MID2', any, read_bool(base_register=1009, bit=31)), BatterySignal('/AlarmFlags/CCBF', any, read_bool(base_register=1009, bit=33)), BatterySignal('/AlarmFlags/AhFL', any, read_bool(base_register=1009, bit=34)), BatterySignal('/AlarmFlags/TbCM', any, read_bool(base_register=1009, bit=36)), BatterySignal('/AlarmFlags/BRNF', any, read_bool(base_register=1009, bit=37)), BatterySignal('/AlarmFlags/HTFS', any, read_bool(base_register=1009, bit=42)), BatterySignal('/AlarmFlags/DATA', any, read_bool(base_register=1009, bit=43)), BatterySignal('/AlarmFlags/CELL2', any, read_bool(base_register=1009, bit=45)), BatterySignal('/LedStatus/Red', max, read_led_red), BatterySignal('/LedStatus/Blue', max, read_led_blue), BatterySignal('/LedStatus/Green', max, read_led_green), BatterySignal('/LedStatus/Amber', max, read_led_amber), BatterySignal('/IoStatus/ConnectedToDcBus', any, read_bool_inverted(base_register=1013, bit=0)), BatterySignal('/IoStatus/AlarmOutActive', any, read_bool(base_register=1013, bit=1)), BatterySignal('/IoStatus/InternalFanActive', any, read_bool(base_register=1013, bit=2)), BatterySignal('/IoStatus/VoltMeasurementAllowed', any, read_bool(base_register=1013, bit=3)), BatterySignal('/IoStatus/AuxRelay', any, read_bool(base_register=1013, bit=4)), BatterySignal('/IoStatus/RemoteState', any, read_bool(base_register=1013, bit=5)), BatterySignal('/IoStatus/HeaterOn', any, read_bool(base_register=1013, bit=6)), BatterySignal('/IoStatus/EocReached', min, read_eoc_reached), BatterySignal('/IoStatus/BatteryCold', any, read_battery_cold), BatterySignal('/Strings/1/Voltage', None, read_float(register=1020, scale_factor=0.01, offset=0), unit='V'), BatterySignal('/Strings/1/Current', None, read_float(register=1021, scale_factor=0.01, offset=-10000), unit='A'), BatterySignal('/Strings/1/PWM', None, read_float(register=1025, scale_factor=0.1, offset=0), unit='%'), BatterySignal('/Strings/2/Voltage', None, read_float(register=1026, scale_factor=0.01, offset=0), unit='V'), BatterySignal('/Strings/2/Current', None, read_float(register=1027, scale_factor=0.01, offset=-10000), unit='A'), BatterySignal('/Strings/2/PWM', None, read_float(register=1031, scale_factor=0.1, offset=0), unit='%'), BatterySignal('/Strings/3/Voltage', None, read_float(register=1032, scale_factor=0.01, offset=0), unit='V'), BatterySignal('/Strings/3/Current', None, read_float(register=1033, scale_factor=0.01, offset=-10000), unit='A'), BatterySignal('/Strings/3/PWM', None, read_float(register=1037, scale_factor=0.1, offset=0), unit='%'), BatterySignal('/Strings/4/Voltage', None, read_float(register=1038, scale_factor=0.01, offset=0), unit='V'), BatterySignal('/Strings/4/Current', None, read_float(register=1039, scale_factor=0.01, offset=-10000), unit='A'), BatterySignal('/Strings/4/PWM', None, read_float(register=1043, scale_factor=0.1, offset=0), unit='%'), BatterySignal('/Strings/5/Voltage', None, read_float(register=1044, scale_factor=0.01, offset=0), unit='V'), BatterySignal('/Strings/5/Current', None, read_float(register=1045, scale_factor=0.1, offset=-10000), unit='A'), BatterySignal('/Strings/5/PWM', None, read_float(register=1049, scale_factor=0.1, offset=0), unit='%'), # see protocol doc page 7 BatterySignal('/Info/MaxDischargeCurrent', sum, get_value= lambda bs: calc_max_discharge_current() , unit='A'), # legacy -bs.battery.i_max BatterySignal('/Info/MaxChargeCurrent', sum, get_value= lambda bs: calc_max_charge_current() , unit='A'), #legacy bs.battery.i_max BatterySignal('/Info/MaxChargeVoltage', min, lambda bs: bs.battery.v_max, unit='V'), BatterySignal('/Info/MinDischargeVoltage', max, lambda bs: bs.battery.v_min, unit='V'), BatterySignal('/Info/NumberOfStrings', sum, lambda bs: bs.battery.n_strings), BatterySignal('/Info/MaxChargePower', sum, calc_max_charge_power), BatterySignal('/Info/MaxDischargePower', sum, calc_max_discharge_power), BatterySignal('/FirmwareVersion', comma_separated, lambda bs: bs.battery.firmware_version), BatterySignal('/HardwareVersion', comma_separated, lambda bs: bs.battery.hardware_version), BatterySignal('/BmsVersion', comma_separated, lambda bs: bs.battery.bms_version) ]