/******************************************************************************
* @fn modbus_send_byte
*
* @brief Send one byte and calculate the crc byte
*
* @param uint8 - the byte wanted to be sent
* uint8 - the crc flag, need to calculate or not
*
* @return none
*/
static void modbus_send_byte( uint8 byte, uint8 crc)
{
//HalUARTWrite( 0, &byte, 1);
send_str_Uart( &byte, 1, 0);
//send_char_Uart(byte, 0);
if ( crc == CRC_NO)
CRC16_byte(byte);
}
void calcCRC16( uint8* data, uint8 len)
{
uint8 *pData = osal_mem_alloc( len);
if( pData)
osal_memcpy( pData, data, len);
pData[rssi_send_hi] = 255;
pData[rssi_send_lo] = modbus_rssi;
initCRC16();
for( uint8 i = 0; i<(len-2); i++)
{
CRC16_byte(pData[i]);
}
pData[len-2] = CRChi;
pData[len-1] = CRClo;
HalUARTWrite( 0, pData, len);
osal_mem_free( pData);
}
void response_scan_cmd(void)
{
uint8 *pBuf;
initCRC16();
pBuf = osal_mem_alloc(9);
if(pBuf!=NULL)
{
pBuf[0]=0xff;
pBuf[1]=0x19;
pBuf[2]=modbus_id;
pBuf[3]=ttt[0];
pBuf[4]=ttt[1];
pBuf[5]=ttt[2];
pBuf[6]=ttt[3];
}
for(uint8 i=0;i<7;i++)
CRC16_byte(pBuf[i]);
pBuf[7]=CRChi;
pBuf[8]=CRClo;
send_str_Uart( pBuf, 9, 0);
}
/******************************************************************************
* @fn modbus_process_msg
*
* @brief Process modbus message
*
* @param uint8 - the pointer the buffer
* uint8 - length
*
* @return none
*/
static void modbus_process_msg( uint8 *data_buffer, uint8 len)
{
uint8 num, tempByte;
uint8 zero = 0;
uint16 i;
uint16 address;
boatMonitor_t *pTempMonitor;
UTCTime utcSecs;
UTCTimeStruct utcTime;
utcSecs = osal_getClock();
osal_ConvertUTCTime( &utcTime, utcSecs );
address = BUILD_UINT16( data_buffer[3], data_buffer[2]);
if(( data_buffer[0] == modbus_id) || ( data_buffer[0] == 255))
{
if(data_buffer[1] == MODBUS_SINGLE_WRITE)
{
HalUARTWrite( 0, data_buffer, len);
if( address == MODBUS_ADDRESS)
{
modbus_id = data_buffer[5];
osal_nv_write( ZCD_NV_MODBUS_ID, 0, sizeof(modbus_id), &modbus_id);
}
if( address == MODBUS_BAUDRATE)
{
if((data_buffer[5] >=0) &&(data_buffer[5] <= 4))
{
modbus_set_baudrate = data_buffer[5];
osal_nv_write( ZCD_NV_BAUDRATE, 0, sizeof(modbus_set_baudrate), &modbus_set_baudrate);
restore_factory_setting();
}
}
}
else if( data_buffer[1] == MODBUS_MULTI_WRITE)
{
if( address == MODBUS_SERIALNUMBER_LOWORD)
{
if(data_buffer[6] == 8)
{
for( uint8 k=0;k<4;k++)
{
ttt[k] = data_buffer[2*k+8];
osal_nv_write( ZCD_NV_SERIAL_NUM, 0, sizeof(ttt), ttt);
}
}
}
// write system UTC
if( address == MODBUS_SYS_HOUR)
{
if( data_buffer[6] >= 12)
modbus_setUtcTime( &data_buffer[7]);
}
}
else if( data_buffer[1] == MODBUS_SINGLE_READ)
{
num = data_buffer[5];
uint8 *pBuf;
uint8 index=0;
pBuf = osal_mem_alloc(num*2+5);
if( pBuf != NULL)
{
pBuf[index++] = data_buffer[0];
pBuf[index++] = data_buffer[1];
pBuf[index++] = num*2;
//modbus_send_byte( data_buffer[0], CRC_NO);
//modbus_send_byte( data_buffer[1], CRC_NO);
//modbus_send_byte( num*2, CRC_NO);
for( i = 0; i < num; i++)
{
if ( i + address <= MODBUS_SERIALNUMBER_LOWORD + 3)
{
//modbus_send_byte( zero, CRC_NO);
pBuf[index++] = zero;
pBuf[index++] = ttt[ i + address - MODBUS_SERIALNUMBER_LOWORD];
}
else if( i + address == MODBUS_FIRMWARE_VERSION_NUMBER_LO)
{
pBuf[index++] = zero;
pBuf[index++] = ttt[4];
}
else if( i + address == MODBUS_FIRMWARE_VERSION_NUMBER_HI)
{
pBuf[index++] = zero;
pBuf[index++] = ttt[5];
}
else if( i + address == MODBUS_ADDRESS)
{
pBuf[index++] = zero;
pBuf[index++] = modbus_id;
}
else if( i + address == MODBUS_PRODUCT_ID)
{
pBuf[index++] = zero;
pBuf[index++] = 210;
}
// System UTC Time
else if( i + address == MODBUS_SYS_HOUR)
{
pBuf[index++] = zero;
pBuf[index++] = utcTime.hour;
}
else if( i + address == MODBUS_SYS_MINUTES)
{
pBuf[index++] = zero;
pBuf[index++] = utcTime.minutes;
}
else if( i + address == MODBUS_SYS_SECONDS)
{
pBuf[index++] = zero;
pBuf[index++] = utcTime.seconds;
}
else if( i + address == MODBUS_SYS_MONTH)
{
tempByte = utcTime.month + 1;
pBuf[index++] = zero;
pBuf[index++] = tempByte;
}
else if( i + address == MODBUS_SYS_DAY)
{
tempByte = utcTime.day + 1;
pBuf[index++] = zero;
pBuf[index++] = tempByte;
}
else if( i + address == MODBUS_SYS_YEAR)
{
tempByte = HI_UINT16( utcTime.year);
pBuf[index++] = tempByte;
tempByte = LO_UINT16( utcTime.year);
pBuf[index++] = tempByte;
}
/*else if( i + address == MODBUS_WATER_SWITCH)
{
if(leaveTimeCounter){
tempByte = water_switch;
//leaveTimeCounter=0;
}
else
tempByte = zero;
pBuf[index++] = zero;
pBuf[index++] = tempByte;
}
else if( i + address == MODBUS_DETECT_POWER)
{
uint16 power_temp;
if(leaveTimeCounter){
power_temp = (ad_power-196)*10/10.57+90;//(ad_power-186)*100/74+90;//((ad_power-644)*64)/100+70;
//leaveTimeCounter = 0;
}else
power_temp = 0;
tempByte = HI_UINT16( power_temp);
pBuf[index++] = tempByte;
tempByte = LO_UINT16( power_temp);
pBuf[index++] = tempByte;
}
else if( i + address == MODBUS_WATER_ID)
{
if(leaveTimeCounter){
tempByte = water_id;
//leaveTimeCounter=0;
}
else
tempByte = zero;
pBuf[index++] = zero;
pBuf[index++] = tempByte;
}
else if( i + address == MODBUS_WATER_RSSI)
{
if(leaveTimeCounter){
tempByte = (uint8)water_rssi;
}
else
tempByte = zero;
pBuf[index++] = 255;
pBuf[index++] = tempByte;
}
else if( i + address == MODBUS_WATER_SWITCH1)
{
if(leaveTimeCounter1){
tempByte = water_switch1;
//leaveTimeCounter=0;
}
else
tempByte = zero;
pBuf[index++] = zero;
pBuf[index++] = tempByte;
}
else if( i + address == MODBUS_DETECT_POWER1)
{
uint16 power_temp;
if(leaveTimeCounter1){
power_temp = (ad_power1-196)*10/10.57+90;//(ad_power-186)*100/74+90;//((ad_power-644)*64)/100+70;
//leaveTimeCounter = 0;
}else
power_temp = 0;
tempByte = HI_UINT16( power_temp);
pBuf[index++] = tempByte;
tempByte = LO_UINT16( power_temp);
pBuf[index++] = tempByte;
}
else if( i + address == MODBUS_WATER_ID1)
{
if(leaveTimeCounter1){
tempByte = water_id1;
//leaveTimeCounter=0;
}
else
tempByte = zero;
pBuf[index++] = zero;
pBuf[index++] = tempByte;
}*/
else if( i + address == MODBUS_BAUDRATE)
{
tempByte = modbus_set_baudrate;
pBuf[index++] = zero;
pBuf[index++] = tempByte;
}
else if( i + address == MODBUS_PANID)
{
tempByte = HI_UINT16( _NIB.nwkPanId);
pBuf[index++] = tempByte;
tempByte = LO_UINT16( _NIB.nwkPanId);
pBuf[index++] = tempByte;
}
else if( i + address == MODBUS_DEVICE_TYPE)
{
tempByte = zgDeviceLogicalType;
pBuf[index++] = zero;
pBuf[index++] = tempByte;
}
else if( i + address == MODBUS_CHANNEL_LIST_HI)
{
tempByte = BREAK_UINT32(zgDefaultChannelList, 3);
pBuf[index++] = tempByte;
tempByte = BREAK_UINT32(zgDefaultChannelList, 2);
pBuf[index++] = tempByte;
}
else if( i + address == MODBUS_CHANNEL_LIST_LO)
{
tempByte = BREAK_UINT32(zgDefaultChannelList, 1);
pBuf[index++] = tempByte;
tempByte = BREAK_UINT32(zgDefaultChannelList, 0);
pBuf[index++] = tempByte;
}
else if( (i + address >= MODBUS_EXTENDED_ADDR_HI) && (i + address <= MODBUS_EXTENDED_ADDR_LO))
{
tempByte = aExtendedAddress[ i+address-MODBUS_EXTENDED_ADDR_HI];
pBuf[index++] = zero;
pBuf[index++] = tempByte;
}
else if( (i + address >= MODBUS_SECURITY_KEY_START) && (i + address <= MODBUS_SECURITY_KEY_END))
{
tempByte = defaultKey[ i+address-MODBUS_SECURITY_KEY_START];
pBuf[index++] = zero;
pBuf[index++] = tempByte;
}
/*else if( i + address == MODBUS_DETECT_PIN1)
{
uint16 power_temp;
if(leaveTimeCounter){
power_temp = detectPin1;
}else
power_temp = 0;
tempByte = HI_UINT16( power_temp);
pBuf[index++] = tempByte;
tempByte = LO_UINT16( power_temp);
pBuf[index++] = tempByte;
}
else if( i + address == MODBUS_DETECT_PIN2)
{
uint16 power_temp;
if(leaveTimeCounter){
power_temp = detectPin2;
//leaveTimeCounter=0;
}else
power_temp = 0;
tempByte = HI_UINT16( power_temp);
pBuf[index++] = tempByte;
tempByte = LO_UINT16( power_temp);
pBuf[index++] = tempByte;
}*/
else if( i + address == MODBUS_MONITOR_NUM)
{
tempByte = numMonitor;
pBuf[index++] = zero;
pBuf[index++] = tempByte;
}
else if( (i + address >= MODBUS_FIRST_MONITOR_ID) && ( i+ address <= MODBUS_LAST_MONITOR_ID))
{
if( i + address == MODBUS_FIRST_MONITOR_ID)
{
pTempMonitor = pBoatMonitor;
}
else
{
pTempMonitor = pBoatMonitor;
for( uint8 j=0; j<((i+address)-MODBUS_FIRST_MONITOR_ID); j++)
{
if(pTempMonitor)
pTempMonitor = pTempMonitor->next;
}
}
pBuf[index++]= zero;
if(pTempMonitor != NULL)
{
pBuf[index++]= pTempMonitor->modbus_id;
}
else
pBuf[index++]= zero;
}
else if( (i + address >= MODBUS_FIRST_DETECT_POWER) && ( i+ address <= MODBUS_LAST_DETECT_POWER))
{
if( i + address == MODBUS_FIRST_DETECT_POWER)
{
pTempMonitor = pBoatMonitor;
}
else
{
pTempMonitor = pBoatMonitor;
for( uint8 j=0; j<((i+address)-MODBUS_FIRST_DETECT_POWER); j++)
{
if(pTempMonitor)
pTempMonitor = pTempMonitor->next;
}
}
if(pTempMonitor != NULL)
{
uint16 power_temp;
power_temp = (pTempMonitor->ad_power-196)*10/10.57+90;
tempByte = HI_UINT16( power_temp);
pBuf[index++] = tempByte;
tempByte = LO_UINT16( power_temp);
pBuf[index++] = tempByte;
}
else
{
pBuf[index++]= zero;
pBuf[index++]= zero;
}
}
else if( (i + address >= MODBUS_FIRST_WATER_SWITCH) && ( i+ address <= MODBUS_LAST_WATER_SWITCH))
{
if( i + address == MODBUS_FIRST_WATER_SWITCH)
{
pTempMonitor = pBoatMonitor;
}
else
{
pTempMonitor = pBoatMonitor;
for( uint8 j=0; j<((i+address)-MODBUS_FIRST_WATER_SWITCH); j++)
{
if(pTempMonitor)
pTempMonitor = pTempMonitor->next;
}
}
pBuf[index++]= zero;
if(pTempMonitor != NULL)
{
pBuf[index++]= pTempMonitor->water_switch;
}
else
pBuf[index++]= zero;
}
else if((i + address >= MODBUS_FIRST_DETECT_PIN1) && ( i+ address <= MODBUS_LAST_DETECT_PIN1))
{
if( i + address == MODBUS_FIRST_DETECT_PIN1)
{
pTempMonitor = pBoatMonitor;
}
else
{
pTempMonitor = pBoatMonitor;
for( uint8 j=0; j<((i+address)-MODBUS_FIRST_DETECT_PIN1); j++)
{
if(pTempMonitor)
pTempMonitor = pTempMonitor->next;
}
}
if(pTempMonitor != NULL)
{
tempByte = HI_UINT16( pTempMonitor->detectPin1);
pBuf[index++] = tempByte;
tempByte = LO_UINT16( pTempMonitor->detectPin1);
pBuf[index++] = tempByte;
}
else
{
pBuf[index++]= zero;
pBuf[index++]= zero;
}
}
else if((i + address >= MODBUS_FIRST_DETECT_PIN2) && ( i+ address <= MODBUS_LAST_DETECT_PIN2))
{
if( i + address == MODBUS_FIRST_DETECT_PIN2)
{
pTempMonitor = pBoatMonitor;
}
else
{
pTempMonitor = pBoatMonitor;
for( uint8 j=0; j<((i+address)-MODBUS_FIRST_DETECT_PIN2); j++)
{
if(pTempMonitor)
pTempMonitor = pTempMonitor->next;
}
}
if(pTempMonitor != NULL)
{
tempByte = HI_UINT16( pTempMonitor->detectPin2);
pBuf[index++] = tempByte;
tempByte = LO_UINT16( pTempMonitor->detectPin2);
pBuf[index++] = tempByte;
}
else
{
pBuf[index++]= zero;
pBuf[index++]= zero;
}
}
else if( (i + address >= MODBUS_FIRST_RSSI) && ( i+ address <= MODBUS_LAST_RSSI))
{
if( i + address == MODBUS_FIRST_RSSI)
{
pTempMonitor = pBoatMonitor;
}
else
{
pTempMonitor = pBoatMonitor;
for( uint8 j=0; j<((i+address)-MODBUS_FIRST_RSSI); j++)
{
if(pTempMonitor)
pTempMonitor = pTempMonitor->next;
}
}
if(pTempMonitor->rssi>=0)
pBuf[index++] = 0;
else
pBuf[index++]= 0xff;
if(pTempMonitor != NULL)
{
pBuf[index++]= pTempMonitor->rssi;
}
else
pBuf[index++]= zero;
}
else
{
pBuf[index++] = zero;
pBuf[index++] = zero;
}
}
for( i=0; i<num*2+3; i++)
CRC16_byte(pBuf[i]);
pBuf[num*2+3] = CRChi;
pBuf[num*2+4] = CRClo;
P1_0 = 1;
send_str_Uart( pBuf, num*2+5, 0);
P1_0 = 0;
osal_mem_free(pBuf);
}
else{
send_str_Uart( pBuf, num*2+5, 0);
}
}
}
}
/******************************************************************************
* @fn modbus_insert_msg
*/
void modbus_insert_msg( uint8 *pBuf, uint8 len)
{
uint8 index = 0;
afAddrType_t destAddr;
destAddr.addrMode = afAddr16Bit;
destAddr.addr.shortAddr = 0;
destAddr.endPoint = 10;
signalStrength_t* pSigStren;
initCRC16();
// uint8 *pInsertBuf = osal_mem_alloc( modbusDataLength*2);
if( firstAddr < 21)
index = 45 - 2*firstAddr;
else
//index = (modbusStartAddr-20)*2 + 1;
index = 3;
for (uint8 i=0; i<modbusDataLength; i++)
{
if( i+modbusStartAddr == MODBUS_PANID)
{
pBuf[index++] = HI_UINT16( _NIB.nwkPanId);
pBuf[index++] = LO_UINT16( _NIB.nwkPanId);
}
else if( i + modbusStartAddr == MODBUS_DEVICE_TYPE)
{
pBuf[index++] = ZERO;
pBuf[index++] = zgDeviceLogicalType;
}
else if( i + modbusStartAddr == MODBUS_CHANNEL_LIST_HI)
{
pBuf[index++] = BREAK_UINT32(zgDefaultChannelList, 3);
pBuf[index++] = BREAK_UINT32(zgDefaultChannelList, 2);
}
else if( i + modbusStartAddr == MODBUS_CHANNEL_LIST_LO)
{
pBuf[index++] = BREAK_UINT32(zgDefaultChannelList, 1);
pBuf[index++] = BREAK_UINT32(zgDefaultChannelList, 0);
}
else if( i + modbusStartAddr == MODBUS_SOFTWARE_REV)
{
pBuf[index++] = ZERO;
pBuf[index++] = ZIG_SOFTWARE_VER;
}
else if( (i + modbusStartAddr >= MODBUS_EXTENDED_ADDR_HI) && (i + modbusStartAddr <= MODBUS_EXTENDED_ADDR_LO))
{
pBuf[index++] = ZERO;
pBuf[index++] = aExtendedAddress[ i+modbusStartAddr-MODBUS_EXTENDED_ADDR_HI];
}
else if( (i + modbusStartAddr >= MODBUS_SECURITY_KEY_START) && (i + modbusStartAddr <= MODBUS_SECURITY_KEY_END))
{
pBuf[index++] = ZERO;
pBuf[index++] = defaultKey[ i+modbusStartAddr-MODBUS_SECURITY_KEY_START];
}
else if( i + modbusStartAddr == MODBUS_TSTAT_NUM)
{
pBuf[index++] = ZERO;
pBuf[index++] = numSignalStren;
}
else if( (i + modbusStartAddr >= MODBUS_FIRST_TSTAT_ID) && ( i+ modbusStartAddr <= MODBUS_LAST_TSTAT_ID))
{
if( i + modbusStartAddr == MODBUS_FIRST_TSTAT_ID)
{
pSigStren = pSignalStren;
}
else
{
pSigStren = pSignalStren;
for( uint8 j=0; j<((i+modbusStartAddr)-MODBUS_FIRST_TSTAT_ID); j++)
{
if(pSigStren)
pSigStren = pSigStren->next;
}
}
pBuf[index++] = ZERO;
if(pSigStren != NULL)
{
pBuf[index++] = pSigStren->modbus_id;
}
else
pBuf[index++] = ZERO;
}
else if( (i + modbusStartAddr >= MODBUS_FIRST_SIG_STREN) && ( i+ modbusStartAddr <= MODBUS_LAST_SIG_STREN))
{
if( i + modbusStartAddr == MODBUS_FIRST_SIG_STREN)
{
pSigStren = pSignalStren;
}
else
{
pSigStren = pSignalStren;
for( uint8 j=0; j<((i+modbusStartAddr)-MODBUS_FIRST_SIG_STREN); j++)
{
if(pSigStren)
pSigStren = pSigStren->next;
}
}
pBuf[index++] = ZERO;
if(pSigStren != NULL)
{
pBuf[index++] = pSigStren->rssi;
}
else
pBuf[index++] = ZERO;
}
else
{
pBuf[index++] = ZERO;
pBuf[index++] = ZERO;
}
}
for( uint8 i=0; i<len-2; i++)
CRC16_byte(pBuf[i]);
pBuf[len-2] = CRChi;
pBuf[len-1] = CRClo;
AF_DataRequest( &destAddr, &temco_epDesc,
TEMCO_CLUSTERID,
len,
pBuf,
&temcoApp_TransID,
AF_DISCV_ROUTE,
AF_DEFAULT_RADIUS );
modbusStartAddr = 0;
modbusDataLength = 0;
}
/******************************************************************************
* @fn modbus_send_byte
*
* @brief Send one byte and calculate the crc byte
*
* @param uint8 - the byte wanted to be sent
* uint8 - the crc flag, need to calculate or not
*
* @return none
*/
static void modbus_send_byte( uint8 byte, uint8 crc)
{
HalUARTWrite( 0, &byte, 1);
if ( crc == CRC_NO)
CRC16_byte(byte);
}
