led.c 4.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194
  1. #include "led.h"
  2. #include "timer.h"
  3. #include "gpio.h"
  4. #include "paras.h"
  5. #include "log.h"
  6. #ifdef BOARD_EVB_ATK
  7. #define LEDR_GPIO GET_PIN(F, 9)
  8. #define LEDG_GPIO GET_PIN(F, 10)
  9. #else
  10. #define LEDR_GPIO GET_PIN(D, 1)
  11. #define LEDG_GPIO GET_PIN(D, 0)
  12. #endif
  13. typedef struct {
  14. int gpio;
  15. int on_level;
  16. int off_level;
  17. }led_info_t;
  18. static led_info_t led_info[LED_ID_MAX]={
  19. {LEDR_GPIO, 0, 1},
  20. {LEDG_GPIO, 0, 1},
  21. };
  22. typedef struct {
  23. int io;
  24. led_para_t para;
  25. led_info_t *info;
  26. uint32_t cnt;
  27. int tmr;
  28. }led_data_t;
  29. typedef struct {
  30. int tmr;
  31. int mode;
  32. led_data_t data[LED_ID_MAX];
  33. }led_handle_t;
  34. extern uint8_t flah_status;
  35. extern void flash_clear();
  36. static led_para_t led_para[LED_MODE_MAX]={
  37. #if 0
  38. {LED_ID_GREEN, 1000,0, -1, 0}, //LED_MODE_NORMAL
  39. {LED_ID_GREEN, 300, 300, -1, 0}, //LED_MODE_UPGRADING
  40. {LED_ID_RED, 1000, 1000, 5, 0}, //LED_MODE_WARN1,
  41. {LED_ID_RED, 1000, 1000, 10, 0}, //LED_MODE_WARN2,
  42. {LED_ID_RED, 500, 500, 10, 0}, //LED_MODE_ERROR,
  43. {LED_ID_RED, 200, 200, 25, 0}, //LED_MODE_FAULT
  44. {LED_ID_RED, 50, 50, -1, 0}, //LED_MODE_FATAL
  45. #else
  46. {LED_ID_GREEN, 1000, 1000, -1, 0}, //LED_MODE_NORMAL
  47. {LED_ID_GREEN, 300, 1000, -1, 0}, //LED_MODE_UPGRADING
  48. {LED_ID_GREEN, 500, 500, 60, 0}, //LED_MODE_WARN1,
  49. {LED_ID_GREEN, 333, 333, 450, 0}, //LED_MODE_WARN2,
  50. {LED_ID_GREEN, 500, 500, 10, 0}, //LED_MODE_ERROR,
  51. {LED_ID_GREEN, 200, 200, 25, 0}, //LED_MODE_FAULT
  52. {LED_ID_GREEN, 50, 50, -1, 0}, //LED_MODE_FATAL
  53. #endif
  54. };
  55. static led_handle_t ledHandle={0};
  56. static void led_handler(void *arg, int last)
  57. {
  58. int level;
  59. led_data_t *h=(led_data_t*)arg;
  60. LOG_D("flash!\n");
  61. if(h->para.on_ms>0 && h->para.off_ms) {
  62. h->cnt++;
  63. if(h->cnt%2) {
  64. gpio_set(h->io, h->info->off_level);
  65. }
  66. else {
  67. gpio_set(h->io, h->info->on_level);
  68. }
  69. }
  70. if(last) {
  71. timer_stop(h->tmr);
  72. if(h->para.end_on) {
  73. gpio_set(h->io, h->info->on_level);
  74. }
  75. else {
  76. gpio_set(h->io, h->info->off_level);
  77. }
  78. flah_status = 1;
  79. // led_reset();
  80. }
  81. }
  82. //////////////////////////////////////////////////
  83. int led_init(void)
  84. {
  85. int i;
  86. led_handle_t *h=&ledHandle;
  87. h->tmr = timer_init();
  88. for(i=0; i<LED_ID_MAX; i++) {
  89. h->data[i].info = &led_info[i];
  90. h->data[i].cnt = 0;
  91. h->data[i].tmr = h->tmr;
  92. h->data[i].io = led_info[i].gpio;
  93. gpio_init(h->data[i].io, GPIO_OUT, led_info[i].off_level);
  94. }
  95. h->mode = -1;
  96. gpio_set(LEDR_GPIO,1);
  97. //led_set(LED_MODE_UPGRADING);
  98. return 0;
  99. }
  100. int led_deinit(void)
  101. {
  102. int i;
  103. led_handle_t *h=&ledHandle;
  104. timer_deinit(h->tmr);
  105. for(i=0; i<LED_ID_MAX; i++) {
  106. gpio_deinit(h->data[i].io);
  107. h->data[i].io = -1;
  108. }
  109. return 0;
  110. }
  111. int led_set(int mode)
  112. {
  113. led_handle_t *h=&ledHandle;
  114. flah_status = 0;
  115. flash_clear();
  116. h->mode = mode;
  117. return led_set_ex(&led_para[h->mode]);
  118. }
  119. int led_set_ex(led_para_t *para)
  120. {
  121. int r=0;
  122. led_handle_t *h=&ledHandle;
  123. misc_data_t *misc=&paras_get()->misc;
  124. // if(!misc->led || !para || (para->on_ms<=0 && para->off_ms<=0) || para->times==0) {
  125. // return -1;
  126. // }
  127. led_data_t *ld=&h->data[para->led_id];
  128. ld->cnt = 0;
  129. ld->para = *para;
  130. if(ld->para.on_ms>0) {
  131. gpio_set(ld->io, ld->info->on_level);
  132. if(ld->para.off_ms>0) {
  133. ld->para.times *= 2;
  134. }
  135. else {
  136. ld->para.on_ms *= ld->para.times;
  137. ld->para.times = 1;
  138. }
  139. r = timer_start(h->tmr, ld->para.on_ms, ld->para.times, led_handler, ld);
  140. }
  141. else {
  142. gpio_set(ld->io, ld->info->on_level);
  143. if(ld->para.off_ms>0) {
  144. ld->para.off_ms *= ld->para.times;
  145. ld->para.times = 1;
  146. r = timer_start(h->tmr, ld->para.off_ms, ld->para.times, led_handler, ld);
  147. }
  148. }
  149. return r;
  150. }
  151. int led_reset(void)
  152. {
  153. led_handle_t *h=&ledHandle;
  154. if(h->mode==-1) {
  155. return -1;
  156. }
  157. h->mode = -1;
  158. timer_stop(h->tmr);
  159. flah_status = 1;
  160. gpio_set(h->data[LED_ID_GREEN].io, led_info[LED_ID_GREEN].off_level);
  161. return 0;
  162. }