mapp_msg.c 11 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368
  1. //==================================================================
  2. //
  3. // Filename: mapp_msg.c
  4. // Description: Message driver
  5. //
  6. //------------------------------------------------------------------
  7. //
  8. // version:
  9. // date: 23:54pm, 08.Apr.2012, by Sirius
  10. // Description:
  11. //
  12. //------------------------------------------------------------------
  13. //==================================================================
  14. #define MAPP_MSG_C
  15. /*------------------------------------------------------------------------------
  16. * I N C L U D E
  17. *------------------------------------------------------------------------------*/
  18. #include "general.h"
  19. #include "mapp_msg.h"
  20. //------------------------------------------------------------------
  21. // static variables
  22. //------------------------------------------------------------------
  23. static T_MSG_QUEUE s_tMsgQue[MsgQueueCnt];
  24. /*=======================================================
  25. - Name: OSQPost
  26. - DESCRIPTION: - post message to module queue.
  27. -
  28. - Input:
  29. - Output:
  30. -
  31. - modification history
  32. - --------------------
  33. - 13:41pm, 11.Dec.2009, written by Sirius
  34. * --------------------
  35. =======================================================*/
  36. void OSQPost(T_MSG_MODULE mod, U08 id, U16 prm)
  37. {
  38. T_MESSAGE msg;
  39. U08 enque,deque;
  40. BOOL qfull;
  41. msg.id = id; /* get message id */
  42. msg.prm = prm; /* get message parameter */
  43. enque = (U08)(s_tMsgQue[mod].nEnque & 0x7f); /* get enqueue index */
  44. qfull = (U08)(s_tMsgQue[mod].nEnque & 0x80); /* MSB of enqueue as full flag */
  45. deque = (U08)(s_tMsgQue[mod].nDeque & 0x7f); /* get dequeue index */
  46. if (qfull == 0) { /* queue not full... */
  47. s_tMsgQue[mod].Queue[enque] = msg; /* message enqueue */
  48. enque++;
  49. if (enque >= QUEUE_LENGTH) { /* avoid overflow */
  50. enque = 0;
  51. }
  52. if (enque == deque) { /* queue full now */
  53. qfull = TRUE;
  54. }
  55. }
  56. if (qfull) { /* set queue MSB as full flag */
  57. enque |= 0x80;
  58. }
  59. s_tMsgQue[mod].nEnque = enque;
  60. s_tMsgQue[mod].nDeque = deque;
  61. return;
  62. }
  63. int OSQIsEmpty(T_MSG_MODULE mod)
  64. {
  65. // 如果入队和出队的索引相等,且队列的MSB没有设置为满,则队列为空
  66. if ((s_tMsgQue[mod].nEnque == s_tMsgQue[mod].nDeque) &&
  67. ((s_tMsgQue[mod].nEnque & 0x80) == 0)) {
  68. return 1; // 队列为空
  69. }
  70. return 0; // 队列不为空
  71. }
  72. /*=======================================================
  73. - Name: OSQNew
  74. - DESCRIPTION: - post new message to module queue.If message
  75. already exists,change the param to new param.
  76. -
  77. - Input:
  78. - Output:
  79. -
  80. - modification history
  81. - --------------------
  82. - 14:54pm, 11.Dec.2009, written by Sirius
  83. * --------------------
  84. =======================================================*/
  85. void OSQNew(T_MSG_MODULE mod, U08 id, U16 prm)
  86. {
  87. T_MESSAGE msg;
  88. U08 enque,deque,i;
  89. BOOL qfull;
  90. msg.id = id; /* get message id */
  91. msg.prm = prm; /* get message parameter */
  92. enque = (U08)(s_tMsgQue[mod].nEnque & 0x7f); /* get enqueue index */
  93. qfull = (U08)(s_tMsgQue[mod].nEnque & 0x80); /* MSB of enqueue as full flag */
  94. deque = (U08)(s_tMsgQue[mod].nDeque & 0x7f); /* get dequeue index */
  95. if (qfull == 0) { /* queue not full... */
  96. i = deque;
  97. while (i != enque) { /* findout the same message in queue */
  98. if (s_tMsgQue[mod].Queue[i].id == msg.id) {/* message already exists,return... */
  99. s_tMsgQue[mod].Queue[i].prm = msg.prm; /* message param change */
  100. return;
  101. }
  102. i++;
  103. if (i >= QUEUE_LENGTH) {
  104. i = 0;
  105. }
  106. }
  107. s_tMsgQue[mod].Queue[enque] = msg; /* message enqueue */
  108. enque++;
  109. if (enque >= QUEUE_LENGTH) { /* avoid overflow */
  110. enque = 0;
  111. }
  112. if (enque == deque) { /* queue full now */
  113. qfull = TRUE;
  114. }
  115. }
  116. if (qfull) { /* set queue MSB as full flag */
  117. enque |= 0x80;
  118. }
  119. s_tMsgQue[mod].nEnque = enque;
  120. s_tMsgQue[mod].nDeque = deque;
  121. return;
  122. }
  123. /*=======================================================
  124. - Name: OSQInquiry
  125. - DESCRIPTION: - post new message to module queue.If message
  126. already exists,return.
  127. -
  128. - Input:
  129. - Output:
  130. -
  131. - modification history
  132. - --------------------
  133. - 14:54pm, 11.Dec.2009, written by Sirius
  134. * --------------------
  135. =======================================================*/
  136. void OSQInquery(T_MSG_MODULE mod, U08 id, U16 prm)
  137. {
  138. T_MESSAGE msg;
  139. U08 enque,deque,i;
  140. BOOL qfull;
  141. msg.id = id; /* get message id */
  142. msg.prm = prm; /* get message parameter */
  143. enque = (U08)(s_tMsgQue[mod].nEnque & 0x7f); /* get enqueue index */
  144. qfull = (U08)(s_tMsgQue[mod].nEnque & 0x80); /* MSB of enqueue as full flag */
  145. deque = (U08)(s_tMsgQue[mod].nDeque & 0x7f); /* get dequeue index */
  146. if (qfull == 0) { /* queue not full... */
  147. i = deque;
  148. while (i != enque) { /* findout the same message in queue */
  149. if (s_tMsgQue[mod].Queue[i].id == msg.id) {/* message already exists,return... */
  150. return;
  151. }
  152. i++;
  153. if (i >= QUEUE_LENGTH) {
  154. i = 0;
  155. }
  156. }
  157. s_tMsgQue[mod].Queue[enque] = msg; /* message enqueue */
  158. enque++;
  159. if (enque >= QUEUE_LENGTH) { /* avoid overflow */
  160. enque = 0;
  161. }
  162. if (enque == deque) { /* queue full now */
  163. qfull = TRUE;
  164. }
  165. }
  166. if (qfull) { /* set queue MSB as full flag */
  167. enque |= 0x80;
  168. }
  169. s_tMsgQue[mod].nEnque = enque;
  170. s_tMsgQue[mod].nDeque = deque;
  171. return;
  172. }
  173. /*=======================================================
  174. - Name: OSQInsert
  175. - DESCRIPTION: - Insert a new message at the head of queue.
  176. -
  177. - Input:
  178. - Output:
  179. -
  180. - modification history
  181. - --------------------
  182. - 15:01pm, 11.Dec.2009, written by Sirius
  183. * --------------------
  184. =======================================================*/
  185. void OSQInsert(T_MSG_MODULE mod, U08 id, U16 prm)
  186. {
  187. T_MESSAGE msg;
  188. U08 enque,deque;
  189. BOOL qfull;
  190. msg.id = id; /* get message id */
  191. msg.prm = prm; /* get message parameter */
  192. enque = (U08)(s_tMsgQue[mod].nEnque & 0x7f); /* get enqueue index */
  193. qfull = (U08)(s_tMsgQue[mod].nEnque & 0x80); /* MSB of enqueue as full flag */
  194. deque = (U08)(s_tMsgQue[mod].nDeque & 0x7f); /* get dequeue index */
  195. if (qfull) { /* drop last message if queue full */
  196. if (enque == 0) {
  197. enque = QUEUE_LENGTH - 1;
  198. } else {
  199. enque--;
  200. }
  201. }
  202. if (deque == 0) { /* adjust deque pointer to last position */
  203. deque = QUEUE_LENGTH - 1;
  204. } else {
  205. deque--;
  206. }
  207. s_tMsgQue[mod].Queue[deque] = msg; /* insert message to queue head */
  208. if (enque == deque) { /* queue full now */
  209. qfull = TRUE;
  210. }
  211. if (qfull) { /* set queue MSB as full flag */
  212. enque |= 0x80;
  213. }
  214. s_tMsgQue[mod].nEnque = enque;
  215. s_tMsgQue[mod].nDeque = deque;
  216. return;
  217. }
  218. /*=======================================================
  219. - Name: OSQGet
  220. - DESCRIPTION: - Message dequeue from queue.
  221. -
  222. - Input:
  223. - Output:
  224. -
  225. - modification history
  226. - --------------------
  227. - 15:59pm, 11.Dec.2009, written by Sirius
  228. * --------------------
  229. =======================================================*/
  230. //T_MESSAGE *OSQGet(T_MSG_MODULE mod)
  231. //{
  232. // static T_MESSAGE msg;
  233. // U08 enque,deque;
  234. // BOOL qempty;
  235. // msg.id = NO_MSG;
  236. // enque = (U08)(s_tMsgQue[mod].nEnque & 0x7f); /* get enqueue index */
  237. // deque = (U08)(s_tMsgQue[mod].nDeque & 0x7f); /* get dequeue index */
  238. // qempty = (U08)(s_tMsgQue[mod].nDeque & 0x80); /* MSB of dequeue as empty flag */
  239. // if (qempty == 0) { /* queue not empty... */
  240. // msg = s_tMsgQue[mod].Queue[deque]; /* message dequeue */
  241. // deque++;
  242. // if (deque >= QUEUE_LENGTH) { /* avoid overflow */
  243. // deque = 0;
  244. // }
  245. // if (enque == deque) { /* queue full now */
  246. // qempty = TRUE;
  247. // }
  248. // }
  249. // if (qempty) { /* set queue MSB as full flag */
  250. // deque |= 0x80;
  251. // }
  252. // s_tMsgQue[mod].nEnque = enque;
  253. // s_tMsgQue[mod].nDeque = deque;
  254. //
  255. // return (&msg);
  256. //}
  257. T_MESSAGE *OSQGet(T_MSG_MODULE mod)
  258. {
  259. static T_MESSAGE msg;
  260. U08 enque,deque;
  261. BOOL qempty;
  262. msg.id = NO_MSG;
  263. enque = (U08)(s_tMsgQue[mod].nEnque & 0x7f); /* get enqueue index */
  264. deque = (U08)(s_tMsgQue[mod].nDeque & 0x7f); /* get dequeue index */
  265. qempty = (U08)(s_tMsgQue[mod].nDeque & 0x80); /* MSB of dequeue as empty flag */
  266. if (qempty == 0) { /* queue not empty... */
  267. msg = s_tMsgQue[mod].Queue[deque]; /* message dequeue */
  268. deque++;
  269. if (deque >= QUEUE_LENGTH) { /* avoid overflow */
  270. deque = 0;
  271. }
  272. if (enque == deque) { /* queue full now */
  273. qempty = TRUE;
  274. }
  275. }
  276. if (qempty) { /* set queue MSB as full flag */
  277. deque |= 0x80;
  278. }
  279. s_tMsgQue[mod].nEnque = enque;
  280. s_tMsgQue[mod].nDeque = deque;
  281. return (&msg);
  282. }
  283. /*=======================================================
  284. - Name: OSQFlush
  285. - DESCRIPTION: - Flush module message queue.
  286. -
  287. - Input:
  288. - Output:
  289. -
  290. - modification history
  291. - --------------------
  292. - 16:30pm, 11.Dec.2009, written by Sirius
  293. * --------------------
  294. =======================================================*/
  295. void OSQFlush(T_MSG_MODULE mod)
  296. {
  297. s_tMsgQue[mod].nEnque = 0x00; /* clear message enqueue,qfull=FALSE */
  298. s_tMsgQue[mod].nDeque = 0x80; /* clear message dequeue,qempty = TRUE */
  299. }
  300. /*=======================================================
  301. - Name: OSQInit
  302. - DESCRIPTION: - Init all module queue message
  303. -
  304. - Input:
  305. - Output:
  306. -
  307. - modification history
  308. - --------------------
  309. - 16:44pm, 11.Dec.2009, written by Sirius
  310. * --------------------
  311. =======================================================*/
  312. void OSQInit(void)
  313. {
  314. T_MSG_MODULE mod;
  315. for (mod = (T_MSG_MODULE)0; mod < MsgQueueCnt; mod++) {
  316. OSQFlush(mod);
  317. }
  318. }
  319. //--------------------------------------------------------------
  320. //==============================================================
  321. // End Of File
  322. //==============================================================