messaging.c 4.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125
  1. /**
  2. *
  3. */
  4. #include <stdlib.h> // Required for libtelnet.h
  5. #include <esp_log.h>
  6. #include "stdbool.h"
  7. #include <lwip/def.h>
  8. #include <lwip/sockets.h>
  9. #include <errno.h>
  10. #include <string.h>
  11. #include "esp_app_trace.h"
  12. #include "esp_attr.h"
  13. #include "config.h"
  14. #include "nvs_utilities.h"
  15. #include "platform_esp32.h"
  16. #include "messaging.h"
  17. /************************************
  18. * Globals
  19. */
  20. const static char tag[] = "messaging";
  21. static messaging_list_t top;
  22. RingbufHandle_t messaging_create_ring_buffer(uint8_t max_count){
  23. RingbufHandle_t buf_handle = NULL;
  24. StaticRingbuffer_t *buffer_struct = (StaticRingbuffer_t *)heap_caps_malloc(sizeof(StaticRingbuffer_t), MALLOC_CAP_SPIRAM);
  25. if (buffer_struct != NULL) {
  26. size_t buf_size = (size_t )(sizeof(single_message_t)+8)*(size_t )(max_count>0?max_count:5); // no-split buffer requires an additional 8 bytes
  27. uint8_t *buffer_storage = (uint8_t *)heap_caps_malloc(buf_size, MALLOC_CAP_SPIRAM);
  28. if (buffer_storage== NULL) {
  29. ESP_LOGE(tag,"Failed to allocate memory for messaging ring buffer !");
  30. }
  31. else {
  32. buf_handle = xRingbufferCreateStatic(buf_size, RINGBUF_TYPE_NOSPLIT, buffer_storage, buffer_struct);
  33. if (buf_handle == NULL) {
  34. ESP_LOGE(tag,"Failed to create messaging ring buffer !");
  35. }
  36. }
  37. }
  38. else {
  39. ESP_LOGE(tag,"Failed to create ring buffer for messaging!");
  40. }
  41. return buf_handle;
  42. }
  43. RingbufHandle_t messaging_register_subscriber(uint8_t max_count, char * name){
  44. messaging_list_t * cur=&top;
  45. while(cur->next){
  46. cur = cur->next;
  47. }
  48. cur->next=heap_caps_malloc(sizeof(messaging_list_t), MALLOC_CAP_INTERNAL | MALLOC_CAP_8BIT);
  49. if(!cur->next){
  50. ESP_LOGE(tag,"Failed to allocate messaging subscriber entry!");
  51. return NULL;
  52. }
  53. memset(cur->next,0x00,sizeof(messaging_list_t));
  54. cur = cur->next;
  55. cur->buf_handle = messaging_create_ring_buffer(max_count);
  56. strncpy(cur->subscriber_name,name,sizeof(cur->subscriber_name));
  57. return cur->buf_handle;
  58. }
  59. esp_err_t messaging_service_init(){
  60. top.buf_handle = messaging_create_ring_buffer(max_count);
  61. if(!top.buf_handle){
  62. ESP_LOGE(tag, "messaging service init failed.");
  63. }
  64. strncpy(top.subscriber_name,"messaging");
  65. return (top.buf_handle!=NULL);
  66. }
  67. cJSON * messaging_retrieve_messages(RingbufHandle_t buf_handle){
  68. single_message_t * message=NULL;
  69. cJSON * json_messages=cJSON_CreateArray();
  70. cJSON * json_message=NULL;
  71. size_t item_size;
  72. UBaseType_t uxItemsWaiting;
  73. vRingbufferGetInfo(buf_handle, NULL, NULL, NULL, NULL, &uxItemsWaiting);
  74. if(uxItemsWaiting>0){
  75. message = (single_message_t *)xRingbufferReceive(buf_handle, &item_size, pdMS_TO_TICKS(50));
  76. //Check received data
  77. if (message== NULL) {
  78. ESP_LOGE(tag,"Failed to receive message from buffer!");
  79. }
  80. else {
  81. json_message = cJSON_CreateObject();
  82. cJSON_AddStringToObject(json_message, "message", message->message);
  83. cJSON_AddStringToObject(json_message, "type", message->message);
  84. cJSON_AddNumberToObject(json_message,"sent_time",message->sent_time);
  85. cJSON_AddNumberToObject(json_message,"current_time",esp_timer_get_time() / 1000);
  86. cJSON_AddItemToArray(json_messages,json_message);
  87. vRingbufferReturnItem(buf_handle, (void *)message);
  88. }
  89. }
  90. return json_messages;
  91. }
  92. void messaging_release_message(RingbufHandle_t buf_handle, single_message_t * message){
  93. }
  94. esp_err_t messageing_post_to_queue(messaging_list_t * subscriber, single_message_t * message){
  95. UBaseType_t res = xRingbufferSend(subscriber->buf_handle, message, sizeof(message), pdMS_TO_TICKS(1000));
  96. if (res != pdTRUE) {
  97. ESP_LOGE(tag,"Failed to post message to subscriber %s",subscriber->subscriber_name);
  98. return ESP_FAIL;
  99. }
  100. return ESP_OK;
  101. }
  102. void messaging_post_message(messaging_types type, char *fmt, ...){
  103. single_message_t message={};
  104. messaging_list_t * cur=&top;
  105. va_list va;
  106. va_start(va, fmt);
  107. vsnprintf(message.message, sizeof(message.message), fmt, va);
  108. va_end(va);
  109. message.type = type;
  110. message.sent_time = esp_timer_get_time() / 1000;
  111. while(cur->next){
  112. messageing_post_to_queue(cur, &message);
  113. cur = cur->next;
  114. }
  115. return;
  116. }