Advertisement
Guest User

Untitled

a guest
Dec 21st, 2014
181
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.69 KB | None | 0 0
  1. void QPost(INT32U val) // wysyla dane do kolejek
  2. {
  3. int i = 0;
  4. INT8U j;
  5. INT8U err;
  6. static INT32U data[6];
  7. for(;i<6; ++i)
  8. {
  9. err = OSQPost(Access[0][i], data + j);
  10. if(err == OS_Q_FULL) //watek gubi wartosc
  11. {
  12. INT8U k = NEXT_POS(ControlBuf);
  13. INT32U *ptr = (INT32U*) OSQAccept(Access[0][i]);
  14. ControlBuf.msgs[k].flag = VALUE_LOST;
  15. ControlBuf.msgs[k].number = Q_ID(i);
  16. ControlBuf.msgs[k].val = *ptr;
  17. ControlBuf.msgs[k].line = __LINE__;
  18. SEND_ERR(ControlBuf.msgs[k]);
  19. //ponowne wyslanie
  20. OSQPost(Access[0][i], data + j);
  21. }
  22. }
  23. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement