Небольшой эксперимент в написании кода на си. Avr

// Работает. Минус: находится первое же сообщение, но, АКТУАЛЬНОЕ сообщение может быть отправлено позже.
// 453 такта. 28,31 мкс
/*
u08 get_message (u08 num)
{
struct msg_queue *p_msg_queue_1 = Msg_Queue;
struct msg_queue *p_msg_queue_2 = Msg_Queue + 1;
 
u08 cnt = MSG_QUEUE_SIZE;
u08 msg = 0xFF;
 
if (p_msg_queue_1 -> num_fsm != 0xFF)
{
while (cnt--)
{
if (p_msg_queue_1 -> num_fsm == num)
{
msg = p_msg_queue_1 -> msg_fsm;
 
while (cnt--)
{
p_msg_queue_1 -> num_fsm = p_msg_queue_2 -> num_fsm;
p_msg_queue_1++ -> msg_fsm = p_msg_queue_2++ -> msg_fsm;
}
p_msg_queue_1 -> num_fsm = 0xFF;
p_msg_queue_1 -> msg_fsm = 0xFF;
return msg;
}
p_msg_queue_1++;
p_msg_queue_2++;
}
}
return msg;
}
*/
 
// 814 тактов. 50,88 мкс
u08 get_message (u08 num)
{
u08 cnt = 0;
u08 msg = 0xFF;
 
if (Msg_Queue [cnt].num_fsm != 0xFF)
{
while (cnt < MSG_QUEUE_SIZE)
{
if (Msg_Queue[cnt].num_fsm == num)
{
msg = Msg_Queue[cnt].msg_fsm;
 
while (cnt < (MSG_QUEUE_SIZE - 1))
{
Msg_Queue[cnt].num_fsm = Msg_Queue[cnt+1].num_fsm;
Msg_Queue[cnt].msg_fsm = Msg_Queue[cnt+1].msg_fsm;
cnt++;
}
Msg_Queue[cnt].num_fsm = 0xFF;
Msg_Queue[cnt].msg_fsm = 0xFF;
return msg;
}
cnt++;
}
}
return msg;
}