system.c 4.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211
  1. #include "system.h"
  2. #include "bsp_time.h"
  3. #include "nrf_delay.h"
  4. #include "hal_wearshoes.h"
  5. //系统函数
  6. void FPS_process(void)
  7. {
  8. #if DEBUG_FPS
  9. static uint32_t tem1 = 0;
  10. static uint32_t tem2 = 0;
  11. static uint32_t fps_max=0;
  12. static uint32_t cnt_max=0;
  13. uint32_t fps;
  14. tem2 = NRF_RTC0->COUNTER;
  15. if(tem2<tem1) tem2 += 16777216;
  16. fps = (tem2-tem1)/32.768;
  17. if(fps_max<fps){
  18. fps_max = fps;
  19. cnt_max = tem2-tem1;
  20. }
  21. static uint32_t tim=0;
  22. if(TIME_GetTicks()-tim>=1){ tim = TIME_GetTicks();
  23. SEGGER_RTT_printf(0,"fps=%dms,cnt=%d\n",fps_max,cnt_max);
  24. fps_max = 0;
  25. }
  26. tem1 = NRF_RTC0->COUNTER;
  27. #endif
  28. }
  29. //休眠时间 ms
  30. uint32_t systermSleepTime = 1000;
  31. static uint8_t sleep_num = 0;
  32. static Sleep_cb sleep_cb[sleep_cb_max]={0};
  33. int Sleep_Regist(Sleep_cb cb)
  34. {
  35. for(int i=0;i<sleep_cb_max;i++) {
  36. if(sleep_cb[i]==cb) return -1;
  37. if(sleep_cb[i]==0){
  38. sleep_num++;
  39. sleep_cb[i] = cb; //回调函数
  40. return 0;
  41. }
  42. }
  43. SEGGER_RTT_printf(0,"Sleep_Regist too many!\n");
  44. return -2;
  45. }
  46. void Sleep_Event(void)
  47. {
  48. for(int i=0;i<sleep_num;i++) { //SEGGER_RTT_printf(0,"time_cb[%d]=%d\n",i,time_cb[i]);
  49. if(sleep_cb[i]){
  50. sleep_cb[i](systermSleepTime); //回调函数
  51. }
  52. }
  53. }
  54. static uint8_t wakeup_num = 0;
  55. static Sleep_cb wakeup_cb[wakeup_cb_max]={0};
  56. int Wakeup_Regist(Sleep_cb cb)
  57. {
  58. for(int i=0;i<wakeup_cb_max;i++) {
  59. if(wakeup_cb[i]==cb) return -1;
  60. if(wakeup_cb[i]==0){
  61. wakeup_num++;
  62. wakeup_cb[i] = cb; //回调函数
  63. return 0;
  64. }
  65. }
  66. // SEGGER_RTT_printf(0,"Wakeup_Regist too many!\n");
  67. return -2;
  68. }
  69. void Wakeup_Event(void)
  70. {
  71. for(int i=0;i<wakeup_num;i++) { //SEGGER_RTT_printf(0,"time_cb[%d]=%d\n",i,time_cb[i]);
  72. if(wakeup_cb[i]){
  73. wakeup_cb[i](systermSleepTime); //回调函数
  74. }
  75. }
  76. }
  77. //app进程管理
  78. static uint16_t process_dex = 0;
  79. static PROCESS_t mProcess[process_max];
  80. int Process_Start(uint32_t peroid,const char *name,PROCESS_cb cb)
  81. {
  82. for(uint8_t i=0;i<process_dex;i++){
  83. if(mProcess[i].cb==cb){ //已经存在
  84. mProcess[i].enable =1;
  85. mProcess[i].Peroid = peroid;
  86. mProcess[i].tim = TIME_GetTicks();
  87. return 1;
  88. }
  89. }
  90. if(process_dex>=process_max) return -1;
  91. mProcess[process_dex].cb = cb;
  92. mProcess[process_dex].enable =1;
  93. mProcess[process_dex].Peroid = peroid;
  94. mProcess[process_dex].tim = TIME_GetTicks();
  95. #if ProcessTime_EN
  96. sprintf(mProcess[process_dex].name_t,"%s",name);
  97. #endif
  98. process_dex++;
  99. // SEGGER_RTT_printf(0,"process num(%d)\n",process_dex);
  100. return 0;
  101. }
  102. void Process_Stop(PROCESS_cb cb)
  103. {
  104. for(uint8_t i=0;i<process_dex;i++){
  105. if(mProcess[i].cb==cb){ //找到
  106. mProcess[i].enable = 0;
  107. return;
  108. }
  109. }
  110. }
  111. void Process_SetHoldOn(PROCESS_cb cb,uint8_t holdon)
  112. {
  113. for(uint8_t i=0;i<process_dex;i++){
  114. if(mProcess[i].cb==cb){ //找到
  115. if(mProcess[i].holdon!=holdon) mProcess[i].holdon = (holdon&0x01);
  116. return;
  117. }
  118. }
  119. }
  120. void Process_UpdatePeroid(PROCESS_cb cb,uint16_t Peroid)
  121. {
  122. for(uint8_t i=0;i<process_dex;i++){
  123. if(mProcess[i].cb==cb){ //找到
  124. mProcess[i].Peroid = Peroid;
  125. return;
  126. }
  127. }
  128. }
  129. uint16_t Process_GetPeroid(PROCESS_cb cb)
  130. {
  131. for(uint8_t i=0;i<process_dex;i++){
  132. if(mProcess[i].cb==cb){ //找到
  133. return mProcess[i].Peroid;
  134. }
  135. }
  136. return 0;
  137. }
  138. int Process_App(void)
  139. {
  140. int ret = 0;
  141. uint8_t i = 0;
  142. for(i=0;i<process_dex;i++){
  143. if(mProcess[i].enable==0) continue;
  144. if(mProcess[i].cb){
  145. #if ProcessTime_EN
  146. target->cnt1_rtc = NRF_RTC0->COUNTER;
  147. #endif
  148. if(mProcess[i].Peroid ==0) mProcess[i].cb();
  149. else if(TIME_GetTicks()-mProcess[i].tim >= mProcess[i].Peroid ){
  150. mProcess[i].tim = TIME_GetTicks();
  151. mProcess[i].cb();
  152. }
  153. #if ProcessTime_EN
  154. target->cnt2_rtc = NRF_RTC0->COUNTER;
  155. #endif
  156. }
  157. if(mProcess[i].holdon) ret = 1; //不能进入低功耗
  158. }
  159. #if ProcessTime_EN
  160. char Display[100]={0};
  161. static uint32_t tim =0;
  162. if(TIME_GetTicks()-tim>=DisInterval){ tim = TIME_GetTicks();
  163. for(target=head_handle;target;target=target->next){
  164. if(target->cb && target->cnt2_rtc >= (target->cnt1_rtc +2)) {
  165. sprintf(Display,"%s, time:%02f us\n",target->name_t,(target->cnt2_rtc-target->cnt1_rtc)/32.768 * 1000);
  166. SEGGER_RTT_printf(0,"%s",Display);
  167. memset(Display,0,sizeof(Display));
  168. }
  169. }
  170. }
  171. #endif
  172. return ret;
  173. }
  174. //大循环
  175. void USR_Process(void)
  176. {
  177. //app进程调度
  178. if(Process_App()==0){ //进入低功耗模式
  179. Sleep_Event();
  180. systermSleepTime = rtc_sleep(hal_wearshoes_is_wearshoes());
  181. if(systermSleepTime==0){
  182. systermSleepTime = 13;
  183. nrf_delay_ms(systermSleepTime);
  184. }
  185. Wakeup_Event();
  186. }
  187. FPS_process();
  188. }