75 lines
		
	
	
		
			1.9 KiB
		
	
	
	
		
			C++
		
	
	
		
			Executable File
		
	
	
	
	
			
		
		
	
	
			75 lines
		
	
	
		
			1.9 KiB
		
	
	
	
		
			C++
		
	
	
		
			Executable File
		
	
	
	
	
| /*
 | |
|  * Copyright (c) 2006-2021, RT-Thread Development Team
 | |
|  *
 | |
|  * SPDX-License-Identifier: Apache-2.0
 | |
|  *
 | |
|  * Change Logs:
 | |
|  * Date           Author       Notes
 | |
|  * 2016/10/1      Bernard      The first version
 | |
|  */
 | |
| 
 | |
| #pragma once
 | |
| 
 | |
| #include <stdint.h>
 | |
| #include <string.h>
 | |
| 
 | |
| #include <rtthread.h>
 | |
| 
 | |
| namespace rtthread {
 | |
| 
 | |
| /**
 | |
|  * The Queue class allow to control, send, receive, or wait for messages.
 | |
|  * A message can be a integer or pointer value  to a certain type T that is send
 | |
|  * to a thread or interrupt service routine.
 | |
|  * @param  T         data type of a single message element.
 | |
|  * @param  queue_sz  maximum number of messages in queue.
 | |
|  */
 | |
| template<typename T, uint32_t queue_sz>
 | |
| class Queue
 | |
| {
 | |
| public:
 | |
|     /** Create and initialise a message Queue. */
 | |
|     Queue()
 | |
|     {
 | |
|         rt_mq_init(&mID, "mq", mPool, sizeof(T), sizeof(mPool), RT_IPC_FLAG_FIFO);
 | |
|     };
 | |
| 
 | |
|     ~Queue()
 | |
|     {
 | |
|         rt_mq_detach(&mID);
 | |
|     };
 | |
| 
 | |
|     /** Put a message in a Queue.
 | |
|       @param   data      message pointer.
 | |
|       @param   millisec  timeout value or 0 in case of no time-out. (default: 0)
 | |
|       @return  status code that indicates the execution status of the function.
 | |
|     */
 | |
|     rt_err_t put(T& data, int32_t millisec = 0)
 | |
|     {
 | |
|         return rt_mq_send(&mID, &data, sizeof(data));
 | |
|     }
 | |
| 
 | |
|     /** Get a message or Wait for a message from a Queue.
 | |
|       @param   millisec  timeout value or 0 in case of no time-out. (default: osWaitForever).
 | |
|       @return  bool .
 | |
|     */
 | |
|     bool get(T& data, int32_t millisec = WAIT_FOREVER)
 | |
|     {
 | |
|         rt_int32_t tick;
 | |
| 
 | |
|         if (millisec < 0)
 | |
|             tick = -1;
 | |
|         else
 | |
|             tick = rt_tick_from_millisecond(millisec);
 | |
| 
 | |
|         return rt_mq_recv(&mID, &data, sizeof(data), tick) >= 0;
 | |
|     }
 | |
| 
 | |
| private:
 | |
|     struct rt_messagequeue mID;
 | |
| 
 | |
|     char mPool[(sizeof(void *) + RT_ALIGN(sizeof(T), RT_ALIGN_SIZE)) * queue_sz];
 | |
| };
 | |
| 
 | |
| }
 |