diff options
Diffstat (limited to 'inc/listener_buf.h')
| -rw-r--r-- | inc/listener_buf.h | 124 |
1 files changed, 124 insertions, 0 deletions
diff --git a/inc/listener_buf.h b/inc/listener_buf.h new file mode 100644 index 0000000..ee95b1d --- /dev/null +++ b/inc/listener_buf.h @@ -0,0 +1,124 @@ +/** + * Copyright (c) 2019, The Linux Foundation. All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions are + * met: + * * Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * * 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. + * * Neither the name of The Linux Foundation 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 "AS IS" AND ANY EXPRESS OR IMPLIED + * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF + * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT + * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER 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. + */ + +#ifndef LISTENER_BUF_H +#define LISTENER_BUF_H + +#include "sbuf.h" +#include "remote.h" +#include "verify.h" + +static __inline void pack_in_bufs(struct sbuf* buf, remote_arg* pra, int nBufs) { + int ii; + uint32_t len; + C_ASSERT(sizeof(len) == 4); + for(ii = 0; ii < nBufs; ++ii) { + len = (uint32_t)pra[ii].buf.nLen; + sbuf_write(buf, (uint8*)&len, 4); + if(len) { + sbuf_align(buf, 8); + sbuf_write(buf, pra[ii].buf.pv, len); + } + } +} + +static __inline void pack_out_lens(struct sbuf* buf, remote_arg* pra, int nBufs) { + int ii; + uint32_t len; + C_ASSERT(sizeof(len) == 4); + for(ii = 0; ii < nBufs; ++ii) { + len = (uint32_t)pra[ii].buf.nLen; + sbuf_write(buf, (uint8*)&len, 4); + } +} + +static __inline void unpack_in_bufs(struct sbuf* buf, remote_arg* pra, int nBufs) { + int ii; + uint32_t len=0; + C_ASSERT(sizeof(len) == 4); + for(ii = 0; ii < nBufs; ++ii) { + sbuf_read(buf, (uint8*)&len, 4); + pra[ii].buf.nLen = len; + if(pra[ii].buf.nLen) { + sbuf_align(buf, 8); + if((int)pra[ii].buf.nLen <= sbuf_left(buf)) { + pra[ii].buf.pv = sbuf_head(buf); + } + sbuf_advance(buf, pra[ii].buf.nLen); + } + } +} + +static __inline void unpack_out_lens(struct sbuf* buf, remote_arg* pra, int nBufs) { + int ii; + uint32_t len=0; + C_ASSERT(sizeof(len) == 4); + for(ii = 0; ii < nBufs; ++ii) { + sbuf_read(buf, (uint8*)&len, 4); + pra[ii].buf.nLen = len; + } +} + +//map out buffers on the hlos side to the remote_arg array +//dst is the space required for buffers we coun't map from the adsp +static __inline void pack_out_bufs(struct sbuf* buf, remote_arg* pra, int nBufs) { + int ii; + uint32_t len; + C_ASSERT(sizeof(len) == 4); + for(ii = 0; ii < nBufs; ++ii) { + len = (uint32_t)pra[ii].buf.nLen; + sbuf_write(buf, (uint8*)&len, 4); + if(pra[ii].buf.nLen) { + sbuf_align(buf, 8); + if((int)pra[ii].buf.nLen <= sbuf_left(buf)) { + pra[ii].buf.pv = sbuf_head(buf); + } + sbuf_advance(buf, pra[ii].buf.nLen); + } + } +} + +//on the aDSP copy the data from buffers we had to copy to the local remote_arg structure +static __inline int unpack_out_bufs(struct sbuf* buf, remote_arg* pra, int nBufs) { + int ii, nErr = 0; + uint32_t len; + C_ASSERT(sizeof(len) == 4); + for(ii = 0; ii < nBufs; ++ii) { + sbuf_read(buf, (uint8*)&len, 4); + VERIFY(len == pra[ii].buf.nLen); + if(pra[ii].buf.nLen) { + sbuf_align(buf, 8); + sbuf_read(buf, pra[ii].buf.pv, pra[ii].buf.nLen); + } + } +bail: + return nErr; +} + +#endif |