system.c 4.9 KB

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