Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- //formatting frame to send via uart
- memset(dataToSend,0,sizeof(dataToSend));
- destAddr.u16=GetCurrentNodeId();
- memset(dataToSend+OFFSET_RSSI,0,sizeof(int16_t));
- memcpy(dataToSend+OFFSET_ADDRRECV,&destAddr.u16,sizeof(uint16_t));
- //fill fields
- dataToSend[MSG_TYPE_OFFSET]=HEALTH_RADIO_MSGTYPE;
- memcpy(dataToSend + RADIO_PAYLOAD_OFFSET ,(uint8_t *)(&sMoteHealthData),sizeof(MoteHealthDataStr));
- memcpy(dataToSend + RADIO_PAYLOAD_OFFSET ,(uint8_t *)(&sMoteHealthData),sizeof(MoteHealthDataStr));
- crcFrame = Crc16Calc(0,dataToSend,sizeof(MoteHealthDataStr) + RADIO_PAYLOAD_OFFSET);
- dataToSend[sizeof(MoteHealthDataStr) + RADIO_PAYLOAD_OFFSET] = (uint8_t)((crcFrame & 0xFF00)>>8);
- dataToSend[sizeof(MoteHealthDataStr) + RADIO_PAYLOAD_OFFSET + 1] = (uint8_t)((crcFrame & 0x00FF));
- //send uart frame 4 bytes of metrics + payload msg + 2 bytes crc
- eHAL_UART_Send(GetUARTHandleInUse(),dataToSend,sizeof(MoteHealthDataStr) + RADIO_PAYLOAD_OFFSET + 2);
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement