event_record.c 1.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172
  1. #include <stdbool.h>
  2. #include <string.h>
  3. #include "event_record.h"
  4. #include "libs/shark_task.h"
  5. #define MAX_EVENT_SIZE 100
  6. static event_record_t _event[MAX_EVENT_SIZE];
  7. static event_record_t _max_current;
  8. static int event_w_idx = 0;
  9. static bool _event_full = false;
  10. void push_event(event_id_t id, s32 data) {
  11. if (id == Aux_Current_Short) {//when multi aux short, only recode the old
  12. for (int i = 0; i < MAX_EVENT_SIZE; i++) {
  13. if (_event[i].id == Aux_Current_Short) {
  14. if (shark_get_seconds() - _event[i].timestamp <= 1) {
  15. return;
  16. }
  17. }
  18. }
  19. }
  20. event_record_t *pevent = &_event[event_w_idx];
  21. event_w_idx = (event_w_idx + 1) % MAX_EVENT_SIZE;
  22. if (event_w_idx == 0) {
  23. _event_full = true;
  24. }
  25. pevent->id = id;
  26. pevent->timestamp = shark_get_seconds();
  27. pevent->data = data;
  28. }
  29. void push_max_current(s32 current) {
  30. _max_current.id = Max_current_persis;
  31. _max_current.timestamp = shark_get_seconds();
  32. if (abs(current) > abs(_max_current.data)) {
  33. _max_current.data = current;
  34. }
  35. }
  36. static int _event_size(void) {
  37. if (_event_full) {
  38. return MAX_EVENT_SIZE;
  39. }
  40. return event_w_idx;
  41. }
  42. int get_event(int num, int offset, u8 *recoder) {
  43. if (offset >= _event_size()) {
  44. if (offset == _event_size()) {
  45. memcpy(recoder, &_max_current, sizeof(event_record_t));
  46. return 1;
  47. }
  48. return 0;
  49. }
  50. num = MIN(num, _event_size()-offset);
  51. int rtn = 0;
  52. if (_event_full) {
  53. offset += event_w_idx;
  54. }
  55. while(num > 0) {
  56. memcpy(recoder, _event + offset % MAX_EVENT_SIZE, sizeof(event_record_t));
  57. num --;
  58. offset ++;
  59. recoder += sizeof(event_record_t);
  60. rtn ++;
  61. }
  62. return rtn;
  63. }