raiden00pl commented on code in PR #1460: URL: https://github.com/apache/nuttx-apps/pull/1460#discussion_r1055413929
########## logging/nxscope/nxscope_chan.c: ########## @@ -0,0 +1,1566 @@ +/**************************************************************************** + * apps/logging/nxscope/nxscope_chan.c + * + * Licensed to the Apache Software Foundation (ASF) under one or more + * contributor license agreements. See the NOTICE file distributed with + * this work for additional information regarding copyright ownership. The + * ASF licenses this file to you under the Apache License, Version 2.0 (the + * "License"); you may not use this file except in compliance with the + * License. You may obtain a copy of the License at + * + * http://www.apache.org/licenses/LICENSE-2.0 + * + * Unless required by applicable law or agreed to in writing, software + * distributed under the License is distributed on an "AS IS" BASIS, WITHOUT + * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the + * License for the specific language governing permissions and limitations + * under the License. + * + ****************************************************************************/ + +/**************************************************************************** + * Included Files + ****************************************************************************/ + +#include <nuttx/config.h> + +#include <assert.h> +#include <debug.h> +#include <errno.h> +#include <string.h> +#include <stdlib.h> + +#include <logging/nxscope/nxscope.h> + +#include "nxscope_internals.h" + +/**************************************************************************** + * Pre-processor Definitions + ****************************************************************************/ + +#ifdef CONFIG_ENDIAN_BIG +# error Big endian not tested +#endif + +/**************************************************************************** + * Private Data + ****************************************************************************/ + +int g_type_size[] = +{ + 0, /* NXSCOPE_TYPE_UNDEF */ + 0, /* NXSCOPE_TYPE_NONE */ + sizeof(uint8_t), /* NXSCOPE_TYPE_UINT8 */ + sizeof(int8_t), /* NXSCOPE_TYPE_INT8 */ + sizeof(uint16_t), /* NXSCOPE_TYPE_UINT16 */ + sizeof(int16_t), /* NXSCOPE_TYPE_INT16 */ + sizeof(uint32_t), /* NXSCOPE_TYPE_UINT32 */ + sizeof(int32_t), /* NXSCOPE_TYPE_INT32 */ + sizeof(uint64_t), /* NXSCOPE_TYPE_UINT64 */ + sizeof(int64_t), /* NXSCOPE_TYPE_INT64 */ + sizeof(float), /* NXSCOPE_TYPE_FLOAT */ + sizeof(double), /* NXSCOPE_TYPE_DOUBLE */ + sizeof(ub8_t), /* NXSCOPE_TYPE_UB8 */ + sizeof(b8_t), /* NXSCOPE_TYPE_B8 */ + sizeof(ub16_t), /* NXSCOPE_TYPE_UB16 */ + sizeof(b16_t), /* NXSCOPE_TYPE_B16 */ + sizeof(ub32_t), /* NXSCOPE_TYPE_UB32 */ + sizeof(b32_t), /* NXSCOPE_TYPE_B32 */ + sizeof(char), /* NXSCOPE_TYPE_CHAR */ +#if 0 + /* Reserved for future use */ + + sizeof(wchar_t), /* NXSCOPE_TYPE_WCHAR */ +#endif + +#ifdef CONFIG_LOGGING_NXSCOPE_USERTYPES + /* User type always last element and always equal to 1B */ + + sizeof(uint8_t), /* NXSCOPE_TYPE_USER */ +#endif +}; + +/**************************************************************************** + * Private Functions + ****************************************************************************/ + +/**************************************************************************** + * Name: nxscope_stream_overflow + * + * NOTE: This function assumes that we have exclusive access to the nxscope + * instance + * + ****************************************************************************/ + +static void nxscope_stream_overflow(FAR struct nxscope_s *s) +{ + DEBUGASSERT(s); + + s->streambuf[s->proto_stream->hdrlen] |= NXSCOPE_STREAM_FLAGS_OVERFLOW; +} + +/**************************************************************************** + * Name: nxscope_ch_validate + ****************************************************************************/ + +static int nxscope_ch_validate(FAR struct nxscope_s *s, uint8_t ch, + uint8_t type, uint8_t d, uint8_t mlen) +{ + union nxscope_chinfo_type_u utype; + size_t next_i = 0; + int ret = OK; + size_t type_size = 0; + + DEBUGASSERT(s); + + /* Do nothing if stream not started */ + + if (!s->start) + { + ret = -EAGAIN; + goto errout; + } + + /* Do nothing if channel not enabled */ + + if (s->chinfo[ch].enable != 1) + { + ret = -EAGAIN; + goto errout; + } + + /* Some additional checks if debug features enabled */ + +#ifdef CONFIG_DEBUG_FEATURES + /* Validate channel */ + + if (ch > s->cmninfo.chmax) + { + _err("ERROR: invalid channel %d\n", ch); + ret = -EINVAL; + goto errout; + } + + /* Validate channel type */ + + if (s->chinfo[ch].type.s.dtype != type) + { + _err("ERROR: invalid channel type %d != %d\n", + s->chinfo[ch].type.u8, type); + ret = -EINVAL; + goto errout; + } + + /* Validate channel vdim */ + + if (s->chinfo[ch].vdim != d) + { + _err("ERROR: invalid channel dim %d\n", d); + ret = -EINVAL; + goto errout; + } + + /* Validate channel metadata size */ + + if (s->chinfo[ch].mlen != mlen) + { + _err("ERROR: invalid channel mlen %d\n", mlen); + ret = -EINVAL; + goto errout; + } +#endif + +#ifdef CONFIG_LOGGING_NXSCOPE_DIVIDER + /* Handle sample rate divider */ + + s->cntr[ch] += 1; + if (s->cntr[ch] % (s->chinfo[ch].div + 1) != 0) + { + ret = -EAGAIN; + goto errout; + } +#endif + + /* Get utype */ + + utype.u8 = type; + +#ifdef CONFIG_LOGGING_NXSCOPE_CRICHANNELS + /* No more checks needed for critical channel */ + + if (utype.s.cri) + { + ret = OK; + goto errout; + } +#endif + + /* Check buffer size */ + +#ifdef CONFIG_LOGGING_NXSCOPE_USERTYPES + if (type >= NXSCOPE_TYPE_USER) + { + type_size = 1; + } + else +#endif + { + type_size = g_type_size[utype.s.dtype]; + } + + next_i = (s->stream_i + 1 + type_size * d + mlen + + s->proto_stream->footlen); + + if (next_i > s->streambuf_len) + { + _err("ERROR: no space for data %d\n", s->stream_i); + nxscope_stream_overflow(s); + ret = -ENOBUFS; + goto errout; + } + +errout: + return ret; +} + +/**************************************************************************** + * Name: nxscope_put_vector + * + * NOTE: This function assumes that we have exclusive access to the nxscope + * stream buffer + * + * IMPORTANT: Data stored always as little-endian ! + * + ****************************************************************************/ + +static int nxscope_put_vector(FAR uint8_t *buff, uint8_t type, FAR void *val, + uint8_t d) +{ + int i = 0; + int j = 0; + + DEBUGASSERT(buff); + + /* Pack data */ + + switch (type) + { + case NXSCOPE_TYPE_NONE: + { + /* Nothing to do here */ + + break; + } + + case NXSCOPE_TYPE_UINT8: + case NXSCOPE_TYPE_INT8: +#ifdef CONFIG_LOGGING_NXSCOPE_USERTYPES + case NXSCOPE_TYPE_USER: +#endif + { + uint8_t u8 = 0; + + for (i = 0; i < d; i++) + { + DEBUGASSERT(val); + u8 = ((FAR uint8_t *)val)[i]; + + buff[j++] = u8; + } + + break; + } + + case NXSCOPE_TYPE_UINT16: + case NXSCOPE_TYPE_INT16: + case NXSCOPE_TYPE_B8: + case NXSCOPE_TYPE_UB8: + { + uint16_t u16 = 0; + + for (i = 0; i < d; i++) + { + DEBUGASSERT(val); + u16 = ((FAR uint16_t *)val)[i]; +#ifdef CONFIG_ENDIAN_BIG + u16 = __swap_uint16(u16); +#endif + + buff[j++] = ((u16 >> 0) & 0xff); + buff[j++] = ((u16 >> 8) & 0xff); + } + + break; + } + + case NXSCOPE_TYPE_UINT32: + case NXSCOPE_TYPE_INT32: + case NXSCOPE_TYPE_FLOAT: + case NXSCOPE_TYPE_B16: + case NXSCOPE_TYPE_UB16: + { + uint32_t u32 = 0; + + for (i = 0; i < d; i++) + { + DEBUGASSERT(val); + u32 = ((FAR uint32_t *)val)[i]; +#ifdef CONFIG_ENDIAN_BIG + u32 = __swap_uint32(u32); Review Comment: good idea. done -- This is an automated message from the Apache Git Service. To respond to the message, please log on to GitHub and use the URL above to go to the specific comment. To unsubscribe, e-mail: commits-unsubscr...@nuttx.apache.org For queries about this service, please contact Infrastructure at: us...@infra.apache.org
