csu3_am335x/EVSE/Projects/DO360/Apps/internalComm.c

/*
 * internalComm.c
 *
 *  Created on: 2019年5月7日
 *      Author: foluswen
 */
#include 	<sys/time.h>
#include 	<sys/timeb.h>
#include    <sys/types.h>
#include    <sys/stat.h>
#include 	<sys/types.h>
#include 	<sys/ioctl.h>
#include 	<sys/socket.h>
#include 	<sys/ipc.h>
#include 	<sys/shm.h>
#include 	<sys/shm.h>
#include 	<sys/mman.h>
#include 	<linux/wireless.h>
#include 	<arpa/inet.h>
#include 	<netinet/in.h>

#include 	<unistd.h>
#include 	<stdarg.h>
#include    <stdio.h>      /*標準輸入輸出定義*/
#include    <stdlib.h>     /*標準函數庫定義*/
#include    <unistd.h>     /*Unix 標準函數定義*/
#include    <fcntl.h>      /*檔控制定義*/
#include    <termios.h>    /*PPSIX 終端控制定義*/
#include    <errno.h>      /*錯誤號定義*/
#include 	<errno.h>
#include 	<string.h>
#include	<time.h>
#include	<ctype.h>
#include 	<ifaddrs.h>
#include 	<math.h>
#include 	"internalComm.h"

#define PASS                1
#define FAIL                -1

#define RS485_INFO(format, args...) StoreInternalCommLog("[%s:%4d][%s][RS485] "format, (strrchr(__FILE__, '/') ? strrchr(__FILE__, '/') + 1 : __FILE__), __LINE__, __FUNCTION__, ##args)

struct Address Addr = {
    AUX_ADD,
    FAN_ADD,
    RELAY_ADD,
    ACPLUG_ADD,
    LED_ADD,
    RC1_ADD,
    RC2_ADD,
    RD_ADD,
    BROADCAST_ADD
};

struct Command Cmd = {
    MSGID_G_FW_VERSION,
    MSGID_G_HW_VERSION,
    MSGID_G_AC_INPUT_VOLTAGE,
    MSGID_G_DC_OUTPUT_VOLTAGE,
    MSGID_G_FAN_SPEED,
    MSGID_G_TEMPERATURE,
    MSGID_G_AUX_VOLTAGE,
    MSGID_G_RELAY_STATE,
    MSGID_G_GFD,
    MSGID_G_GPIO_INPUT,
    MSGID_G_MODEL_NAME,
    MSGID_G_AC_OUTPUT_CURRENT,
    MSGID_G_AC_STATUS,
    MSGID_G_AC_ALARM,
    MSGID_G_AC_OUTPUT_POWER,
    MSGID_G_DC_INPUT_VOLTAGE,
    MSGID_S_FAN_SPEED,
    MSGID_S_MODEL_NAME,
    MSGID_S_RELAY_STATE,
    MSGID_S_GPIO_OUTPUT,
    MSGID_S_RTC,
    MSGID_S_AC_LED_STATE,
    MSGID_S_AC_CP_DUTY,
    MSGID_S_AC_LEGACY_REQ,
    MSGID_S_GFD,
    MSGID_S_AC_RESET_MCU,
    MSGID_S_MCU_OPERATION,
    MSGID_S_LED_COLOR,
    MSGID_S_FW_CHECKSUM,
    MSGID_S_FW_ABORT,
    MSGID_S_FW_PACKET,
    MSGID_S_FW_FINISH
};

int StoreInternalCommLog(const char *fmt, ...)
{
    char Buf[4096+256];
    char buffer[4096];
    va_list args;
    struct timeb  SeqEndTime;
    struct tm *tm;

    va_start(args, fmt);
    int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
    va_end(args);

    memset(Buf,0,sizeof(Buf));
    ftime(&SeqEndTime);
    SeqEndTime.time = time(NULL);
    tm=localtime(&SeqEndTime.time);

    sprintf(Buf,"echo \'%04d-%02d-%02d %02d:%02d:%02d:%03d - %s\' >> /Storage/SystemLog/[%04d.%02d]InternalCommLog",
        tm->tm_year+1900,tm->tm_mon+1,tm->tm_mday,tm->tm_hour,tm->tm_min,tm->tm_sec,SeqEndTime.millitm,
        buffer,
        tm->tm_year+1900,tm->tm_mon+1);
    system(Buf);

    return rc;
}

int tranceiveRelDelayTime(int fd, unsigned char* cmd, unsigned char cmd_len, unsigned char* rx, unsigned short _delay, int debug)
{
	int len;
    char buffer[1024];
    char temp[32];

	tcflush(fd,TCIOFLUSH);

	if(write(fd, cmd, cmd_len) >= cmd_len)
	{
	    if(debug > 0)
	    {
            memset(buffer, 0x00, sizeof(buffer));
            sprintf(buffer, "Tx->");
            for(int i = 0; i < cmd_len; i++)
            {
                sprintf(temp, " %02X", cmd[i]);
                strcat(buffer, temp);
            }
            RS485_INFO("%s", buffer);
	    }
		usleep(_delay * 1000);
		len = read(fd, rx, 512);
		if(debug > 0)
		{
            memset(buffer, 0x00, sizeof(buffer));
            sprintf(buffer, "Rx<-");
            if(len > 0)
            {
                for(int i = 0; i < len; i++)
                {
                    sprintf(temp, " %02X", rx[i]);
                    strcat(buffer, temp);
                }
            }
            else
            {
                strcat(buffer, " No Data!");
            }
            RS485_INFO("%s", buffer);
		}
	}
	else
	{
		#ifdef SystemLogMessage
		DEBUG_ERROR("Serial command %s response fail.\n", cmd);
		#endif
	}

	return len;
}

int tranceive(int fd, unsigned char* cmd, unsigned char cmd_len, unsigned char* rx, int debug)
{
	int len;
    char buffer[1024];
    char temp[32];

	tcflush(fd,TCIOFLUSH);

	if(write(fd, cmd, cmd_len) >= cmd_len)
	{
	    if(debug > 0)
	    {
            memset(buffer, 0x00, sizeof(buffer));
            sprintf(buffer, "Tx->");
            for(int i = 0; i < cmd_len; i++)
            {
                sprintf(temp, " %02X", cmd[i]);
                strcat(buffer, temp);
            }
            RS485_INFO("%s", buffer);
	    }

		usleep(15000);
		len = read(fd, rx, 512);
		if(debug > 0)
		{
            memset(buffer, 0x00, sizeof(buffer));
            sprintf(buffer, "Rx<-");
            if(len > 0)
            {
                for(int i = 0; i < len; i++)
                {
                    sprintf(temp, " %02X", rx[i]);
                    strcat(buffer, temp);
                }
            }
            else
            {
                strcat(buffer, " No Data!");
            }
            RS485_INFO("%s", buffer);
		}
	}
	else
	{
		#ifdef SystemLogMessage
		DEBUG_ERROR("Serial command %s response fail.\n", cmd);
		#endif
	}

	return len;
}

int Internal_Comm_Request(unsigned char fd, unsigned char targetAddr, unsigned char msg, unsigned char *data, unsigned short dataLen, unsigned char *response, int debug)
{
    int resLen = 0, rxLen = 0;

    unsigned char tx[512], rx[512];
    unsigned char txChksum = 0x00, rxChksum = 0;

    tx[0] = FRAME_ID;
    tx[1] = CSU_ADD;
    tx[2] = targetAddr;
    tx[3] = msg;
    tx[4] = dataLen & 0xFF;
    tx[5] = (dataLen >> 8) & 0xFF;

    if(dataLen > 0)
    {
        memcpy(&tx[6], &data[0], dataLen);

        for(int i = 0; i < dataLen; i++)
        {
            txChksum ^= tx[6 + i];
        }
    }

    tx[6 + dataLen] = txChksum;

    rxLen = tranceive(fd, &tx[0], INTERNAL_PACKET_MIN_LEN + dataLen, &rx[0], debug);

    if(rxLen >= INTERNAL_PACKET_MIN_LEN)
    {
        resLen = (rx[4] | (rx[5] << 8));

        if(rxLen == (INTERNAL_PACKET_MIN_LEN + resLen))
        {
            for(int i = 0; i < resLen; i++)
            {
                rxChksum ^= rx[6 + i];
            }

            if(rxChksum == rx[INTERNAL_PACKET_MIN_LEN - 1 + resLen])
            {
                if(rx[2] == tx[1] && rx[1] == tx[2] && rx[3] == tx[3])
                {
                    if(resLen > 0)
                    {
                        memcpy(response, &rx[6], resLen);
                    }
#if 0
                    printf("\r\n");
                    for(int i = 0; i < rxLen; i++)
                    {
                        printf(" %02X", rx[i]);
                    }
#endif
                }
                else
                {
                    // response packet(address or message) is not match
                    resLen = -1;
                }
            }
            else
            {
                // checksum is not match
                resLen = -1;
            }
        }
        else
        {
            // rx packet length and data length is not match
            resLen = -1;
        }
    }
    else
    {
        // rx packet length is less than  INTERNAL_PACKET_MIN_LEN
        resLen = -1;
    }

    return resLen;
}

unsigned char Query_FW_Ver(unsigned char fd, unsigned char targetAddr, Ver *Ret_Buf, int debug)
{
#if 0
	unsigned char result = FAIL;
	unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_FW_Ver, 0x00, 0x00, 0x00};
	unsigned char rx[512];
	unsigned char chksum = 0x00;
	unsigned char len = tranceive(fd, tx, sizeof(tx), rx, debug);

//		for (int i = 0; i < 7; i++)
//			printf("tx = %x \n", tx[i]);
//		for (int i = 0; i < len; i++)
//			printf("rx = %x \n", rx[i]);

	if(len > 6)
	{
		if (len < 6+(rx[4] | rx[5]<<8))
			return result;

		for(int idx = 0;idx<(rx[4] | rx[5]<<8);idx++)
		{
			chksum ^= rx[6+idx];
		}

		if((chksum == rx[6+(rx[4] | rx[5]<<8)]) &&
		   (rx[2] == tx[1]) &&
		   (rx[1] == tx[2]) &&
		   (rx[3] == tx[3]))
		{
			memcpy(Ret_Buf->Version_FW, (char *)rx+6, (rx[4] | rx[5]<<8));
			*(Ret_Buf->Version_FW + 8) = 0x00;
			result = PASS;
		}
	}

	return result;
#endif
    int resLen = 0;
    unsigned char result = FAIL;
    unsigned char response[512];

    resLen = Internal_Comm_Request(fd, targetAddr, Cmd.query_FW_Ver, 0, 0, &response[0], debug);

    if(resLen >= 0)
    {
        int maxLen = sizeof(Ret_Buf->Version_FW) - 1;

        strncpy((char *)Ret_Buf->Version_FW, (char *)response, resLen > maxLen ? maxLen : resLen);
        Ret_Buf->Version_FW[maxLen] = 0;
        result = PASS;
    }
    return result;
}

unsigned char Query_HW_Ver(unsigned char fd, unsigned char targetAddr, Ver *Ret_Buf, int debug)
{
#if 0
	unsigned char result = FAIL;
	unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_HW_Ver, 0x00, 0x00, 0x00};
	unsigned char rx[512];
	unsigned char chksum = 0x00;
	unsigned char len = tranceive(fd, tx, sizeof(tx), rx, debug);

	if(len > 6)
	{
		if (len < 6+(rx[4] | rx[5]<<8))
			return result;

		for(int idx = 0;idx<(rx[4] | rx[5]<<8);idx++)
		{
			chksum ^= rx[6+idx];
		}

		if((chksum == rx[6+(rx[4] | rx[5]<<8)]) &&
		   (rx[2] == tx[1]) &&
		   (rx[1] == tx[2]) &&
		   (rx[3] == tx[3]))
		{
			memcpy(Ret_Buf->Version_HW, (char *)rx+6, (rx[4] | rx[5]<<8));
			*(Ret_Buf->Version_HW + 8) = 0x00;
			result = PASS;
		}
	}

	return result;
#endif
    int resLen = 0;
    unsigned char result = FAIL;
    unsigned char response[512];

    resLen = Internal_Comm_Request(fd, targetAddr, Cmd.query_HW_Ver, 0, 0, &response[0], debug);

    if(resLen >= 0)
    {
        int maxLen = sizeof(Ret_Buf->Version_FW) - 1;

        strncpy((char *)Ret_Buf->Version_HW, (char *)response, resLen > maxLen ? maxLen : resLen);
        Ret_Buf->Version_HW[maxLen] = 0;
        result = PASS;
    }
    return result;
}

unsigned char Query_Present_InputVoltage(unsigned char fd, unsigned char targetAddr, PresentInputVoltage *Ret_Buf, int debug)
{
#if 0
	unsigned char result = FAIL;
	unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_Present_InputVoltage, 0x00, 0x00, 0x00};
	unsigned char rx[512];
	unsigned char chksum = 0x00;
	unsigned char len = tranceive(fd, tx, sizeof(tx), rx, debug);

	if(len > 13)
	{
		if (len < 6+(rx[4] | rx[5]<<8))
			return result;

		for(int idx = 0;idx<(rx[4] | rx[5]<<8);idx++)
		{
			chksum ^= rx[6+idx];
		}
		if((chksum == rx[6+(rx[4] | rx[5]<<8)]) &&
		   (rx[2] == tx[1]) &&
		   (rx[1] == tx[2]) &&
		   (rx[3] == tx[3]) &&
		   chksum != 0)
		{
			Ret_Buf->inputType = rx[6];
			Ret_Buf->L1N_L12 =(rx[7] | (rx[8]<<8))/10.0;
			Ret_Buf->L2N_L23 =(rx[9] | (rx[10]<<8))/10.0;
			Ret_Buf->L3N_L31 =(rx[11] | (rx[12]<<8))/10.0;

			if (Ret_Buf->L1N_L12 >= 320 ||
					Ret_Buf->L2N_L23 >= 320 ||
					Ret_Buf->L3N_L31 >= 320)
			{
				result = FAIL;
			}
			else
				result = PASS;
		}
	}

	return result;
#endif
    int resLen = 0;
    unsigned char result = FAIL;
    unsigned char response[512];

    resLen = Internal_Comm_Request(fd, targetAddr, Cmd.query_Present_InputVoltage, 0, 0, &response[0], debug);

    if(resLen >= 7)
    {
        Ret_Buf->inputType = response[0];
        Ret_Buf->L1N_L12 =(response[1] | (response[2] << 8)) / 10.0;
        Ret_Buf->L2N_L23 =(response[3] | (response[4] << 8)) / 10.0;
        Ret_Buf->L3N_L31 =(response[5] | (response[6] << 8)) / 10.0;

        if (Ret_Buf->L1N_L12 >= 320 || Ret_Buf->L2N_L23 >= 320 || Ret_Buf->L3N_L31 >= 320)
        {
            result = FAIL;
        }
        else
        {
            result = PASS;
        }
    }

    return result;
}

unsigned char Query_DC_InputVoltage(unsigned char fd, unsigned char targetAddr, DCInputVoltage *Ret_Buf, int debug)
{
    unsigned char result = FAIL;
    int resLen = 0;
    unsigned char response[512];

    memset(response, 0x00, 512);
    resLen = Internal_Comm_Request(fd, targetAddr, Cmd.query_DC_InputVoltage, 0, 0, &response[0], debug);

    if(resLen >= 0)
    {
        Ret_Buf->DC_Input_1 =(response[0] | (response[1] << 8)) / 10;
        Ret_Buf->DC_Input_2 =(response[2] | (response[3] << 8)) / 10;

        result = PASS;
    }

    return result;
}

unsigned char Query_Present_OutputVoltage(unsigned char fd, unsigned char targetAddr, PresentOutputVoltage *Ret_Buf, int debug)
{
#if 0
	unsigned char result = FAIL;
	unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_Present_OutputVoltage, 0x00, 0x00, 0x00};
	unsigned char rx[512];
	unsigned char chksum = 0x00;
	unsigned char len = tranceive(fd, tx, sizeof(tx), rx, debug);

	if(len > 6)
	{
		if (len < 6+(rx[4] | rx[5]<<8))
			return result;

		for(int idx = 0;idx<(rx[4] | rx[5]<<8);idx++)
		{
			chksum ^= rx[6+idx];
		}

		if((chksum == rx[6+(rx[4] | rx[5]<<8)]) &&
		   (rx[2] == tx[1]) &&
		   (rx[1] == tx[2]) &&
		   (rx[3] == tx[3]))
		{

			Ret_Buf->behindFuse_Voltage_C1 =(rx[6] | (rx[7]<<8));
			Ret_Buf->behindRelay_Voltage_C1 =(rx[8] | (rx[9]<<8));
			if((rx[4] | rx[5]<<8) > 4)
			{
				Ret_Buf->behindFuse_Voltage_C2 =(rx[10] | (rx[11]<<8));
				Ret_Buf->behindRelay_Voltage_C2 =(rx[12] | (rx[13]<<8));
			}
			result = PASS;
		}
	}

	return result;
#endif
    int resLen = 0;
    unsigned char result = FAIL;
    unsigned char response[512];

    resLen = Internal_Comm_Request(fd, targetAddr, Cmd.query_Present_OutputVoltage, 0, 0, &response[0], debug);

    if(resLen >= 8)
    {
        Ret_Buf->behindFuse_Voltage_C1 = (response[0] | (response[1] << 8));
        Ret_Buf->behindRelay_Voltage_C1 = (response[2] | (response[3] << 8));
        Ret_Buf->behindFuse_Voltage_C2 =(response[4] | (response[5] << 8));
        Ret_Buf->behindRelay_Voltage_C2 =(response[6] | (response[7] << 8));

        result = PASS;
    }

    return result;
}

unsigned char Query_Fan_Speed(unsigned char fd, unsigned char targetAddr, FanSpeed *Ret_Buf, int debug)
{
#if 0
	unsigned char result = FAIL;
	unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_Fan_Speed, 0x00, 0x00, 0x00};
	unsigned char rx[512];
	unsigned char chksum = 0x00;
	unsigned char len = tranceive(fd, tx, sizeof(tx), rx, debug);

	if(len > 6)
	{
		if (len < 6+(rx[4] | rx[5]<<8))
			return result;

		for(int idx = 0;idx<(rx[4] | rx[5]<<8);idx++)
		{
			chksum ^= rx[6+idx];
		}

		if((chksum == rx[6+(rx[4] | rx[5]<<8)]) &&
		   (rx[2] == tx[1]) &&
		   (rx[1] == tx[2]) &&
		   (rx[3] == tx[3]))
		{
			for(int idx=0;idx < 4;idx++)
				Ret_Buf->speed[idx] = (rx[6+(2*idx)] | (rx[6+(2*idx)+1]<<8));

			result = PASS;
		}
	}

	return result;
#endif
    int resLen = 0;
    unsigned char result = FAIL;
    unsigned char response[512];

    resLen = Internal_Comm_Request(fd, targetAddr, Cmd.query_Fan_Speed, 0, 0, &response[0], debug);

    if(resLen >= 8)
    {
        for(int i = 0; i < 4; i++)
        {
            Ret_Buf->speed[i] = (response[2 * i] | (response[(2 * i) + 1] << 8));
        }
        result = PASS;
    }

    return result;
}

unsigned char Query_Relay_Output(unsigned char fd, unsigned char targetAddr, Relay *Ret_Buf, int debug)
{
#if 0
	unsigned char result = FAIL;
	unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_Relay_Output, 0x00, 0x00, 0x00};
	unsigned char rx[512];
	unsigned char chksum = 0x00;
	unsigned char len = tranceive(fd, tx, sizeof(tx), rx, debug);

//	for (int i = 0; i < 7; i++)
//		printf("tx = %x \n", tx[i]);
//	for (int i = 0; i < len; i++)
//		printf("rx = %x \n", rx[i]);

	if(len > 6)
	{
		if (len < 6+(rx[4] | rx[5]<<8))
			return result;

		for(int idx = 0;idx<(rx[4] | rx[5]<<8);idx++)
		{
			chksum ^= rx[6+idx];
		}

		if((chksum == rx[6+(rx[4] | rx[5]<<8)]) &&
		   (rx[2] == tx[1]) &&
		   (rx[1] == tx[2]) &&
		   (rx[3] == tx[3]))
		{
			Ret_Buf->relay_event.bits.AC_Contactor = (rx[6] >> 0) & 0x01;
			Ret_Buf->relay_event.bits.CCS_Precharge = (rx[6] >> 1) & 0x01;

			Ret_Buf->relay_event.bits.Gun1_N = (rx[7] >> 0) & 0x01;
			Ret_Buf->relay_event.bits.Gun1_P = (rx[7] >> 1) & 0x01;
			Ret_Buf->relay_event.bits.Gun1_Parallel_N = (rx[7] >> 2) & 0x01;
			Ret_Buf->relay_event.bits.Gun1_Parallel_P = (rx[7] >> 3) & 0x01;

			Ret_Buf->relay_event.bits.Gun2_N = (rx[8] >> 0) & 0x01;
			Ret_Buf->relay_event.bits.Gun2_P = (rx[8] >> 1) & 0x01;
            Ret_Buf->relay_event.bits.Gun2_Parallel_N = (rx[8] >> 2) & 0x01;
            Ret_Buf->relay_event.bits.Gun2_Parallel_P = (rx[8] >> 3) & 0x01;
			result = PASS;
		}
	}

	return result;
#endif
    int resLen = 0;
    unsigned char result = FAIL;
    unsigned char response[512];

    resLen = Internal_Comm_Request(fd, targetAddr, Cmd.query_Relay_Output, 0, 0, &response[0], debug);

    if(resLen >= 3)
    {
        Ret_Buf->relay_event.bits.AC_Contactor = (response[0] >> 0) & 0x01;
        Ret_Buf->relay_event.bits.CCS_Precharge = (response[0] >> 1) & 0x01;

        Ret_Buf->relay_event.bits.Gun1_N = (response[1] >> 0) & 0x01;
        Ret_Buf->relay_event.bits.Gun1_P = (response[1] >> 1) & 0x01;
        Ret_Buf->relay_event.bits.Gun1_Parallel_N = (response[1] >> 2) & 0x01;
        Ret_Buf->relay_event.bits.Gun1_Parallel_P = (response[1] >> 3) & 0x01;

        Ret_Buf->relay_event.bits.Gun2_N = (response[2] >> 0) & 0x01;
        Ret_Buf->relay_event.bits.Gun2_P = (response[2] >> 1) & 0x01;
        Ret_Buf->relay_event.bits.Gun2_Parallel_N = (response[2] >> 2) & 0x01;
        Ret_Buf->relay_event.bits.Gun2_Parallel_P = (response[2] >> 3) & 0x01;
        result = PASS;
    }

    return result;
}

unsigned char Query_Gfd_Adc(unsigned char fd, unsigned char targetAddr, Gfd *Ret_Buf, int debug)
{
#if 0
	unsigned char result = FAIL;
	unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_Gfd_Adc, 0x00, 0x00, 0x00};
	unsigned char rx[512];
	unsigned char chksum = 0x00;
	unsigned char len = tranceive(fd, tx, sizeof(tx), rx, debug);

//	for(int i = 0; i < 7; i++)
//		printf ("tx = %d \n", tx[i]);
	if(len > 6)
	{
		if (len < 6+(rx[4] | rx[5]<<8))
		{
			//printf("Query_Gfd_Adc fail \n");
			return result;
		}

//		for(int i = 0; i < len; i++)
//			printf ("rx = %d \n", rx[i]);

		for(int idx = 0;idx<(rx[4] | rx[5]<<8);idx++)
		{
			chksum ^= rx[6+idx];
		}

		if((chksum == rx[6+(rx[4] | rx[5]<<8)]) &&
		   (rx[2] == tx[1]) &&
		   (rx[1] == tx[2]) &&
		   (rx[3] == tx[3]))
		{
			Ret_Buf->Resister_conn1 = (rx[6] | (rx[7] << 8));
			Ret_Buf->voltage_conn1 = (rx[8] | (rx[9] << 8));
			Ret_Buf->result_conn1 = rx[10];
			Ret_Buf->rb_step_1 = rx[11];

			Ret_Buf->Resister_conn2 = (rx[12] | (rx[13] << 8));
			Ret_Buf->voltage_conn2 = (rx[14] | (rx[15] << 8));
			Ret_Buf->result_conn2 = rx[16];
			Ret_Buf->rb_step_2 = rx[17];

			result = PASS;
		}
	}

	return result;
#endif
    int resLen = 0;
    unsigned char result = FAIL;
    unsigned char response[512];

    resLen = Internal_Comm_Request(fd, targetAddr, Cmd.query_Gfd_Adc, 0, 0, &response[0], debug);

    if(resLen >= 12)
    {
        Ret_Buf->Resister_conn1 = (response[0] | (response[1] << 8));
        Ret_Buf->voltage_conn1 = (response[2] | (response[3] << 8));
        Ret_Buf->result_conn1 = response[4];
        Ret_Buf->rb_step_1 = response[5];

        Ret_Buf->Resister_conn2 = (response[6] | (response[7] << 8));
        Ret_Buf->voltage_conn2 = (response[8] | (response[9] << 8));
        Ret_Buf->result_conn2 = response[10];
        Ret_Buf->rb_step_2 = response[11];
        result = PASS;
    }

    return result;
}

unsigned char Config_Fan_Speed(unsigned char fd, unsigned char targetAddr, FanSpeed *Set_Buf, int debug)
{
#if 0
	unsigned char result = FAIL;
	unsigned char tx[15] = {0xaa, 0x00, targetAddr, Cmd.config_Fan_Speed, 0x08, 0x00, Set_Buf->speed[0]&0xff, (Set_Buf->speed[0]>>8)&0xff, Set_Buf->speed[1]&0xff, (Set_Buf->speed[1]>>8)&0xff, Set_Buf->speed[2]&0xff, (Set_Buf->speed[2]>>8)&0xff, Set_Buf->speed[3]&0xff, (Set_Buf->speed[3]>>8)&0xff, 0x00};
	unsigned char rx[512];
	unsigned char chksum = 0x00;

	for(int idx = 0;idx<(tx[4] | tx[5]<<8);idx++)
		chksum ^= tx[6+idx];
	tx[14] = chksum;

	unsigned char len = tranceive(fd, tx, sizeof(tx), rx, debug);
	if(len > 6)
	{
		if (len < 6+(rx[4] | rx[5]<<8))
			return result;

		chksum = 0x00;
		for(int idx = 0;idx<(rx[4] | rx[5]<<8);idx++)
		{
			chksum ^= rx[6+idx];
		}

		if((chksum == rx[6+(rx[4] | rx[5]<<8)]) &&
		   (rx[2] == tx[1]) &&
		   (rx[1] == tx[2]) &&
		   (rx[3] == tx[3]) &&
		   rx[6] == PASS)
		{
			result = PASS;
		}
	}

	return result;
#endif
    int resLen = 0;
    unsigned char result = FAIL;
    unsigned char response[512];
    unsigned char data[8];

    data[0] = Set_Buf->speed[0] & 0xFF;
    data[1] = (Set_Buf->speed[0] >> 8) & 0xFF;
    data[2] = Set_Buf->speed[1] & 0xFF;
    data[3] = (Set_Buf->speed[1] >> 8) & 0xFF;
    data[4] = Set_Buf->speed[2] & 0xFF;
    data[5] = (Set_Buf->speed[2] >> 8) & 0xFF;
    data[6] = Set_Buf->speed[3] & 0xFF;
    data[7] = (Set_Buf->speed[3] >> 8) & 0xFF;

    resLen = Internal_Comm_Request(fd, targetAddr, Cmd.config_Fan_Speed, data, 8, &response[0], debug);

    if(resLen >= 0)
    {
        result = PASS;
    }

    return result;
}

unsigned char Config_Relay_Output(unsigned char fd, unsigned char targetAddr, Relay *Set_Buf, int debug)
{
#if 0
	unsigned char result = FAIL;
	unsigned char tx[10] = {0xaa, 0x00, targetAddr, Cmd.config_Relay_Output, 0x03, 0x00, Set_Buf->relay_event.relay_status[0], Set_Buf->relay_event.relay_status[1], Set_Buf->relay_event.relay_status[2]};
	unsigned char rx[512];
	unsigned char chksum = 0x00;

	for(int idx = 0;idx<(tx[4] | tx[5]<<8);idx++)
		chksum ^= tx[6 + idx];
	tx[9] = chksum;

//	for (int i = 0; i < 10; i++)
//		printf("set relay cmd : tx = %x \n", tx[i]);

	unsigned char len = tranceive(fd, tx, sizeof(tx), rx, debug);

	if(len > 6)
	{
		if (len < 6+(rx[4] | rx[5]<<8))
			return result;

//		for (int i = 0; i < len; i++)
//			printf("set relay cmd : rx = %x \n", rx[i]);

		chksum = 0x00;
		for(int idx = 0;idx<(rx[4] | rx[5]<<8);idx++)
		{
			chksum ^= rx[6+idx];
		}

		if((chksum == rx[6+(rx[4] | rx[5]<<8)]) &&
		   (rx[2] == tx[1]) &&
		   (rx[1] == tx[2]) &&
		   (rx[3] == tx[3]) &&
		   rx[6] == PASS)
		{
			result = PASS;
		}
	}

	return result;
#endif
    int resLen = 0;
    unsigned char result = FAIL;
    unsigned char response[512];

    resLen = Internal_Comm_Request(fd, targetAddr, Cmd.config_Relay_Output, Set_Buf->relay_event.relay_status, 3, &response[0], debug);

    if(resLen >= 0)
    {
        result = PASS;
    }

    return result;
}

unsigned char Config_Gfd_Value(unsigned char fd, unsigned char targetAddr, Gfd_config *Set_Buf, int debug)
{
#if 0
	unsigned char result = FAIL;
	unsigned char tx[9] = {0xaa, 0x00, targetAddr, Cmd.config_Gfd_Value, 0x02, 0x00, 0x00, 0x00, 0x00};
	unsigned char rx[512];
	unsigned char chksum = 0x00;

	tx[6] = Set_Buf->index;
	tx[7] = Set_Buf->state;

	for(int idx = 0; idx<(tx[4] | tx[5]<<8);idx++)
		chksum ^= tx[6+idx];
	tx[8] = chksum;

	unsigned char len = tranceive(fd, tx, sizeof(tx), rx, debug);

	if(len > 6)
	{
		if (len < 6+(rx[4] | rx[5]<<8))
			return result;

		chksum = 0x00;
		for(int idx = 0;idx<(rx[4] | rx[5]<<8);idx++)
		{
			chksum ^= rx[6+idx];
		}

		if((chksum == rx[6+(rx[4] | rx[5]<<8)]) &&
		   (rx[2] == tx[1]) &&
		   (rx[1] == tx[2]) &&
		   (rx[3] == tx[3]))
		{
			result = PASS;
		}
	}

	return result;
#endif
    int resLen = 0;
    unsigned char result = FAIL;
    unsigned char response[512];
    unsigned char data[2];

    data[0] = Set_Buf->index;
    data[1] = Set_Buf->state;

    resLen = Internal_Comm_Request(fd, targetAddr, Cmd.config_Gfd_Value, data, 2, &response[0], debug);

    if(resLen >= 0)
    {
        result = PASS;
    }

    return result;
}

unsigned char Config_Model_Name(unsigned char fd, unsigned char targetAddr, unsigned char *modelname, int len, int debug)
{
#if 0
	unsigned char result = FAIL;
	unsigned char tx[21] = {0xaa, 0x00, targetAddr, Cmd.config_Model_Name, 0x0E, 0x00,
			0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
	unsigned char rx[512];
	unsigned char chksum = 0x00;

	memcpy(tx + 6, modelname, 14);

	for(int idx = 0; idx<(tx[4] | tx[5]<<8);idx++)
		chksum ^= tx[6+idx];
	tx[20] = chksum;

//	for(int i = 0; i < 21; i++)
//				printf ("tx = %x \n", tx[i]);
	unsigned char len = tranceive(fd, tx, sizeof(tx), rx, debug);
//	for(int i = 0; i < len; i++)
//					printf ("rx = %x \n", rx[i]);
	if(len > 6)
	{
		if (len < 6+(rx[4] | rx[5]<<8))
			return result;

		chksum = 0x00;
		for(int idx = 0;idx<(rx[4] | rx[5]<<8);idx++)
		{
			chksum ^= rx[6+idx];
		}

		if((chksum == rx[6+(rx[4] | rx[5]<<8)]) &&
			  (rx[2] == tx[1]) &&
			  (rx[1] == tx[2]) &&
			  (rx[3] == tx[3]) &&
			  rx[6] == PASS)
		{
			result = PASS;
		}
	}

	return result;
#endif
    int resLen = 0;
    unsigned char result = FAIL;
    unsigned char response[512];

    resLen = Internal_Comm_Request(fd, targetAddr, Cmd.config_Model_Name, modelname, len, &response[0], debug);

    if(resLen >= 0)
    {
        result = PASS;
    }
    return result;
}

unsigned char Config_Rtc_Data(unsigned char fd, unsigned char targetAddr, Rtc *Set_Buf, int debug)
{
#if 0
	unsigned char result = FAIL;
	unsigned char tx[21] = { 0xaa, 0x00, targetAddr, Cmd.config_Rtc_Data, 0x0E, 0x00, Set_Buf->RtcData[0], Set_Buf->RtcData[1],
			Set_Buf->RtcData[2], Set_Buf->RtcData[3], Set_Buf->RtcData[4], Set_Buf->RtcData[5], Set_Buf->RtcData[6], Set_Buf->RtcData[7],
			Set_Buf->RtcData[8], Set_Buf->RtcData[9], Set_Buf->RtcData[10], Set_Buf->RtcData[11], Set_Buf->RtcData[12], Set_Buf->RtcData[13]};
	unsigned char rx[512];
	unsigned char chksum = 0x00;

	for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++)
		chksum ^= tx[6 + idx];
	tx[20] = chksum;

	if (tranceive(fd, tx, sizeof(tx), rx, debug) > 0)
	{
		chksum = 0x00;
		for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++)
		{
			chksum ^= rx[6 + idx];
		}

		if((chksum == rx[6+(rx[4] | rx[5]<<8)]) &&
				(rx[2] == tx[1]) &&
				(rx[1] == tx[2]) &&
				(rx[3] == tx[3]) &&
				rx[6] == PASS)
		{
			result = PASS;
		}
	}

	return result;
#endif
    int resLen = 0;
    unsigned char result = FAIL;
    unsigned char response[512];

    resLen = Internal_Comm_Request(fd, targetAddr, Cmd.config_Rtc_Data, (unsigned char *)&Set_Buf->RtcData[0], sizeof(Rtc), &response[0], debug);

    if(resLen >= 0)
    {
        result = PASS;
    }
    return result;
}

unsigned char Update_Start(unsigned char fd, unsigned char targetAddr, unsigned int crc32)
{
	unsigned char result = FAIL;
	unsigned char tx[11] = {0xaa, 0x00, targetAddr, Cmd.update_Start, 0x04, 0x00, (crc32>>0)&0xff, (crc32>>8)&0xff, (crc32>>16)&0xff, (crc32>>24)&0xff, 0x00};
	unsigned char rx[512];
	unsigned char chksum = 0x00;

	for(int idx = 0;idx<(tx[4] | tx[5]<<8);idx++)
		chksum ^= tx[6+idx];
	tx[10] = chksum;

	unsigned char len = tranceive(fd, tx, sizeof(tx), rx, 0);
	if(len > 6)
	{
		if (len < 6+(rx[4] | rx[5]<<8))
			return result;

		chksum = 0x00;
		for(int idx = 0;idx<(rx[4] | rx[5]<<8);idx++)
		{
			chksum ^= rx[6+idx];
		}

		if((chksum == rx[6+(rx[4] | rx[5]<<8)]) &&
		   (rx[2] == tx[1]) &&
		   (rx[1] == tx[2]) &&
		   (rx[3] == tx[3]) &&
		   (rx[6] == 0x00))
		{
			result = PASS;
		}
	}

	return result;
}

unsigned char Update_Abord(unsigned char fd, unsigned char targetAddr)
{
	unsigned char result = FAIL;
	unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.update_Start, 0x04, 0x00, 0x00};
	unsigned char rx[512];
	unsigned char chksum = 0x00;
	unsigned char len = tranceive(fd, tx, sizeof(tx), rx, 0);

	if(len > 6)
	{
		if (len < 6+(rx[4] | rx[5]<<8))
			return result;

		for(int idx = 0;idx<(rx[4] | rx[5]<<8);idx++)
		{
			chksum ^= rx[6+idx];
		}

		if((chksum == rx[6+(rx[4] | rx[5]<<8)]) &&
		   (rx[2] == tx[1]) &&
		   (rx[1] == tx[2]) &&
		   (rx[3] == tx[3]) &&
		   (rx[6] == 0x00))
		{
			result = PASS;
		}
	}

	return result;
}

unsigned char Update_Transfer(unsigned char fd, unsigned char targetAddr, unsigned int startAddr, unsigned char *data, unsigned short int length)
{
	unsigned char result = FAIL;
	unsigned char tx[11 + length];
	unsigned char rx[512];
	unsigned char chksum = 0x00;

	tx[0] = 0xaa;
	tx[1] = 0x00;
	tx[2] = targetAddr;
	tx[3] = Cmd.update_Transfer;
	tx[4] = (4 + length) & 0xff;
	tx[5] = ((4 + length)>>8) & 0xff;
	tx[6] = (startAddr>>0) & 0xff;
	tx[7] = (startAddr>>8) & 0xff;
	tx[8] = (startAddr>>16) & 0xff;
	tx[9] = (startAddr>>24) & 0xff;
	memcpy(tx+10, data, length);

	for(int idx = 0;idx<(tx[4] | tx[5]<<8);idx++)
		chksum ^= tx[6+idx];
	tx[sizeof(tx)-1] = chksum;

	unsigned char len = tranceive(fd, tx, sizeof(tx), rx, 0);

	if(len > 6)
	{
		if (len < 6+(rx[4] | rx[5]<<8))
			return result;

		for(int idx = 0;idx<(rx[4] | rx[5]<<8);idx++)
		{
			chksum ^= rx[6+idx];
		}

		if((chksum == rx[6+(rx[4] | rx[5]<<8)]) &&
		   (rx[2] == tx[1]) &&
		   (rx[1] == tx[2]) &&
		   (rx[3] == tx[3]) &&
		   (rx[6] == 0x00))
		{
			result = PASS;
		}
	}

	return result;
}

unsigned char Update_Finish(unsigned char fd, unsigned char targetAddr)
{
	unsigned char result = FAIL;
	unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.update_Finish, 0x04, 0x00, 0x00};
	unsigned char rx[512];
	unsigned char chksum = 0x00;
	unsigned char len = tranceive(fd, tx, sizeof(tx), rx, 0);

	if(len > 6)
	{
		if (len < 6+(rx[4] | rx[5]<<8))
			return result;

		for(int idx = 0;idx<(rx[4] | rx[5]<<8);idx++)
		{
			chksum ^= rx[6+idx];
		}

		if((chksum == rx[6+(rx[4] | rx[5]<<8)]) &&
		   (rx[2] == tx[1]) &&
		   (rx[1] == tx[2]) &&
		   (rx[3] == tx[3]) &&
		   (rx[6] == 0x00))
		{
			result = PASS;
		}
	}

	return result;
}

unsigned char Config_LED_Status(unsigned char fd, unsigned char targetAddr, Ac_Led_Status *Ret_Buf, int debug)
{
	unsigned char result = FAIL;
	unsigned char tx[12] = {0xaa, 0x00, targetAddr, Cmd.config_ac_led_status, 0x05, 0x00, Ret_Buf->ActionMode, (Ret_Buf->AcAlarmCode >> 0) & 0xFF,
			(Ret_Buf->AcAlarmCode >> 8) & 0xFF, (Ret_Buf->AcAlarmCode >> 16) & 0xFF, (Ret_Buf->AcAlarmCode >> 24) & 0xFF};
	unsigned char rx[512];
	unsigned char chksum = 0x00;

	for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++)
			chksum ^= tx[6 + idx];
	tx[11] = chksum;

	if (tranceiveRelDelayTime(fd, tx, sizeof(tx), rx, 100, debug) > 0)
	{
		chksum = 0x00;
		for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++)
		{
			chksum ^= rx[6 + idx];
		}

		if((chksum == rx[6+(rx[4] | rx[5]<<8)]) &&
			(rx[2] == tx[1]) &&
			(rx[1] == tx[2]) &&
			(rx[3] == tx[3]) &&
			rx[6] == PASS)
		{
			result = PASS;
		}
	}

	return result;
}

unsigned char Config_Led_Color(unsigned char fd, unsigned char targetAddr, Led_Color *Ret_Buf, int debug)
{
#if 0
	unsigned char result = FAIL;
	unsigned char tx[13] = {0xaa, 0x00, targetAddr, Cmd.config_led_color, 0x06, 0x00,
			Ret_Buf->Connect_1_Red, Ret_Buf->Connect_1_Green, Ret_Buf->Connect_1_Blue,
			Ret_Buf->Connect_2_Red, Ret_Buf->Connect_2_Green, Ret_Buf->Connect_2_Blue};
	unsigned char rx[512];
	unsigned char chksum = 0x00;

	for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++)
		chksum ^= tx[6 + idx];
	tx[12] = chksum;

	unsigned char len = tranceive(fd, tx, sizeof(tx), rx, debug);

	if(len > 6)
	{
		if (len < 6+(rx[4] | rx[5]<<8))
			return result;

		for(int idx = 0;idx<(rx[4] | rx[5]<<8);idx++)
		{
			chksum ^= rx[6+idx];
		}

		if((chksum == rx[6+(rx[4] | rx[5]<<8)]) &&
			  (rx[2] == tx[1]) &&
			  (rx[1] == tx[2]) &&
			  (rx[3] == tx[3]) &&
			  (rx[6] == PASS))
		{
			result = PASS;
		}
	}

	return result;
#endif
    int resLen = 0;
    unsigned char result = FAIL;
    unsigned char response[512];
    unsigned char data[6];

    data[0] = Ret_Buf->Connect_1_Red;
    data[1] = Ret_Buf->Connect_1_Green;
    data[2] = Ret_Buf->Connect_1_Blue;
    data[3] = Ret_Buf->Connect_2_Red;
    data[4] = Ret_Buf->Connect_2_Green;
    data[5] = Ret_Buf->Connect_2_Blue;

    resLen = Internal_Comm_Request(fd, targetAddr, Cmd.config_led_color, data, 6, &response[0], debug);

    if(resLen >= 0)
    {
        result = PASS;
    }

    return result;
}