scheduler.cpp 6.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297
  1. /*
  2. Generated with CMSIS-DSP Compute Graph Scripts.
  3. The generated code is not covered by CMSIS-DSP license.
  4. The support classes and code is covered by CMSIS-DSP license.
  5. */
  6. #include "arm_math.h"
  7. #include "custom.h"
  8. #include "GenericNodes.h"
  9. #include "AppNodes.h"
  10. #include "scheduler.h"
  11. #if !defined(CHECKERROR)
  12. #define CHECKERROR if (cgStaticError < 0) \
  13. {\
  14. goto errorHandling;\
  15. }
  16. #endif
  17. #if !defined(CG_BEFORE_ITERATION)
  18. #define CG_BEFORE_ITERATION
  19. #endif
  20. #if !defined(CG_AFTER_ITERATION)
  21. #define CG_AFTER_ITERATION
  22. #endif
  23. #if !defined(CG_BEFORE_SCHEDULE)
  24. #define CG_BEFORE_SCHEDULE
  25. #endif
  26. #if !defined(CG_AFTER_SCHEDULE)
  27. #define CG_AFTER_SCHEDULE
  28. #endif
  29. #if !defined(CG_BEFORE_BUFFER)
  30. #define CG_BEFORE_BUFFER
  31. #endif
  32. #if !defined(CG_BEFORE_FIFO_BUFFERS)
  33. #define CG_BEFORE_FIFO_BUFFERS
  34. #endif
  35. #if !defined(CG_BEFORE_FIFO_INIT)
  36. #define CG_BEFORE_FIFO_INIT
  37. #endif
  38. #if !defined(CG_BEFORE_NODE_INIT)
  39. #define CG_BEFORE_NODE_INIT
  40. #endif
  41. #if !defined(CG_AFTER_INCLUDES)
  42. #define CG_AFTER_INCLUDES
  43. #endif
  44. #if !defined(CG_BEFORE_SCHEDULER_FUNCTION)
  45. #define CG_BEFORE_SCHEDULER_FUNCTION
  46. #endif
  47. #if !defined(CG_BEFORE_NODE_EXECUTION)
  48. #define CG_BEFORE_NODE_EXECUTION
  49. #endif
  50. #if !defined(CG_AFTER_NODE_EXECUTION)
  51. #define CG_AFTER_NODE_EXECUTION
  52. #endif
  53. CG_AFTER_INCLUDES
  54. /*
  55. Description of the scheduling.
  56. */
  57. static unsigned int schedule[7]=
  58. {
  59. 5,6,2,0,1,3,4,
  60. };
  61. CG_BEFORE_FIFO_BUFFERS
  62. /***********
  63. FIFO buffers
  64. ************/
  65. #define FIFOSIZE0 2
  66. #define FIFOSIZE1 2
  67. #define FIFOSIZE2 2
  68. #define FIFOSIZE3 2
  69. #define FIFOSIZE4 2
  70. #define FIFOSIZE5 2
  71. #define BUFFERSIZE1 2
  72. CG_BEFORE_BUFFER
  73. int16_t buf1[BUFFERSIZE1]={0};
  74. #define BUFFERSIZE2 2
  75. CG_BEFORE_BUFFER
  76. int16_t buf2[BUFFERSIZE2]={0};
  77. #define BUFFERSIZE3 2
  78. CG_BEFORE_BUFFER
  79. int16_t buf3[BUFFERSIZE3]={0};
  80. #define BUFFERSIZE4 2
  81. CG_BEFORE_BUFFER
  82. int16_t buf4[BUFFERSIZE4]={0};
  83. #define BUFFERSIZE5 2
  84. CG_BEFORE_BUFFER
  85. int16_t buf5[BUFFERSIZE5]={0};
  86. #define BUFFERSIZE6 2
  87. CG_BEFORE_BUFFER
  88. int16_t buf6[BUFFERSIZE6]={0};
  89. CG_BEFORE_SCHEDULER_FUNCTION
  90. uint32_t scheduler(int *error)
  91. {
  92. int cgStaticError=0;
  93. uint32_t nbSchedule=0;
  94. int32_t debugCounter=10;
  95. CG_BEFORE_FIFO_INIT;
  96. /*
  97. Create FIFOs objects
  98. */
  99. FIFO<int16_t,FIFOSIZE0,0,1> fifo0(buf1);
  100. FIFO<int16_t,FIFOSIZE1,0,1> fifo1(buf2);
  101. FIFO<int16_t,FIFOSIZE2,0,1> fifo2(buf3);
  102. FIFO<int16_t,FIFOSIZE3,0,1> fifo3(buf4);
  103. FIFO<int16_t,FIFOSIZE4,0,1> fifo4(buf5);
  104. FIFO<int16_t,FIFOSIZE5,0,1> fifo5(buf6);
  105. CG_BEFORE_NODE_INIT;
  106. /*
  107. Create node objects
  108. */
  109. Duplicate2<int16_t,1,int16_t,1,int16_t,1> dup0(fifo3,fifo4,fifo5);
  110. ProcessingOddEven<int16_t,1,int16_t,1,int16_t,1> proc(fifo0,fifo1,fifo2);
  111. SinkAsync<int16_t,1> sinka(fifo4);
  112. SinkAsync<int16_t,1> sinkb(fifo5);
  113. SourceEven<int16_t,1> sourceEven(fifo1);
  114. SourceOdd<int16_t,1> sourceOdd(fifo0);
  115. /* Run several schedule iterations */
  116. CG_BEFORE_SCHEDULE;
  117. while((cgStaticError==0) && (debugCounter > 0))
  118. {
  119. /* Run a schedule iteration */
  120. CG_BEFORE_ITERATION;
  121. for(unsigned long id=0 ; id < 7; id++)
  122. {
  123. CG_BEFORE_NODE_EXECUTION;
  124. cgStaticError = 0;
  125. switch(schedule[id])
  126. {
  127. case 0:
  128. {
  129. bool canRun=true;
  130. canRun &= !fifo2.willUnderflowWith(1);
  131. canRun &= !fifo3.willOverflowWith(1);
  132. if (!canRun)
  133. {
  134. cgStaticError = CG_SKIP_EXECUTION_ID_CODE;
  135. }
  136. else
  137. {
  138. cgStaticError = 0;
  139. }
  140. }
  141. break;
  142. case 1:
  143. {
  144. cgStaticError = dup0.prepareForRunning();
  145. }
  146. break;
  147. case 2:
  148. {
  149. cgStaticError = proc.prepareForRunning();
  150. }
  151. break;
  152. case 3:
  153. {
  154. cgStaticError = sinka.prepareForRunning();
  155. }
  156. break;
  157. case 4:
  158. {
  159. cgStaticError = sinkb.prepareForRunning();
  160. }
  161. break;
  162. case 5:
  163. {
  164. cgStaticError = sourceEven.prepareForRunning();
  165. }
  166. break;
  167. case 6:
  168. {
  169. cgStaticError = sourceOdd.prepareForRunning();
  170. }
  171. break;
  172. default:
  173. break;
  174. }
  175. if (cgStaticError == CG_SKIP_EXECUTION_ID_CODE)
  176. continue;
  177. CHECKERROR;
  178. switch(schedule[id])
  179. {
  180. case 0:
  181. {
  182. {
  183. int16_t* i0;
  184. int16_t* o1;
  185. i0=fifo2.getReadBuffer(1);
  186. o1=fifo3.getWriteBuffer(1);
  187. compute(i0,o1,1);
  188. cgStaticError = 0;
  189. }
  190. }
  191. break;
  192. case 1:
  193. {
  194. cgStaticError = dup0.run();
  195. }
  196. break;
  197. case 2:
  198. {
  199. cgStaticError = proc.run();
  200. }
  201. break;
  202. case 3:
  203. {
  204. cgStaticError = sinka.run();
  205. }
  206. break;
  207. case 4:
  208. {
  209. cgStaticError = sinkb.run();
  210. }
  211. break;
  212. case 5:
  213. {
  214. cgStaticError = sourceEven.run();
  215. }
  216. break;
  217. case 6:
  218. {
  219. cgStaticError = sourceOdd.run();
  220. }
  221. break;
  222. default:
  223. break;
  224. }
  225. CG_AFTER_NODE_EXECUTION;
  226. CHECKERROR;
  227. }
  228. debugCounter--;
  229. CG_AFTER_ITERATION;
  230. nbSchedule++;
  231. }
  232. errorHandling:
  233. CG_AFTER_SCHEDULE;
  234. *error=cgStaticError;
  235. return(nbSchedule);
  236. }