Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- void QPost(INT32U val) // wysyla dane do kolejek
- {
- int i = 0;
- INT8U j;
- INT8U err;
- static INT32U data[6];
- for(;i<6; ++i)
- {
- err = OSQPost(Access[0][i], data + j);
- if(err == OS_Q_FULL) //watek gubi wartosc
- {
- INT8U k = NEXT_POS(ControlBuf);
- INT32U *ptr = (INT32U*) OSQAccept(Access[0][i]);
- ControlBuf.msgs[k].flag = VALUE_LOST;
- ControlBuf.msgs[k].number = Q_ID(i);
- ControlBuf.msgs[k].val = *ptr;
- ControlBuf.msgs[k].line = __LINE__;
- SEND_ERR(ControlBuf.msgs[k]);
- //ponowne wyslanie
- OSQPost(Access[0][i], data + j);
- }
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement