276 lines
12 KiB
C++
276 lines
12 KiB
C++
/*
|
|
; Project: Open Vehicle Monitor System
|
|
; Date: 15th Apr 2022
|
|
;
|
|
; (C) 2022 Carsten Schmiemann
|
|
;
|
|
; Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
; of this software and associated documentation files (the "Software"), to deal
|
|
; in the Software without restriction, including without limitation the rights
|
|
; to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
; copies of the Software, and to permit persons to whom the Software is
|
|
; furnished to do so, subject to the following conditions:
|
|
;
|
|
; The above copyright notice and this permission notice shall be included in
|
|
; all copies or substantial portions of the Software.
|
|
;
|
|
; THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
; IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
; FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
|
; AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
; LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
; OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
|
; THE SOFTWARE.
|
|
*/
|
|
|
|
#include "vehicle_renaultzoe_ph2_obd.h"
|
|
|
|
void OvmsVehicleRenaultZoePh2OBD::IncomingEVC(uint16_t type, uint16_t pid, const char* data, uint16_t len) {
|
|
switch (pid) {
|
|
case 0x2006: { //Odometer (Total Vehicle Distance)
|
|
StandardMetrics.ms_v_pos_odometer->SetValue((float) CAN_UINT24(0), Kilometers);
|
|
//ESP_LOGD(TAG, "2006 EVC ms_v_pos_odometer: %d", CAN_UINT24(0));
|
|
break;
|
|
}
|
|
case 0x2003: { //Vehicle Speed
|
|
StandardMetrics.ms_v_pos_speed->SetValue((float) (CAN_UINT(0) * 0.01), KphPS);
|
|
//ESP_LOGD(TAG, "2003 EVC ms_v_pos_speed: %f", CAN_UINT(0) * 0.01);
|
|
break;
|
|
}
|
|
case 0x2005: { //12V Battery Voltage
|
|
StandardMetrics.ms_v_charge_12v_voltage->SetValue((float) (CAN_UINT(0) * 0.01), Volts);
|
|
//ESP_LOGD(TAG, "2005 EVC ms_v_charge_12v_voltage: %f", CAN_UINT(0) * 0.01);
|
|
break;
|
|
}
|
|
case 0x21CF: { //Inverter status --- Main switch for polling and driving state
|
|
//ESP_LOGD(TAG, "21CF EVC mt_inv_status: %d", CAN_NIBL(0));
|
|
if (CAN_NIBL(0) == 1) {
|
|
mt_inv_status->SetValue("Inverter off");
|
|
//StandardMetrics.ms_v_env_on->SetValue(false);
|
|
//StandardMetrics.ms_v_env_awake->SetValue(false);
|
|
} else if (CAN_NIBL(0) == 2) {
|
|
mt_inv_status->SetValue("Inverter on");
|
|
//StandardMetrics.ms_v_env_on->SetValue(true);
|
|
//StandardMetrics.ms_v_env_awake->SetValue(true);
|
|
StandardMetrics.ms_v_door_chargeport->SetValue(false);
|
|
} else if (CAN_NIBL(0) == 3) {
|
|
mt_inv_status->SetValue("Inverter decharging");
|
|
//StandardMetrics.ms_v_env_on->SetValue(false);
|
|
//StandardMetrics.ms_v_env_awake->SetValue(false);
|
|
} else if (CAN_NIBL(0) == 4) {
|
|
mt_inv_status->SetValue("Inverter alternator mode");
|
|
//StandardMetrics.ms_v_env_on->SetValue(false);
|
|
//StandardMetrics.ms_v_env_awake->SetValue(false);
|
|
} else if (CAN_NIBL(0) == 5) {
|
|
mt_inv_status->SetValue("Inverter ready to sleep");
|
|
//StandardMetrics.ms_v_env_on->SetValue(false);
|
|
//StandardMetrics.ms_v_env_awake->SetValue(false);
|
|
} else {
|
|
mt_inv_status->SetValue("Inverter state unknown");
|
|
}
|
|
break;
|
|
}
|
|
case 0x2218: { // Ambient temperature
|
|
StandardMetrics.ms_v_env_temp->SetValue((float) (CAN_UINT(0) * 0.1 - 273), Celcius);
|
|
//ESP_LOGD(TAG, "2218 EVC ms_v_env_temp: %f", (CAN_UINT(0) * 0.1 - 273));
|
|
break;
|
|
}
|
|
case 0x2A09: { // Power consumption by consumer
|
|
mt_bat_aux_power_consumer->SetValue((float) CAN_UINT(0) * 10, Watts);
|
|
//ESP_LOGD(TAG, "2A09 EVC mt_bat_aux_power_consumer: %d", CAN_UINT(0) * 10);
|
|
break;
|
|
}
|
|
case 0x2191: { // Power consumption by ptc
|
|
mt_bat_aux_power_ptc->SetValue((float) CAN_UINT(0) * 10, Watts);
|
|
//ESP_LOGD(TAG, "2191 EVC mt_bat_aux_power_ptc: %d", CAN_UINT(0) * 10);
|
|
break;
|
|
}
|
|
case 0x2B85: { // Charge plug preset
|
|
//ESP_LOGD(TAG, "2B85 EVC Charge plug present: %d", CAN_NIBL(0));
|
|
if (CAN_NIBL(0) == 1) {
|
|
StandardMetrics.ms_v_charge_pilot->SetValue(true);
|
|
if (!CarPluggedIn) {
|
|
ESP_LOGI(TAG, "Charge cable plugged in");
|
|
CarPluggedIn = true;
|
|
}
|
|
}
|
|
if (CAN_NIBL(0) == 0) {
|
|
StandardMetrics.ms_v_charge_pilot->SetValue(false);
|
|
if (CarPluggedIn) {
|
|
ESP_LOGI(TAG, "Charge cable plugged out");
|
|
CarPluggedIn = false;
|
|
StandardMetrics.ms_v_door_chargeport->SetValue(false);
|
|
}
|
|
}
|
|
break;
|
|
}
|
|
case 0x2B6D: { // Charge MMI States, will be polled every 30s even car is off, because free frames are unreliable
|
|
//ESP_LOGD(TAG, "2B6D Charge MMI States RAW: %d", CAN_NIBL(0));
|
|
if (CAN_NIBL(0) == 0) {
|
|
StandardMetrics.ms_v_charge_state->SetValue("stopped");
|
|
StandardMetrics.ms_v_charge_substate->SetValue("stopped");
|
|
StandardMetrics.ms_v_charge_inprogress->SetValue(false);
|
|
//ESP_LOGD(TAG, "2B6D Charge MMI States : No Charge");
|
|
}
|
|
if (CAN_NIBL(0) == 1) {
|
|
StandardMetrics.ms_v_charge_state->SetValue("timerwait");
|
|
StandardMetrics.ms_v_charge_substate->SetValue("timerwait");
|
|
//ESP_LOGD(TAG, "2B6D Charge MMI States : Waiting for a planned charge");
|
|
}
|
|
if (CAN_NIBL(0) == 2) {
|
|
StandardMetrics.ms_v_charge_state->SetValue("done");
|
|
StandardMetrics.ms_v_charge_substate->SetValue("stopped");
|
|
StandardMetrics.ms_v_charge_inprogress->SetValue(false);
|
|
//ESP_LOGD(TAG, "2B6D Charge MMI States : Ended charge");
|
|
}
|
|
if (CAN_NIBL(0) == 3) {
|
|
StandardMetrics.ms_v_charge_state->SetValue("charging");
|
|
StandardMetrics.ms_v_charge_substate->SetValue("onrequest");
|
|
StandardMetrics.ms_v_charge_inprogress->SetValue(true);
|
|
//ESP_LOGD(TAG, "2B6D Charge MMI States : Charge in progress");
|
|
}
|
|
if (CAN_NIBL(0) == 4) {
|
|
StandardMetrics.ms_v_charge_state->SetValue("stopped");
|
|
StandardMetrics.ms_v_charge_substate->SetValue("interrupted");
|
|
StandardMetrics.ms_v_charge_inprogress->SetValue(false);
|
|
//ESP_LOGD(TAG, "2B6D Charge MMI States : Charge failure");
|
|
}
|
|
if (CAN_NIBL(0) == 5) {
|
|
StandardMetrics.ms_v_charge_state->SetValue("stopped");
|
|
StandardMetrics.ms_v_charge_substate->SetValue("powerwait");
|
|
StandardMetrics.ms_v_charge_inprogress->SetValue(false);
|
|
//ESP_LOGD(TAG, "2B6D Charge MMI States : Waiting for current charge");
|
|
}
|
|
if (CAN_NIBL(0) == 6) {
|
|
StandardMetrics.ms_v_door_chargeport->SetValue(true);
|
|
//ESP_LOGD(TAG, "2B6D Charge MMI States : Chargeport opened");
|
|
ESP_LOGI(TAG, "Chargedoor opened");
|
|
}
|
|
if (CAN_NIBL(0) == 8) {
|
|
StandardMetrics.ms_v_charge_state->SetValue("prepare");
|
|
StandardMetrics.ms_v_charge_substate->SetValue("powerwait");
|
|
StandardMetrics.ms_v_charge_inprogress->SetValue(false);
|
|
//ESP_LOGD(TAG, "2B6D Charge MMI States : Charge preparation");
|
|
}
|
|
if (!mt_bus_awake->AsBool()) {
|
|
ZoeWakeUp();
|
|
}
|
|
break;
|
|
}
|
|
case 0x2B7A: { // Charge type
|
|
//ESP_LOGD(TAG, "2B7A EVC Charge type: %d", (CAN_NIBL(0)));
|
|
if (CAN_NIBL(0) == 0) {
|
|
StandardMetrics.ms_v_charge_type->SetValue("undefined");
|
|
}
|
|
if (CAN_NIBL(0) == 1 || CAN_NIBL(0) == 2) {
|
|
StandardMetrics.ms_v_charge_type->SetValue("type2");
|
|
StandardMetrics.ms_v_charge_mode->SetValue("standard");
|
|
}
|
|
if (CAN_NIBL(0) == 3) {
|
|
StandardMetrics.ms_v_charge_type->SetValue("chademo");
|
|
StandardMetrics.ms_v_charge_mode->SetValue("performance");
|
|
}
|
|
if (CAN_NIBL(0) == 4) {
|
|
StandardMetrics.ms_v_charge_type->SetValue("ccs");
|
|
StandardMetrics.ms_v_charge_mode->SetValue("performance");
|
|
}
|
|
break;
|
|
}
|
|
case 0x3064: { // Motor rpm
|
|
StandardMetrics.ms_v_mot_rpm->SetValue((float) (CAN_UINT(0)));
|
|
//ESP_LOGD(TAG, "3064 EVC ms_v_mot_rpm: %d", (CAN_UINT(0)));
|
|
break;
|
|
}
|
|
case 0x300F: { // AC charging power available
|
|
mt_main_power_available->SetValue((float) (CAN_UINT(0) * 0.025), kW);
|
|
//ESP_LOGD(TAG, "300F EVC mt_main_power_available: %f", (CAN_UINT(0) * 0.025));
|
|
break;
|
|
}
|
|
case 0x300D: { // AC input current
|
|
StandardMetrics.ms_v_charge_current->SetValue((float) (CAN_UINT(0) * 0.1), Amps);
|
|
//Power factor measured with a Janitza UMG512 Class A power analyser to get more precision
|
|
//Only three phases measurement at the moment
|
|
if (StandardMetrics.ms_v_charge_current->AsFloat() > 19.0f) {
|
|
ACInputPowerFactor = 1.0;
|
|
} else if (StandardMetrics.ms_v_charge_current->AsFloat() > 18.0f) {
|
|
ACInputPowerFactor = 0.997;
|
|
} else if (StandardMetrics.ms_v_charge_current->AsFloat() > 17.0f) {
|
|
ACInputPowerFactor = 0.99;
|
|
} else if (StandardMetrics.ms_v_charge_current->AsFloat() > 16.0f) {
|
|
ACInputPowerFactor = 0.978;
|
|
} else if (StandardMetrics.ms_v_charge_current->AsFloat() > 15.0f) {
|
|
ACInputPowerFactor = 0.948;
|
|
} else if (StandardMetrics.ms_v_charge_current->AsFloat() > 14.0f) {
|
|
ACInputPowerFactor = 0.931;
|
|
} else if (StandardMetrics.ms_v_charge_current->AsFloat() > 13.0f) {
|
|
ACInputPowerFactor = 0.916;
|
|
} else if (StandardMetrics.ms_v_charge_current->AsFloat() > 12.0f) {
|
|
ACInputPowerFactor = 0.902;
|
|
} else if (StandardMetrics.ms_v_charge_current->AsFloat() > 11.0f) {
|
|
ACInputPowerFactor = 0.888;
|
|
} else if (StandardMetrics.ms_v_charge_current->AsFloat() > 10.0f) {
|
|
ACInputPowerFactor = 0.905;
|
|
} else if (StandardMetrics.ms_v_charge_current->AsFloat() > 9.0f) {
|
|
ACInputPowerFactor = 0.929;
|
|
} else if (StandardMetrics.ms_v_charge_current->AsFloat() > 8.0f) {
|
|
ACInputPowerFactor = 0.901;
|
|
} else if (StandardMetrics.ms_v_charge_current->AsFloat() > 7.0f) {
|
|
ACInputPowerFactor = 0.775;
|
|
} else if (StandardMetrics.ms_v_charge_current->AsFloat() < 6.0f && StandardMetrics.ms_v_charge_inprogress->AsBool(false)) {
|
|
ACInputPowerFactor = 0.05;
|
|
}
|
|
if (StandardMetrics.ms_v_charge_type->AsString() == "type2" && mt_main_phases_num->AsFloat() == 3 && StandardMetrics.ms_v_charge_inprogress->AsBool(false)) {
|
|
StandardMetrics.ms_v_charge_power->SetValue((StandardMetrics.ms_v_charge_current->AsFloat() * StandardMetrics.ms_v_charge_voltage->AsFloat() * ACInputPowerFactor * 1.732f) * 0.001, kW);
|
|
} else if (StandardMetrics.ms_v_charge_type->AsString() == "type2" && (mt_main_phases_num->AsFloat() == 2 || mt_main_phases_num->AsFloat() == 1)) {
|
|
StandardMetrics.ms_v_charge_power->SetValue((StandardMetrics.ms_v_charge_current->AsFloat() * StandardMetrics.ms_v_charge_voltage->AsFloat() * ACInputPowerFactor) * 0.001, kW);
|
|
} else if (StandardMetrics.ms_v_charge_type->AsString() == "type2") {
|
|
StandardMetrics.ms_v_charge_power->SetValue(0);
|
|
}
|
|
//ESP_LOGD(TAG, "300D EVC mt_main_current: %f", (CAN_UINT(0) * 0.1));
|
|
break;
|
|
}
|
|
case 0x300B: { // AC phases used
|
|
//ESP_LOGD(TAG, "300B EVC mt_main_phases: %d", (CAN_NIBL(0)));
|
|
if (CAN_NIBL(0) == 0) {
|
|
mt_main_phases->SetValue("one phase");
|
|
mt_main_phases_num->SetValue(1);
|
|
}
|
|
if (CAN_NIBL(0) == 1) {
|
|
mt_main_phases->SetValue("two phase");
|
|
mt_main_phases_num->SetValue(2);
|
|
}
|
|
if (CAN_NIBL(0) == 2) {
|
|
mt_main_phases->SetValue("three phase");
|
|
mt_main_phases_num->SetValue(3);
|
|
}
|
|
if (CAN_NIBL(0) == 3) {
|
|
mt_main_phases->SetValue("not detected");
|
|
mt_main_phases_num->SetValue(0);
|
|
}
|
|
break;
|
|
}
|
|
case 0x2B8A: { // AC mains voltage
|
|
StandardMetrics.ms_v_charge_voltage->SetValue((float) (CAN_UINT(0) * 0.5), Volts);
|
|
//ESP_LOGD(TAG, "2B8A EVC ms_v_charge_voltage: %f", (CAN_UINT(0) * 0.5));
|
|
break;
|
|
}
|
|
case 0x21CD: { // User SOC
|
|
mt_bat_user_soc->SetValue((float) (CAN_UINT(0)), Percentage);
|
|
//ESP_LOGD(TAG, "21CD EVC mt_bat_user_soc: %f", (float) CAN_UINT(0));
|
|
break;
|
|
}
|
|
|
|
default: {
|
|
char *buf = NULL;
|
|
size_t rlen = len, offset = 0;
|
|
do {
|
|
rlen = FormatHexDump(&buf, data + offset, rlen, 16);
|
|
offset += 16;
|
|
ESP_LOGW(TAG, "OBD2: unhandled reply from EVC [%02x %02x]: %s", type, pid, buf ? buf : "-");
|
|
} while (rlen);
|
|
if (buf)
|
|
free(buf);
|
|
break;
|
|
}
|
|
}
|
|
} |