uint8_t RNWK_OnPacketRx(RPHY_PacketDesc *packet) { RNWK_ShortAddrType addr; RMAC_MsgType type; addr = RNWK_BUF_GET_DST_ADDR(packet->phyData); if (addr==RNWK_ADDR_BROADCAST || addr==RNWK_GetThisNodeAddr()) { /* it is for me :-) */ type = RMAC_GetType(packet->phyData, packet->phySize); /* get the type of the message */ if (RMAC_MSG_TYPE_IS_ACK(type) && RMAC_IsExpectedACK(packet->phyData, packet->phySize)) { /* 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_IS_ACK; return ERR_OK; /* no need to process the packet further */ } else if (RMAC_MSG_TYPE_IS_DATA(type)) { /* data packet received */ if (RNWK_AppOnRxCallback!=NULL) { /* do we have a callback? */ #if RNET_CONFIG_USE_ACK if (RMAC_MSG_TYPE_REQ_ACK(type)) { (void)RNWK_SendACK(packet, RNWK_GetThisNodeAddr()); /* send ack message back */ } #endif return RNWK_AppOnRxCallback(packet); /* call upper layer */ } } else { return ERR_FAULT; /* wrong message type? */ } } return ERR_FAILED; }
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; }
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); }