OVMS3/OVMS.V3/components/vehicle_renaultzoe_ph2_can/src/ph2_commands.cpp

/*
;    Project:       Open Vehicle Monitor System
;    Date:          19th Nov 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 "ovms_log.h"

#include <stdio.h>
#include <string>
#include <iomanip>
#include "pcp.h"
#include "ovms_metrics.h"
#include "ovms_events.h"
#include "ovms_config.h"
#include "ovms_command.h"
#include "metrics_standard.h"
#include "ovms_notify.h"
#include "ovms_peripherals.h"
#include "ovms_netmanager.h"

#include "vehicle_renaultzoe_ph2_can.h"
#include "ph2_poller.h"

void OvmsVehicleRenaultZoePh2CAN::CanInit()
{
  OvmsCommand* cmd;
  OvmsCommand* ph2;
  ph2 = cmd_zoe_ph2->RegisterCommand("ph2", "Zoe Ph2 CAN tools");
  cmd = ph2->RegisterCommand("request", "Send ISO-TP request, output response");
  cmd->RegisterCommand("device", "Send ISO-TP request to a ECU", shell_can_request, "<txid> <rxid> <request>", 3, 3);
  cmd->RegisterCommand("broadcast", "Send ISO-TP request as broadcast", shell_can_request, "<request>", 1, 1);
}

int OvmsVehicleRenaultZoePh2CAN::CanRequest(uint16_t txid, uint16_t rxid, string request, string& response, int timeout_ms /*=3000*/)
{
  OvmsMutexLock lock(&zoe_can1_request);

  // prepare single poll:
  OvmsVehicle::poll_pid_t poll[] = {
    { txid, rxid, 0, 0, { 1, 1, 1 }, 0, ISOTP_STD },
    POLL_LIST_END
  };

  assert(request.size() > 0);
  poll[0].type = request[0];

  if (POLL_TYPE_HAS_16BIT_PID(poll[0].type)) {
    assert(request.size() >= 3);
    poll[0].args.pid = request[1] << 8 | request[2];
    poll[0].args.datalen = LIMIT_MAX(request.size()-3, sizeof(poll[0].args.data));
    memcpy(poll[0].args.data, request.data()+3, poll[0].args.datalen);
  }
  else if (POLL_TYPE_HAS_8BIT_PID(poll[0].type)) {
    assert(request.size() >= 2);
    poll[0].args.pid = request.at(1);
    poll[0].args.datalen = LIMIT_MAX(request.size()-2, sizeof(poll[0].args.data));
    memcpy(poll[0].args.data, request.data()+2, poll[0].args.datalen);
  }
  else {
    poll[0].args.pid = 0;
    poll[0].args.datalen = LIMIT_MAX(request.size()-1, sizeof(poll[0].args.data));
    memcpy(poll[0].args.data, request.data()+1, poll[0].args.datalen);
  }

  // stop default polling:
  PollSetPidList(m_can1, NULL);
  vTaskDelay(pdMS_TO_TICKS(100));

  // clear rx semaphore, start single poll:
  zoe_can1_rxwait.Take(0);
  PollSetPidList(m_can1, poll);

  // wait for response:
  bool rxok = zoe_can1_rxwait.Take(pdMS_TO_TICKS(timeout_ms));
  if (rxok == pdTRUE)
    response = zoe_can1_rxbuf;

  // restore default polling:
  zoe_can1_rxwait.Give();
  PollSetPidList(m_can1, renault_zoe_polls);

  return (rxok == pdFALSE) ? -1 : (int)zoe_can1_rxerr;
}

void OvmsVehicleRenaultZoePh2CAN::shell_can_request(int verbosity, OvmsWriter* writer, OvmsCommand* cmd, int argc, const char* const* argv)
{
  OvmsVehicleRenaultZoePh2CAN* zoe_ph2_can = GetInstance(writer);
  uint16_t txid = 0, rxid = 0;
  string request;
  string response;

  // parse args:
  string device = cmd->GetName();
  if (device == "device") {
    if (argc < 3) {
      writer->puts("ERROR: too few args, need: txid rxid request");
      return;
    }
    txid = strtol(argv[0], NULL, 16);
    rxid = strtol(argv[1], NULL, 16);
    request = hexdecode(argv[2]);
  } else {
    if (argc < 1) {
      writer->puts("ERROR: too few args, need: request");
      return;
    }
    request = hexdecode(argv[0]);
    // "broadcast"
      txid = 0x7df;
      rxid = 0;
    }

  // validate request:
  if (request.size() == 0) {
    writer->puts("ERROR: no request");
    return;
  } else {
    uint8_t type = request.at(0);
    if ((POLL_TYPE_HAS_16BIT_PID(type) && request.size() < 3) ||
        (POLL_TYPE_HAS_8BIT_PID(type) && request.size() < 2)) {
      writer->printf("ERROR: request too short for type %02X\n", type);
      return;
    }
  }

  // execute request:
  int err = zoe_ph2_can->CanRequest(txid, rxid, request, response, 3000);
  if (err == -1) {
    writer->puts("ERROR: timeout waiting for response");
    return;
  } else if (err) {
    writer->printf("ERROR: request failed with response error code %02X\n", err);
    return;
  }

  // output response as hex dump:
  writer->puts("Response:");
  char *buf = NULL;
  size_t rlen = response.size(), offset = 0;
  do {
    rlen = FormatHexDump(&buf, response.data() + offset, rlen, 16);
    offset += 16;
    writer->puts(buf ? buf : "-");
  } while (rlen);
  if (buf)
    free(buf);
}

OvmsVehicle::vehicle_command_t OvmsVehicleRenaultZoePh2CAN::CommandPreHeat(bool climatecontrolon) {
    
    //Wake Up Packet
    uint8_t data[8] = {0x83, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
    
    canbus *obd;
    obd = m_can1;
    
    for (int i=0; i<40; i++)
    {
      obd->WriteStandard(0x55C, 8, data);
    }
    obd->WriteStandard(0x6f9, 8, data);
    data[0] = 0x40;
    data[1] = 0x80;

    vTaskDelay(50 / portTICK_PERIOD_MS);
    obd->WriteStandard(0x43c, 8, data);

    data = {0xe4, 0x64, 0x70, 0x00, 0x28, 0x84, 0x07, 0x10};
    obd->WriteStandard(0x46f, 8, data);

    data = {0x84, 0xc7, 0x07, 0x55, 0xe0, 0x0d, 0x00, 0xc4};
    obd->WriteStandard(0x47d, 8, data);

    data = {0x03, 0x20, 0x40, 0x00, 0x00, 0x00, 0x00, 0x00};
    obd->WriteStandard(0x46a, 8, data);

    data = {0x03, 0x02, 0x04, 0x02, 0x06, 0x00, 0x20, 0x08};
    obd->WriteStandard(0x46c, 8, data);

    data = {0x10, 0xc9, 0x50, 0x21, 0x01, 0x20, 0x00, 0x00};
    obd->WriteStandard(0x482, 8, data);

    data = {0x00, 0x00, 0x00, 0x55, 0x00, 0x00, 0x00, 0x00};
    obd->WriteStandard(0x5b1, 8, data);

    data = {0xff, 0xff, 0xff, 0xff, 0x01, 0x00, 0x00, 0x00};
    obd->WriteStandard(0x5ba, 8, data);

    return Success;
}

OvmsVehicle::vehicle_command_t OvmsVehicleRenaultZoePh2CAN::CommandWakeup() {
    ESP_LOGI(TAG, "Send Wakeup Command");

    vTaskDelay(500 / portTICK_PERIOD_MS);

    uint32_t txid = 0x747, rxid = 0x767; //IVI
    uint8_t protocol = ISOTP_STD;
    int timeout_ms = 100;
    std::string request;
    std::string response;
    
    request = hexdecode("2F90090301");
    int err = PollSingleRequest(m_can1, txid, rxid, request, response, timeout_ms, protocol);
    
    request = hexdecode("2F900900");
    err = PollSingleRequest(m_can1, txid, rxid, request, response, timeout_ms, protocol);

    if (err == POLLSINGLE_TXFAILURE) {
      ESP_LOGE(TAG, "ERROR: transmission failure (CAN bus error)");
      return Fail;
    }
    else if (err < 0) {
      ESP_LOGD(TAG, "ERROR: timeout waiting for poller/response");
      return Fail;
    }
    else if (err) {
      ESP_LOGD(TAG, "ERROR: request failed with response error code %02X\n", err);
      return Fail;
    }
    
    return Success;
}

OvmsVehicle::vehicle_command_t OvmsVehicleRenaultZoePh2CAN::CommandLock(const char* pin) {
    //ToDo: Sniff HFM/BCM packets
    return NotImplemented;
}

OvmsVehicle::vehicle_command_t OvmsVehicleRenaultZoePh2CAN::CommandUnlock(const char* pin) {
    //ToDo: Sniff HFM/BCM packets
    return NotImplemented;
}