luat_rtos_freertos_queue.c 1.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384
  1. #ifdef LUAT_FREERTOS_FULL_INCLUDE
  2. #include "freertos/FreeRTOS.h"
  3. #include "freertos/task.h"
  4. #include "freertos/queue.h"
  5. #include "freertos/semphr.h"
  6. #include "freertos/timers.h"
  7. #else
  8. #include "FreeRTOS.h"
  9. #include "task.h"
  10. #include "queue.h"
  11. #include "semphr.h"
  12. #include "timers.h"
  13. #endif
  14. #include "luat_base.h"
  15. #include "luat_rtos.h"
  16. int luat_rtos_queue_create(luat_rtos_queue_t *queue_handle, uint32_t item_count, uint32_t item_size)
  17. {
  18. if (!queue_handle) return -1;
  19. *queue_handle = xQueueCreate(item_count, item_size);
  20. return (*queue_handle)?0:-1;
  21. }
  22. int luat_rtos_queue_delete(luat_rtos_queue_t queue_handle)
  23. {
  24. if (!queue_handle) return -1;
  25. vQueueDelete ((QueueHandle_t)queue_handle);
  26. return 0;
  27. }
  28. int luat_rtos_queue_send(luat_rtos_queue_t queue_handle, void *item, uint32_t item_size, uint32_t timeout)
  29. {
  30. if (!queue_handle || !item) return -1;
  31. if (luat_rtos_get_ipsr())
  32. {
  33. BaseType_t pxHigherPriorityTaskWoken;
  34. if (xQueueSendFromISR(queue_handle, item, &pxHigherPriorityTaskWoken) != pdPASS)
  35. return -1;
  36. portYIELD_FROM_ISR(pxHigherPriorityTaskWoken);
  37. return 0;
  38. }
  39. else
  40. {
  41. if (xQueueSend(queue_handle, item, luat_rtos_ms2tick(timeout)) != pdPASS)
  42. return -1;
  43. }
  44. return 0;
  45. }
  46. int luat_rtos_queue_recv(luat_rtos_queue_t queue_handle, void *item, uint32_t item_size, uint32_t timeout)
  47. {
  48. if (!queue_handle || !item)
  49. return -1;
  50. BaseType_t yield = pdFALSE;
  51. if (luat_rtos_get_ipsr())
  52. {
  53. if (xQueueReceiveFromISR(queue_handle, item, &yield) != pdPASS)
  54. return -1;
  55. portYIELD_FROM_ISR(yield);
  56. return 0;
  57. }
  58. else
  59. {
  60. if (xQueueReceive(queue_handle, item, luat_rtos_ms2tick(timeout)) != pdPASS)
  61. return -1;
  62. }
  63. return 0;
  64. }
  65. int luat_rtos_queue_get_cnt(luat_rtos_queue_t queue_handle, uint32_t *item_cnt)
  66. {
  67. if (!queue_handle || !item_cnt)
  68. return -1;
  69. if (luat_rtos_get_ipsr()) {
  70. *item_cnt = uxQueueMessagesWaitingFromISR(queue_handle);
  71. }
  72. else {
  73. *item_cnt = uxQueueMessagesWaiting(queue_handle);
  74. }
  75. return 0;
  76. }