3 * Copyright 2007,2008 Free Software Foundation, Inc.
5 * This file is part of GNU Radio
7 * GNU Radio is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 3, or (at your option)
12 * GNU Radio is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
17 * You should have received a copy of the GNU General Public License along
18 * with this program; if not, write to the Free Software Foundation, Inc.,
19 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
25 #include <mblock/msg_queue.h>
26 #include <mblock/message.h>
29 mb_msg_queue::mb_msg_queue()
30 : d_not_empty(&d_mutex)
34 mb_msg_queue::~mb_msg_queue()
39 mb_msg_queue::insert(mb_message_sptr msg)
41 omni_mutex_lock l(d_mutex);
43 mb_pri_t q = mb_pri_clamp(msg->priority());
45 if (d_queue[q].empty_p()){
46 d_queue[q].tail = d_queue[q].head = msg;
47 msg->d_next.reset(); //msg->d_next = 0;
50 d_queue[q].tail->d_next = msg;
51 d_queue[q].tail = msg;
52 msg->d_next.reset(); // msg->d_next = 0;
55 // FIXME set bit in bitmap
61 * Delete highest pri message from the queue and return it.
62 * Returns equivalent of zero pointer if queue is empty.
64 * Caller must be holding d_mutex
67 mb_msg_queue::get_highest_pri_msg_helper()
69 // FIXME use bitmap and ffz to find best queue in O(1)
71 for (mb_pri_t q = 0; q <= MB_PRI_WORST; q++){
73 if (!d_queue[q].empty_p()){
74 mb_message_sptr msg = d_queue[q].head;
75 d_queue[q].head = msg->d_next;
76 if (d_queue[q].head == 0){
77 d_queue[q].tail.reset(); // d_queue[q].tail = 0;
78 // FIXME clear bit in bitmap
81 msg->d_next.reset(); // msg->d_next = 0;
86 return mb_message_sptr(); // eqv to a zero pointer
91 mb_msg_queue::get_highest_pri_msg_nowait()
93 omni_mutex_lock l(d_mutex);
95 return get_highest_pri_msg_helper();
99 mb_msg_queue::get_highest_pri_msg()
101 omni_mutex_lock l(d_mutex);
104 mb_message_sptr msg = get_highest_pri_msg_helper();
105 if (msg) // Got one; return it
108 d_not_empty.wait(); // Wait for something
113 mb_msg_queue::get_highest_pri_msg_timedwait(const mb_time &abs_time)
115 unsigned long secs = abs_time.d_secs;
116 unsigned long nsecs = abs_time.d_nsecs;
118 omni_mutex_lock l(d_mutex);
121 mb_message_sptr msg = get_highest_pri_msg_helper();
122 if (msg) // Got one; return it
125 if (!d_not_empty.timedwait(secs, nsecs)) // timed out
126 return mb_message_sptr(); // eqv to zero pointer