data_t *try_get_free_data() 
{ 
boost::mutex::scoped_try_lock lock(m_free_mutex); 
if(!lock.owns_lock()) 
{ 
return NULL; 
} 
 
if(m_queuefreep->empty()) 
{ 
return NULL; 
} 
data_t* datap = m_queuefreep->front(); 
m_queuefreep->pop(); 
 
return datap; 
}; 

#include <stdexcept>                // for debug purpose 
 
template <typename item, unsigned int qsize> 
class queue { 
public: 
item data[qsize]; 
unsigned int rp,wp; 
bool full; 
 
queue():   rp(0),wp(0),full(false) {} 
 
bool empty() { return ((rp == wp) && (!full)); } 
 
unsigned int size() { 
if(!full)   return (wp-rp+qsize)%qsize; 
else        return qsize; 
} 
 
item& front() { 
if(empty()) throw; 
return data[rp]; 
} 
 
item& back() { 
if(empty()) throw; 
return data[(wp-1+qsize)%qsize]; 
} 
 
void push(const item dd) { 
if(full)    throw; 
data[wp] = dd; 
wp = (wp+1)%qsize; 
if(wp == rp)    full = true; 
} 
 
void pop(){ 
if(empty()) throw; 
rp = (rp + 1)%qsize; 
full = false; 
} 
}; 
 
template <typename item, unsigned int qsize> 
class stack 
{ 
public: 
item data[qsize]; 
unsigned int p; 
stack():   p(0){} 
 
bool empty() {  return (p == 0);} 
unsigned int size() { return p; } 
 
item& top(){ 
if(empty()) throw; 
return data[p-1]; 
} 
void push(const item dd) { 
if(p==qsize) throw; 
data[p++] = dd; 
} 
 
void pop() { 
if(empty()) throw; 
p--; 
} 
}; 

/* 
* myqueue.h 
*    meant to replace the STL queue. 
*  Created on: 2010-3-19 
*      Author: guoqiang 
*/ 
#ifndef MYQUEUE_H_ 
#define MYQUEUE_H_ 
 
#include <stdlib.h> 
#include <exception> 
#include <stdexcept>                // for debug purpose 
using namespace std; 
 
template <typename item> 
class gqueue 
{ 
public: 
gqueue(int capacity):   m_rp(0), m_wp(0), m_full(false) 
{ 
m_capacity = capacity; 
m_datap =  (item*)malloc(sizeof(item)*m_capacity); 
if(m_datap == NULL) 
{ 
throw(exception()); 
} 
} 
 
virtual ~gqueue() throw() 
{ 
if(m_datap) 
{ 
free(m_datap); 
m_datap = NULL; 
} 
}; 
 
bool empty() 
{ 
return ((m_rp == m_wp) && (!m_full)); 
} 
 
unsigned int size() 
{ 
if(!m_full) 
{ 
return (m_wp-m_rp+m_capacity)%m_capacity; 
} 
else 
{ 
return m_capacity; 
} 
} 
 
item& front() 
{ 
if(empty()) 
{ 
throw; 
} 
 
return m_datap[m_rp]; 
} 
 
item& back() 
{ 
if(empty()) 
{ 
throw; 
} 
return m_datap[(m_wp-1+m_capacity)%m_capacity]; 
} 
 
void push(const item dd) 
{ 
if(m_full) 
{ 
throw; 
} 
m_datap[m_wp] = dd; 
m_wp = (m_wp+1)%m_capacity; 
if(m_wp == m_rp) 
{ 
m_full = true; 
} 
} 
 
void pop() 
{ 
if(empty()) 
{ 
throw; 
} 
m_rp = (m_rp + 1)%m_capacity; 
m_full = false; 
} 
 
private: 
unsigned int m_capacity; 
// item data[qsize]; 
item* m_datap; 
unsigned int m_rp; 
unsigned int m_wp; 
bool m_full; 
 
}; 
 
#endif /* MYQUEUE_H_ */ 

原文来自：http://hi.baidu.com/goggle1/blog/item/0ea14befc4675ef7b2fb952a.html