/*
;    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.h"

void OvmsVehicleRenaultZoePh2::IncomingBCM(uint16_t type, uint16_t pid, const char* data, uint16_t len) {  
  switch (pid) {
    case 0x4204: {  // TPMS pressure - front left
      StandardMetrics.ms_v_tpms_pressure->SetElemValue(MS_V_TPMS_IDX_FL, (float)CAN_UINT(0) * 7.5 / 10, kPa);
      ESP_LOGD(TAG, "4204 BCM tpms pressure FL: %f", CAN_UINT(0) * 7.5);
      break;
    }
    case 0x4205: {  // TPMS pressure - front right
      StandardMetrics.ms_v_tpms_pressure->SetElemValue(MS_V_TPMS_IDX_FR, (float)CAN_UINT(0) * 7.5 / 10, kPa);
      ESP_LOGD(TAG, "4205 BCM tpms pressure FR: %f", CAN_UINT(0) * 7.5);
      break;
    }
    case 0x4206: {  // TPMS pressure - rear left
      StandardMetrics.ms_v_tpms_pressure->SetElemValue(MS_V_TPMS_IDX_RL, (float)CAN_UINT(0) * 7.5 / 10, kPa);
      ESP_LOGD(TAG, "4206 BCM tpms pressure RL: %f", CAN_UINT(0) * 7.5);
      break;
    }
    case 0x4207: {  // TPMS pressure - rear right
      StandardMetrics.ms_v_tpms_pressure->SetElemValue(MS_V_TPMS_IDX_RR, (float)CAN_UINT(0) * 7.5 / 10, kPa);
      ESP_LOGD(TAG, "4207 BCM tpms pressure RR: %f", CAN_UINT(0) * 7.5);
      break;
    }
    case 0x420C: {  // TPMS temp - front left
      StandardMetrics.ms_v_tpms_temp->SetElemValue(MS_V_TPMS_IDX_FL, (float)(CAN_UINT(0) - 30) * 0.001, Celcius);
      ESP_LOGD(TAG, "420C BCM tpms temp FL: %f", (CAN_UINT(0) - 30) * 0.001);
      break;
    }
    case 0x420D: {  // TPMS temp - front right
      StandardMetrics.ms_v_tpms_temp->SetElemValue(MS_V_TPMS_IDX_FR, (float)(CAN_UINT(0) - 30) * 0.001, Celcius);
      ESP_LOGD(TAG, "420D BCM tpms temp FR: %f", (CAN_UINT(0) - 30) * 0.001);
      break;
    }
    case 0x420E: {  // TPMS temp - rear left
      StandardMetrics.ms_v_tpms_temp->SetElemValue(MS_V_TPMS_IDX_RL, (float)(CAN_UINT(0) - 30) * 0.001, Celcius);
      ESP_LOGD(TAG, "420E BCM tpms temp RL: %f", (CAN_UINT(0) - 30) * 0.001);
      break;
    }
    case 0x420F: {  // TPMS temp - rear right
      StandardMetrics.ms_v_tpms_temp->SetElemValue(MS_V_TPMS_IDX_RR, (float)(CAN_UINT(0) - 30) * 0.001, Celcius);
      ESP_LOGD(TAG, "420F BCM tpms temp RR: %f", (CAN_UINT(0) - 30) * 0.001);
      break;
    }
    case 0x4109: {  // TPMS alert - front left
      if (CAN_NIBL(0) == 0) {
        StandardMetrics.ms_v_tpms_alert->SetElemValue(MS_V_TPMS_IDX_FL, 0);
      }
      if (CAN_NIBL(0) == 1 || CAN_NIBL(0) == 3 || CAN_NIBL(0) == 5 || CAN_NIBL(0) == 7) {
        StandardMetrics.ms_v_tpms_alert->SetElemValue(MS_V_TPMS_IDX_FL, 2);
      }
      if (CAN_NIBL(0) == 2 || CAN_NIBL(0) == 4 || CAN_NIBL(0) == 6 ) {
        StandardMetrics.ms_v_tpms_alert->SetElemValue(MS_V_TPMS_IDX_FL, 1);
      }
      ESP_LOGD(TAG, "40FF BCM tpms alert FL: %d", CAN_NIBL(0));
      break;
    }
    case 0x410A: {  // TPMS alert - front right
      if (CAN_NIBL(0) == 0) {
        StandardMetrics.ms_v_tpms_alert->SetElemValue(MS_V_TPMS_IDX_FR, 0);
      }
      if (CAN_NIBL(0) == 1 || CAN_NIBL(0) == 3 || CAN_NIBL(0) == 5 || CAN_NIBL(0) == 7) {
        StandardMetrics.ms_v_tpms_alert->SetElemValue(MS_V_TPMS_IDX_FR, 2);
      }
      if (CAN_NIBL(0) == 2 || CAN_NIBL(0) == 4 || CAN_NIBL(0) == 6 ) {
        StandardMetrics.ms_v_tpms_alert->SetElemValue(MS_V_TPMS_IDX_FR, 1);
      }
      ESP_LOGD(TAG, "40FF BCM tpms alert FR: %d", CAN_NIBL(0));
      break;
    }
    case 0x410B: {  // TPMS alert - rear left
      if (CAN_NIBL(0) == 0) {
        StandardMetrics.ms_v_tpms_alert->SetElemValue(MS_V_TPMS_IDX_RL, 0);
      }
      if (CAN_NIBL(0) == 1 || CAN_NIBL(0) == 3 || CAN_NIBL(0) == 5 || CAN_NIBL(0) == 7) {
        StandardMetrics.ms_v_tpms_alert->SetElemValue(MS_V_TPMS_IDX_RL, 2);
      }
      if (CAN_NIBL(0) == 2 || CAN_NIBL(0) == 4 || CAN_NIBL(0) == 6 ) {
        StandardMetrics.ms_v_tpms_alert->SetElemValue(MS_V_TPMS_IDX_RL, 1);
      }
      ESP_LOGD(TAG, "40FF BCM tpms alert RL: %d", CAN_NIBL(0));
      break;
    }
    case 0x410C: {  // TPMS alert - rear right
      if (CAN_NIBL(0) == 0) {
        StandardMetrics.ms_v_tpms_alert->SetElemValue(MS_V_TPMS_IDX_RR, 0);
      }
      if (CAN_NIBL(0) == 1 || CAN_NIBL(0) == 3 || CAN_NIBL(0) == 5 || CAN_NIBL(0) == 7) {
        StandardMetrics.ms_v_tpms_alert->SetElemValue(MS_V_TPMS_IDX_RR, 2);
      }
      if (CAN_NIBL(0) == 2 || CAN_NIBL(0) == 4 || CAN_NIBL(0) == 6 ) {
        StandardMetrics.ms_v_tpms_alert->SetElemValue(MS_V_TPMS_IDX_RR, 1);
      }
      ESP_LOGD(TAG, "40FF BCM tpms alert RR: %d", CAN_NIBL(0));
      break;
    }
    case 0x608E: {  //Vehicle running aka ignition
      //reliability test needed
      ESP_LOGD(TAG, "608E BCM Vehicle running: %d", CAN_NIBL(0));
      break;
    }
    case 0x8004: {  //Car secure aka vehicle locked 
      StandardMetrics.ms_v_env_locked->SetValue((bool)CAN_NIBL(0));
      ESP_LOGD(TAG, "%d Car Secure S: %d", pid, CAN_NIBL(0));
      break;
    }
    case 0x6026: {  //Front left door
      StandardMetrics.ms_v_door_fl->SetValue((bool)CAN_NIBL(0));
      ESP_LOGD(TAG, "%d Front left door: %d", pid, CAN_NIBL(0));
      break;
    }
    case 0x6027: {  //Front right door
      StandardMetrics.ms_v_door_fr->SetValue((bool)CAN_NIBL(0));
      ESP_LOGD(TAG, "%d Front right door: %d", pid, CAN_NIBL(0));
      break;
    }
    case 0x61B2: {  //Rear left door
      StandardMetrics.ms_v_door_rl->SetValue((bool)CAN_NIBL(0));
      ESP_LOGD(TAG, "%d Rear left door: %d", pid, CAN_NIBL(0));
      break;
    }
    case 0x61B3: {  //Rear right door
      StandardMetrics.ms_v_door_rr->SetValue((bool)CAN_NIBL(0));
      ESP_LOGD(TAG, "%d Rear right door: %d", pid, CAN_NIBL(0));
      break;
    }
    case 0x609B: {  //Tailgate
      StandardMetrics.ms_v_door_trunk->SetValue((bool)CAN_NIBL(0));
      ESP_LOGD(TAG, "%d Tailgate: %d", pid, CAN_NIBL(0));
      break;
    }
    case 0x0495: {  //Hood
      StandardMetrics.ms_v_door_hood->SetValue((bool)CAN_NIBL(0));
      ESP_LOGD(TAG, "%d Hood: %d", pid, CAN_NIBL(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 BCM [%02x %02x]: %s", type, pid, buf ? buf : "-");
      } while (rlen);
      if (buf)
        free(buf);
      break;
    }
  }
}