/* * internalComm.c * * Created on: 2019年5月7日 * Author: foluswen */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include /*標準輸入輸出定義*/ #include /*標準函數庫定義*/ #include /*Unix 標準函數定義*/ #include /*檔控制定義*/ #include /*PPSIX 終端控制定義*/ #include /*錯誤號定義*/ #include #include #include #include #include #include #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; }