forked from gatsby/datalink_repo
omit redundant code.
This commit is contained in:
@@ -81,8 +81,6 @@ static int32_t MgmtMsg_Packing(L2_INST* instPtr, BIT_ARRAY* bitarr, L2_MSG_TYPE
|
|||||||
return EPARAM;
|
return EPARAM;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
memset(bitarr->words, 0x99, (size_t) (MGMT_MSG_LEN / 8));
|
|
||||||
switch (msgType) {
|
switch (msgType) {
|
||||||
case L2_MSG_TK_INIT:
|
case L2_MSG_TK_INIT:
|
||||||
// Series tag
|
// Series tag
|
||||||
@@ -918,9 +916,6 @@ int32_t MgmtNet_Routine(L2_INST* instPtr, const L2_RTNE_TABLE_ENTRY* rtneEntry){
|
|||||||
}
|
}
|
||||||
|
|
||||||
// Update RTT FSM if needed.
|
// Update RTT FSM if needed.
|
||||||
if (L2_GetLastFrameType(instPtr) == L2_INTRA_TSYNC_FRAME && L2_GetLastTor(instPtr) == L2_TOR_RX) {
|
|
||||||
RTT_FsmUpdate(instPtr, L2_TOR_RX);
|
|
||||||
}
|
|
||||||
if (rtneEntry->slotType == L2_SLOT_INTRA_TSYNC) {
|
if (rtneEntry->slotType == L2_SLOT_INTRA_TSYNC) {
|
||||||
if(torState == L2_TOR_TX) {
|
if(torState == L2_TOR_TX) {
|
||||||
RTT_FsmUpdate(instPtr, L2_TOR_TX);
|
RTT_FsmUpdate(instPtr, L2_TOR_TX);
|
||||||
@@ -942,7 +937,7 @@ int32_t MgmtNet_Routine(L2_INST* instPtr, const L2_RTNE_TABLE_ENTRY* rtneEntry){
|
|||||||
L2_SetupNextSlot(instPtr, torState, L2_INTER_MGMT_FRAME);
|
L2_SetupNextSlot(instPtr, torState, L2_INTER_MGMT_FRAME);
|
||||||
break;
|
break;
|
||||||
case L2_SLOT_INTRA_MGMT:
|
case L2_SLOT_INTRA_MGMT:
|
||||||
memset(instPtr->sendPktData, 0xAA, INTRA_MGMT_FRAME_LENGTH_MAX);
|
memset(instPtr->sendPktData, 0xAA, L2_PACKET_LEN_MAX);
|
||||||
if (torState == L2_TOR_TX) {
|
if (torState == L2_TOR_TX) {
|
||||||
if(MgmtPkt_Packing(instPtr, MGMTPKT_INTRA_MGMT) != SUCCESS) {
|
if(MgmtPkt_Packing(instPtr, MGMTPKT_INTRA_MGMT) != SUCCESS) {
|
||||||
Status = FAILURE;
|
Status = FAILURE;
|
||||||
@@ -957,7 +952,7 @@ int32_t MgmtNet_Routine(L2_INST* instPtr, const L2_RTNE_TABLE_ENTRY* rtneEntry){
|
|||||||
break;
|
break;
|
||||||
case L2_SLOT_INTRA_TSYNC:
|
case L2_SLOT_INTRA_TSYNC:
|
||||||
if (torState == L2_TOR_TX) {
|
if (torState == L2_TOR_TX) {
|
||||||
memset(instPtr->sendPktData, 0xAA, INTRA_RTT_FRAME_LENGTH_MAX);
|
memset(instPtr->sendPktData, 0xAA, L2_PACKET_LEN_MAX);
|
||||||
if(L2_GetNodeType(instPtr) == L2_NODE_HEAD){
|
if(L2_GetNodeType(instPtr) == L2_NODE_HEAD){
|
||||||
if(MgmtPkt_Packing(instPtr, MGMTPKT_INTRA_RTTREQ) != SUCCESS) {
|
if(MgmtPkt_Packing(instPtr, MGMTPKT_INTRA_RTTREQ) != SUCCESS) {
|
||||||
Status = FAILURE;
|
Status = FAILURE;
|
||||||
|
|||||||
@@ -141,7 +141,6 @@ static int32_t ScanMsg_Packing(L2_INST* instPtr, BIT_ARRAY* bitarr, L2_MSG_TYPE
|
|||||||
return (EPARAM);
|
return (EPARAM);
|
||||||
}
|
}
|
||||||
uint64_t dataChunk = 0;
|
uint64_t dataChunk = 0;
|
||||||
memset(bitarr->words, 0xAA, (size_t)(bitarr->num_of_bits / 8));
|
|
||||||
switch (msgType) {
|
switch (msgType) {
|
||||||
case L2_MSG_BM:
|
case L2_MSG_BM:
|
||||||
if (bitarr->num_of_bits < BM_MSG_LEN) {
|
if (bitarr->num_of_bits < BM_MSG_LEN) {
|
||||||
@@ -553,6 +552,9 @@ static int32_t Scan_2WAcqHandler (L2_INST* instPtr){
|
|||||||
else {
|
else {
|
||||||
scanFsmPtr->w2acqTimeout++; // increase counter.
|
scanFsmPtr->w2acqTimeout++; // increase counter.
|
||||||
}
|
}
|
||||||
|
// using pull mode to receive 2wacq frame
|
||||||
|
// since first time sync procedure is accomplished in BM stage.
|
||||||
|
Phy_SetMode(instPtr->config.phyInstPtr, PHY_MODE_PULL);
|
||||||
L2_SetupNextSlot(instPtr, L2_TOR_RX, frameType);
|
L2_SetupNextSlot(instPtr, L2_TOR_RX, frameType);
|
||||||
return SUCCESS;
|
return SUCCESS;
|
||||||
}
|
}
|
||||||
@@ -647,7 +649,7 @@ int32_t ScanNet_PktHandler(L2_INST* instPtr) {
|
|||||||
|
|
||||||
if ( L2_isCxn2Net(instPtr) == false ) {
|
if ( L2_isCxn2Net(instPtr) == false ) {
|
||||||
// TODO: Check
|
// TODO: Check
|
||||||
L2_TimeAlign(instPtr, scanFsmPtr->BMrcvLog.frameNum, scanFsmPtr->BMrcvLog.slotNum, false);
|
L2_TimeAlign(instPtr, scanFsmPtr->BMrcvLog.frameNum, scanFsmPtr->BMrcvLog.slotNum, true);
|
||||||
}
|
}
|
||||||
// trigger flag
|
// trigger flag
|
||||||
BmrecvStateUpdate(scanFsmPtr, true);
|
BmrecvStateUpdate(scanFsmPtr, true);
|
||||||
@@ -979,7 +981,7 @@ int32_t ScanNet_Routine(L2_INST* instPtr, const L2_RTNE_TABLE_ENTRY* rtneEntry)
|
|||||||
Status = FAILURE;
|
Status = FAILURE;
|
||||||
goto routine_err;
|
goto routine_err;
|
||||||
}
|
}
|
||||||
memset(instPtr->sendPktData, 0xAA, INTRA_BM_FRAME_LENGTH_MAX);
|
memset(instPtr->sendPktData, 0xAA, L2_PACKET_LEN_MAX);
|
||||||
if(ScanPkt_Packing(instPtr, SCANPKT_INTRA_BM) != SUCCESS) {
|
if(ScanPkt_Packing(instPtr, SCANPKT_INTRA_BM) != SUCCESS) {
|
||||||
Status = FAILURE;
|
Status = FAILURE;
|
||||||
goto routine_err;
|
goto routine_err;
|
||||||
@@ -995,12 +997,11 @@ int32_t ScanNet_Routine(L2_INST* instPtr, const L2_RTNE_TABLE_ENTRY* rtneEntry)
|
|||||||
case L2_SLOT_INTRA_SCAN_2W:
|
case L2_SLOT_INTRA_SCAN_2W:
|
||||||
if (torState == L2_TOR_TX) {
|
if (torState == L2_TOR_TX) {
|
||||||
if(L2_GetNodeType(instPtr) != L2_NODE_HEAD && L2_isDataAvail(instPtr) == false) {
|
if(L2_GetNodeType(instPtr) != L2_NODE_HEAD && L2_isDataAvail(instPtr) == false) {
|
||||||
/* Antenna setting (reserved.) */
|
// skip...
|
||||||
L2_SetupNextSlot(instPtr, L2_TOR_SUSPEND, L2_INTRA_W2_ACQ_FRAME);
|
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
/* Prepare Request/ACK data. */
|
/* Prepare Request/ACK data. */
|
||||||
memset(instPtr->sendPktData, 0xAA, (size_t) INTRA_W2ACQ_FRAME_LENGTH_MAX);
|
memset(instPtr->sendPktData, 0xAA, L2_PACKET_LEN_MAX);
|
||||||
/* Pack message words */
|
/* Pack message words */
|
||||||
if(ScanPkt_Packing(instPtr, SCANPKT_INTRA_2WACQ) != SUCCESS) {
|
if(ScanPkt_Packing(instPtr, SCANPKT_INTRA_2WACQ) != SUCCESS) {
|
||||||
Status = FAILURE;
|
Status = FAILURE;
|
||||||
|
|||||||
@@ -65,7 +65,6 @@ static int UduHeader_Packing(L2_INST* instPtr, BIT_ARRAY* bitarr, uint8_t dst, u
|
|||||||
return EPARAM;
|
return EPARAM;
|
||||||
}
|
}
|
||||||
uint64_t dataChunk = 0;
|
uint64_t dataChunk = 0;
|
||||||
memset(bitarr->words, 0xF0, (size_t)(UDUH_LEN/8));
|
|
||||||
// priority
|
// priority
|
||||||
dataChunk = 1;
|
dataChunk = 1;
|
||||||
FrameInsertChunk(bitarr, UDUH_PRI_OFFSET, UDUH_PRI_LEN, dataChunk);
|
FrameInsertChunk(bitarr, UDUH_PRI_OFFSET, UDUH_PRI_LEN, dataChunk);
|
||||||
@@ -118,7 +117,6 @@ static int PduHeader_Packing(L2_INST* instPtr, BIT_ARRAY* bitarr, L2_PDU_HEADER_
|
|||||||
if(bitarr->num_of_bits < PDUH0_LEN){
|
if(bitarr->num_of_bits < PDUH0_LEN){
|
||||||
return EPARAM;
|
return EPARAM;
|
||||||
}
|
}
|
||||||
memset(bitarr->words, 0xF0, (size_t)(PDUH0_LEN/8));
|
|
||||||
// PDU type
|
// PDU type
|
||||||
dataChunk = 0;
|
dataChunk = 0;
|
||||||
FrameInsertChunk(bitarr, PDUH0_TYPE_OFFSET, PDUH0_TYPE_LEN, dataChunk);
|
FrameInsertChunk(bitarr, PDUH0_TYPE_OFFSET, PDUH0_TYPE_LEN, dataChunk);
|
||||||
@@ -141,7 +139,6 @@ static int PduHeader_Packing(L2_INST* instPtr, BIT_ARRAY* bitarr, L2_PDU_HEADER_
|
|||||||
if(bitarr->num_of_bits < PDUH1_LEN){
|
if(bitarr->num_of_bits < PDUH1_LEN){
|
||||||
return EPARAM;
|
return EPARAM;
|
||||||
}
|
}
|
||||||
memset(bitarr->words, 0xF0, (size_t)(PDUH1_LEN/8));
|
|
||||||
// PDU type
|
// PDU type
|
||||||
dataChunk = 1;
|
dataChunk = 1;
|
||||||
FrameInsertChunk(bitarr, PDUH1_TYPE_OFFSET, PDUH1_TYPE_LEN, dataChunk);
|
FrameInsertChunk(bitarr, PDUH1_TYPE_OFFSET, PDUH1_TYPE_LEN, dataChunk);
|
||||||
@@ -246,7 +243,6 @@ int32_t ServiceNet_Routine(L2_INST* instPtr, const L2_RTNE_TABLE_ENTRY* rtneEntr
|
|||||||
DBG_ERROR("Failed to allocate memory for svcMsg.\n");
|
DBG_ERROR("Failed to allocate memory for svcMsg.\n");
|
||||||
return FAILURE;
|
return FAILURE;
|
||||||
}
|
}
|
||||||
memset(instPtr->sendPktData, 0xCC, (size_t)(INTRA_SVC_FRAME_LENGTH_MAX));
|
|
||||||
switch(rtneEntry->slotType){
|
switch(rtneEntry->slotType){
|
||||||
case L2_SLOT_INTER_SVC:
|
case L2_SLOT_INTER_SVC:
|
||||||
L2_SetupNextSlot(instPtr, torState, L2_INTER_SVC_FRAME);
|
L2_SetupNextSlot(instPtr, torState, L2_INTER_SVC_FRAME);
|
||||||
@@ -254,7 +250,7 @@ int32_t ServiceNet_Routine(L2_INST* instPtr, const L2_RTNE_TABLE_ENTRY* rtneEntr
|
|||||||
case L2_SLOT_INTRA_SVC:
|
case L2_SLOT_INTRA_SVC:
|
||||||
if(torState == L2_TOR_TX){
|
if(torState == L2_TOR_TX){
|
||||||
//TODO:
|
//TODO:
|
||||||
memset(instPtr->sendPktData, 0x00, INTRA_SVC_FRAME_LENGTH_MAX);
|
memset(instPtr->sendPktData, 0xAA, L2_PACKET_LEN_MAX);
|
||||||
// Pack PDU header
|
// Pack PDU header
|
||||||
if(PduHeader_Packing(instPtr, svcMsg, L2_PDU_HEADER_0, rtneEntry->dst0) != SUCCESS){
|
if(PduHeader_Packing(instPtr, svcMsg, L2_PDU_HEADER_0, rtneEntry->dst0) != SUCCESS){
|
||||||
DBG_ERROR("Failed to packing PduHeader.\n");
|
DBG_ERROR("Failed to packing PduHeader.\n");
|
||||||
|
|||||||
@@ -323,9 +323,8 @@ void L2_EventPoolHandler(L2_INST* instPtr){
|
|||||||
DBG_ERROR("Failed to initialize schedule event pool iteration.\n");
|
DBG_ERROR("Failed to initialize schedule event pool iteration.\n");
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
while (iter->next != NULL)
|
while ((node = list_iterator_next(iter)))
|
||||||
{
|
{
|
||||||
node = list_iterator_next(iter);
|
|
||||||
event = (L2_SCHD_EVENT*)node->val;
|
event = (L2_SCHD_EVENT*)node->val;
|
||||||
if(L2_isEventScheduled(event)){
|
if(L2_isEventScheduled(event)){
|
||||||
if(event->schdFrame == L2_GetCurrentFrameNum(instPtr)
|
if(event->schdFrame == L2_GetCurrentFrameNum(instPtr)
|
||||||
|
|||||||
Reference in New Issue
Block a user