/* k_pipe_util.c */ /* * Copyright (c) 1997-2014 Wind River Systems, Inc. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1) Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * * 2) Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * * 3) Neither the name of Wind River Systems nor the names of its contributors * may be used to endorse or promote products derived from this software without * specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include #include #define _ALL_OPT (0x000000FF) void DeListWaiter(struct k_args *pReqProc) { __ASSERT_NO_MSG(NULL != pReqProc->Head); REMOVE_ELM(pReqProc); pReqProc->Head = NULL; } void myfreetimer(struct k_timer **ppTimer) { if (*ppTimer) { _k_timer_delist(*ppTimer); FREETIMER(*ppTimer); *ppTimer = NULL; } } /* adapted from mailbox implementation of copypacket() */ void mycopypacket(struct k_args **out, struct k_args *in) { GETARGS(*out); memcpy(*out, in, sizeof(struct k_args)); (*out)->Ctxt.args = in; } int CalcFreeReaderSpace(struct k_args *pReaderList) { int iSize = 0; if (pReaderList) { struct k_args *pReader = pReaderList; while (pReader != NULL) { iSize += (pReader->args.pipe_xfer_req.iSizeTotal - pReader->args.pipe_xfer_req.iSizeXferred); pReader = pReader->next; } } return iSize; } int CalcAvailWriterData(struct k_args *pWriterList) { int iSize = 0; if (pWriterList) { struct k_args *pWriter = pWriterList; while (pWriter != NULL) { iSize += (pWriter->args.pipe_xfer_req.iSizeTotal - pWriter->args.pipe_xfer_req.iSizeXferred); pWriter = pWriter->next; } } return iSize; } K_PIPE_OPTION _k_pipe_option_get(K_ARGS_ARGS *args) { return (K_PIPE_OPTION)(args->pipe_xfer_req.ReqInfo.Params & _ALL_OPT); } void _k_pipe_option_set(K_ARGS_ARGS *args, K_PIPE_OPTION option) { /* Ensure that only the pipe option bits are modified */ args->pipe_xfer_req.ReqInfo.Params &= (~_ALL_OPT); args->pipe_xfer_req.ReqInfo.Params |= (option & _ALL_OPT); } REQ_TYPE _k_pipe_request_type_get(K_ARGS_ARGS *args) { return (REQ_TYPE)(args->pipe_xfer_req.ReqInfo.Params & _ALLREQ); } void _k_pipe_request_type_set(K_ARGS_ARGS *args, REQ_TYPE ReqType) { /* Ensure that only the request type bits are modified */ args->pipe_xfer_req.ReqInfo.Params &= (~_ALLREQ); args->pipe_xfer_req.ReqInfo.Params |= (ReqType & _ALLREQ); } TIME_TYPE _k_pipe_time_type_get(K_ARGS_ARGS *args) { return (TIME_TYPE)(args->pipe_xfer_req.ReqInfo.Params & _ALLTIME); } void _k_pipe_time_type_set(K_ARGS_ARGS *args, TIME_TYPE TimeType) { /* Ensure that only the time type bits are modified */ args->pipe_xfer_req.ReqInfo.Params &= (~_ALLTIME); args->pipe_xfer_req.ReqInfo.Params |= (TimeType & _ALLTIME); } void _k_pipe_request_status_set(struct _pipe_xfer_req_arg *pipe_xfer_req, PIPE_REQUEST_STATUS status) { #ifdef CONFIG_OBJECT_MONITOR /* * if transition XFER_IDLE --> XFER_BUSY, TERM_XXX * increment pipe counter */ if (XFER_IDLE == pipe_xfer_req->status /* current (old) status */ && (XFER_BUSY | TERM_XXX) & status /* new status */) { (pipe_xfer_req->ReqInfo.pipe.ptr->count)++; } #endif pipe_xfer_req->status = status; }