uint8_t RNWK_OnPacketRx(RPHY_PacketDesc *packet) {
RNWK_ShortAddrType addr;
RMAC_MsgType type;
uint8_t res;
addr = RNWK_BUF_GET_DST_ADDR(packet->data);
if (addr==RNWK_ADDR_BROADCAST || addr==RNWK_GetThisNodeAddr()) { /* it is for me :-) */
type = RMAC_GetType(packet->data, packet->dataSize); /* get the type of the message */
if (type==RMAC_MSG_TYPE_ACK && RMAC_IsExpectedACK(packet->data, packet->dataSize)) {
/* it is an ACK, and the sequence number matches. Mark it with a flag and return, as no need for further processing */
packet->flags |= RPHY_PACKET_FLAGS_ACK;
return ERR_OK; /* no need to process the packet further */
} else if (type==RMAC_MSG_TYPE_DATA) { /* data packet received */
if (RNWK_AppOnRxCallback!=NULL) { /* do we have a callback? */
res = RNWK_AppOnRxCallback(packet); /* call upper layer */
if (res==ERR_OK) { /* all fine, now send acknowledge back */
addr = RNWK_BUF_GET_SRC_ADDR(packet->data); /* who should receive the ack? */
RNWK_BUF_SET_DST_ADDR(packet->data, addr); /* destination address is from where we got the data */
return RMAC_SendACK(packet); /* send ack message back */
}
}
} else {
return ERR_FAULT; /* wrong message type? */
}
}
return ERR_FAILED;
}
static uint8_t RAPP_OnPacketRx(RPHY_PacketDesc *packet) {
uint8_t size;
uint8_t *data;
RAPP_MSG_Type type;
RNWK_ShortAddrType srcAddr;
type = (RAPP_MSG_Type)RAPP_BUF_TYPE(packet->phyData);
size = RAPP_BUF_SIZE(packet->phyData);
data = RAPP_BUF_PAYLOAD_START(packet->phyData);
srcAddr = RNWK_BUF_GET_SRC_ADDR(packet->phyData);
return ParseMessage(type, size, data, srcAddr, packet);
}
uint8_t RNWK_SendACK(RPHY_PacketDesc *rxPacket, RNWK_ShortAddrType saddr) {
RNWK_ShortAddrType addr;
uint8_t buf[RMAC_BUFFER_SIZE];
RPHY_PacketDesc ackPacket;
ackPacket.flags = RPHY_PACKET_FLAGS_NONE;
ackPacket.phyData = buf;
ackPacket.phySize = sizeof(buf);
/* send an ack message back: this is is of type ack with src and dst address */
addr = RNWK_BUF_GET_SRC_ADDR(rxPacket->phyData); /* who should receive the ack? */
RNWK_BUF_SET_SRC_ADDR(ackPacket.phyData, saddr); /* set source address */
RNWK_BUF_SET_DST_ADDR(ackPacket.phyData, addr); /* destination address is from where we got the data */
return RMAC_SendACK(rxPacket, &ackPacket);
}
void RAPP_SniffPacket(RPHY_PacketDesc *packet, bool isTx) {
uint8_t buf[32];
const CLS1_StdIOType *io;
int i;
uint8_t dataSize;
RNWK_ShortAddrType addr;
io = CLS1_GetStdio();
if (isTx) {
CLS1_SendStr((unsigned char*)"Packet Tx ", io->stdOut);
} else {
CLS1_SendStr((unsigned char*)"Packet Rx ", io->stdOut);
}
UTIL1_strcpy(buf, sizeof(buf), (unsigned char*)"flags: ");
UTIL1_strcatNum16s(buf, sizeof(buf), packet->flags);
CLS1_SendStr(buf, io->stdOut);
if (packet->flags!=RPHY_PACKET_FLAGS_NONE) {
CLS1_SendStr((unsigned char*)"(", io->stdOut);
if (packet->flags&RPHY_PACKET_FLAGS_IS_ACK) {
CLS1_SendStr((unsigned char*)"IS_ACK,", io->stdOut);
}
if (packet->flags&RPHY_PACKET_FLAGS_REQ_ACK) {
CLS1_SendStr((unsigned char*)"REQ_ACK", io->stdOut);
}
CLS1_SendStr((unsigned char*)")", io->stdOut);
}
UTIL1_strcpy(buf, sizeof(buf), (unsigned char*)" size: ");
UTIL1_strcatNum16s(buf, sizeof(buf), packet->phySize);
CLS1_SendStr(buf, io->stdOut);
/* PHY */
CLS1_SendStr((unsigned char*)" PHY data: ", io->stdOut);
dataSize = RPHY_BUF_SIZE(packet->phyData);
for(i=0; i<dataSize+RPHY_HEADER_SIZE;i++) {
buf[0] = '\0';
UTIL1_strcatNum8Hex(buf, sizeof(buf), packet->phyData[i]);
UTIL1_strcat(buf, sizeof(buf), (unsigned char*)" ");
CLS1_SendStr(buf, io->stdOut);
}
/* MAC */
UTIL1_strcpy(buf, sizeof(buf), (unsigned char*)" MAC size:");
UTIL1_strcatNum8u(buf, sizeof(buf), dataSize);
UTIL1_strcat(buf, sizeof(buf), (unsigned char*)" type:");
UTIL1_strcatNum8Hex(buf, sizeof(buf), RMAC_BUF_TYPE(packet->phyData));
CLS1_SendStr(buf, io->stdOut);
RMAC_DecodeType(buf, sizeof(buf), packet);
CLS1_SendStr(buf, io->stdOut);
UTIL1_strcpy(buf, sizeof(buf), (unsigned char*)" s#:");
UTIL1_strcatNum8Hex(buf, sizeof(buf), RMAC_BUF_SEQN(packet->phyData));
CLS1_SendStr(buf, io->stdOut);
/* NWK */
UTIL1_strcpy(buf, sizeof(buf), (unsigned char*)" NWK src:");
addr = RNWK_BUF_GET_SRC_ADDR(packet->phyData);
#if RNWK_SHORT_ADDR_SIZE==1
UTIL1_strcatNum8Hex(buf, sizeof(buf), addr);
#else
UTIL1_strcatNum16Hex(buf, sizeof(buf), addr);
#endif
UTIL1_strcat(buf, sizeof(buf), (unsigned char*)" dst:");
addr = RNWK_BUF_GET_DST_ADDR(packet->phyData);
#if RNWK_SHORT_ADDR_SIZE==1
UTIL1_strcatNum8Hex(buf, sizeof(buf), addr);
#else
UTIL1_strcatNum16Hex(buf, sizeof(buf), addr);
#endif
CLS1_SendStr(buf, io->stdOut);
/* APP */
if (dataSize>RMAC_HEADER_SIZE+RNWK_HEADER_SIZE) { /* there is application data */
UTIL1_strcpy(buf, sizeof(buf), (unsigned char*)" APP type:");
UTIL1_strcatNum8Hex(buf, sizeof(buf), RAPP_BUF_TYPE(packet->phyData));
UTIL1_strcat(buf, sizeof(buf), (unsigned char*)" size:");
UTIL1_strcatNum8Hex(buf, sizeof(buf), RAPP_BUF_SIZE(packet->phyData));
CLS1_SendStr(buf, io->stdOut);
}
CLS1_SendStr((unsigned char*)"\r\n", io->stdOut);
}