csu3_am335x/EVSE/Projects/DM30/Apps/Ev_Comm.c

#include "Module_EvComm.h"
#include <linux/can.h>
#include <linux/can/raw.h>
#include <string.h>
#include <stdio.h>      /*標準輸入輸出定義*/
#include <stdlib.h>     /*標準函數庫定義*/
#include <unistd.h>     /*Unix 標準函數定義*/
#include <fcntl.h>      /*檔控制定義*/
#include <termios.h>    /*PPSIX 終端控制定義*/
#include <errno.h>      /*錯誤號定義*/

//================================================
//================================================
// CANBUS send cmd
//================================================
//================================================

int PackageIdCmd(int cmd)
{
    return cmd | 0x80000000;
}

void SendCmdToEvboard(int cmd, byte *data, byte dataLen)
{
    struct can_frame frame;

    frame.can_id = cmd;
    frame.can_dlc = dataLen;
    memcpy(frame.data, data, sizeof(frame.data));

    write(CanFd, &frame, sizeof(struct can_frame));
}

void SetTargetAddr(byte *target_number, byte index)
{
    int id = PackageIdCmd(Ev_Cmd.address_assignment + index);
    //printf("intCmd = %x \n", cmd & CAN_EFF_MASK);
    //cmd = cmd & CAN_EFF_MASK;

    byte data[8];

    data[0] = *target_number;
    data[1] = *(target_number + 1);
    data[2] = *(target_number + 2);
    data[3] = *(target_number + 3);
    data[4] = index;

    SendCmdToEvboard(id, data, 5);
}

void GetFirmwareVersion(byte gun_index, byte toId)
{
    int id = PackageIdCmd(Ev_Cmd.get_firmware_ver + toId);
    byte data[8];

    SendCmdToEvboard(id, data, 0);
}

void SyncRtcInfo(byte gun_index, byte toId, int epoch)
{
    int id = PackageIdCmd(Ev_Cmd.sync_rtc_info + toId);
    byte data[8];

    data[0] = epoch & 0xff;
    data[1] = (epoch >> 8) & 0xff;
    data[2] = (epoch >> 16) & 0xff;
    data[3] = (epoch >> 24) & 0xff;

    SendCmdToEvboard(id, data, 4);
}

void GetHardwareVersion(byte gun_index, byte toId)
{
    int id = PackageIdCmd(Ev_Cmd.get_hardware_ver + toId);
    byte data[8];

    SendCmdToEvboard(id, data, 0);
}

void SetChargingPermission(byte gun_index, byte permissionStatus, short aOutputPw, short aOutputCur, short aOutputVol, byte toId)
{
    int id = PackageIdCmd(Ev_Cmd.charging_permission + toId);
    byte data[8];

    data[0] = permissionStatus;
    data[1] = aOutputPw & 0xff;
    data[2] = (aOutputPw >> 8) & 0xff;
    data[3] = aOutputCur & 0xff;
    data[4] = (aOutputCur >> 8) & 0xff;
    data[5] = aOutputVol & 0xff;
    data[6] = (aOutputVol >> 8) & 0xff;
    data[7] = 0xff;

    SendCmdToEvboard(id, data, sizeof(data));
}

void SetPresentOutputPower(short outputVol_b1, short outputCur_b1, short outputVol_b2, short outputCur_b2)
{
    int id = PackageIdCmd(Ev_Cmd.present_output_power);
    byte data[8];

    data[0] = outputVol_b1 & 0xff;
    data[1] = (outputVol_b1 >> 8) & 0xff;
    data[2] = outputCur_b1 & 0xff;
    data[3] = (outputCur_b1 >> 8) & 0xff;
    data[4] = outputVol_b2 & 0xff;
    data[5] = (outputVol_b2 >> 8) & 0xff;
    data[6] = outputCur_b2 & 0xff;
    data[7] = (outputCur_b2 >> 8) & 0xff;

    SendCmdToEvboard(id, data, 8);
}

void SetPresentOutputCapacity(short aOutputPw_b1, short aOutputCur_b1, short aOutputPw_b2, short aOutputCur_b2)
{
    int id = PackageIdCmd(Ev_Cmd.present_output_cap);
    byte data[8];

    data[0] = aOutputPw_b1 & 0xff;
    data[1] = (aOutputPw_b1 >> 8) & 0xff;
    data[2] = aOutputCur_b1 & 0xff;
    data[3] = (aOutputCur_b1 >> 8) & 0xff;
    data[4] = aOutputPw_b2 & 0xff;
    data[5] = (aOutputPw_b2 >> 8) & 0xff;
    data[6] = aOutputCur_b2 & 0xff;
    data[7] = (aOutputCur_b2 >> 8) & 0xff;

    SendCmdToEvboard(id, data, 8);
}

void GetOutputReq(byte gun_index, byte toId)
{
    int id = PackageIdCmd(Ev_Cmd.get_output_req + toId);
    byte data[8];

    SendCmdToEvboard(id, data, 0);
}

void GetEvBatteryInfo(byte gun_index, byte toId)
{
    int id = PackageIdCmd(Ev_Cmd.get_battery_info + toId);
    byte data[8];

    SendCmdToEvboard(id, data, 0);
}

void EvseStopChargingEvent(byte stopResult, byte *stopReason, byte toId)
{
    int id = PackageIdCmd(Ev_Cmd.evse_stop_charging + toId);
    byte data[8];

    data[0] = stopResult;
    data[1] = *stopReason;
    data[2] = *(stopReason + 1);
    data[3] = *(stopReason + 2);
    data[4] = *(stopReason + 3);
    data[5] = *(stopReason + 4);
    data[6] = *(stopReason + 5);

    SendCmdToEvboard(id, data, 7);
}

void GetMiscellaneousInfo(byte gun_index, byte relayStatus, float power, float voltage, byte toId)
{
    int id = PackageIdCmd(Ev_Cmd.get_miscellaneous_info + toId);
    byte data[8];

    int _power = power * 10;

    data[0] = relayStatus;
    data[1] = (int)_power & 0xff;
    data[2] = ((int)_power >> 8) & 0xff;
    data[3] = (int)voltage & 0xff;
    data[4] = ((int)voltage >> 8) & 0xff;

    SendCmdToEvboard(id, data, 5);
}

void SetIsolationStatus(byte gun_index, byte result, byte toId)
{
    int id = PackageIdCmd(Ev_Cmd.isolation_status + toId);
    byte data[8];

    data[0] = result;
    SendCmdToEvboard(id, data, 1);
}

void SetEvsePrechargeInfo(byte gun_index, byte result, byte toId)
{
    int id = PackageIdCmd(Ev_Cmd.evse_precharge_info + toId);
    byte data[8];

    data[0] = result;
    SendCmdToEvboard(id, data, 1);
}