void Shm_Locked_queue_Add( Shm_Locked_queue_Control *lq_cb, Shm_Envelope_control *ecb ) { uint32_t index; ecb->next = Shm_Locked_queue_End_of_list; ecb->queue = lq_cb->owner; index = ecb->index; Shm_Lock( lq_cb ); if ( Shm_Convert(lq_cb->front) != Shm_Locked_queue_End_of_list ) Shm_Envelopes[ Shm_Convert(lq_cb->rear) ].next = index; else lq_cb->front = index; lq_cb->rear = index; Shm_Unlock( lq_cb ); }
Shm_Envelope_control *Shm_Locked_queue_Get( Shm_Locked_queue_Control *lq_cb ) { Shm_Envelope_control *tmp_ecb; uint32_t tmpfront; tmp_ecb = NULL; Shm_Lock( lq_cb ); tmpfront = Shm_Convert(lq_cb->front); if ( tmpfront != Shm_Locked_queue_End_of_list ) { tmp_ecb = &Shm_Envelopes[ tmpfront ]; lq_cb->front = tmp_ecb->next; if ( tmp_ecb->next == Shm_Locked_queue_End_of_list ) lq_cb->rear = Shm_Locked_queue_End_of_list; tmp_ecb->next = Shm_Locked_queue_Not_on_list; } Shm_Unlock( lq_cb ); return( tmp_ecb ); }