extlibs/tinycbor/tinycbor/src/extract_number_p.h

   1 /****************************************************************************
   2 **
   3 ** Copyright (C) 2015 Intel Corporation
   4 **
   5 ** Permission is hereby granted, free of charge, to any person obtaining a copy
   6 ** of this software and associated documentation files (the "Software"), to deal
   7 ** in the Software without restriction, including without limitation the rights
   8 ** to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
   9 ** copies of the Software, and to permit persons to whom the Software is
  10 ** furnished to do so, subject to the following conditions:
  11 **
  12 ** The above copyright notice and this permission notice shall be included in
  13 ** all copies or substantial portions of the Software.
  14 **
  15 ** THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  16 ** IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  17 ** FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
  18 ** AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  19 ** LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  20 ** OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  21 ** THE SOFTWARE.
  22 **
  23 ****************************************************************************/
  24
  25 #define _BSD_SOURCE 1
  26 #include "cbor.h"
  27 #include "cborconstants_p.h"
  28 #include "compilersupport_p.h"
  29
  30 static inline uint16_t get16(const uint8_t *ptr)
  31 {
  32     uint16_t result;
  33     memcpy(&result, ptr, sizeof(result));
  34     return cbor_ntohs(result);
  35 }
  36
  37 static inline uint32_t get32(const uint8_t *ptr)
  38 {
  39     uint32_t result;
  40     memcpy(&result, ptr, sizeof(result));
  41     return cbor_ntohl(result);
  42 }
  43
  44 static inline uint64_t get64(const uint8_t *ptr)
  45 {
  46     uint64_t result;
  47     memcpy(&result, ptr, sizeof(result));
  48     return cbor_ntohll(result);
  49 }
  50
  51 static CborError extract_number(const uint8_t **ptr, const uint8_t *end, uint64_t *len)
  52 {
  53     uint8_t additional_information = **ptr & SmallValueMask;
  54     ++*ptr;
  55     if (additional_information < Value8Bit) {
  56         *len = additional_information;
  57         return CborNoError;
  58     }
  59     if (unlikely(additional_information > Value64Bit))
  60         return CborErrorIllegalNumber;
  61
  62     size_t bytesNeeded = 1 << (additional_information - Value8Bit);
  63     if (unlikely(bytesNeeded > (size_t)(end - *ptr))) {
  64         return CborErrorUnexpectedEOF;
  65     } else if (bytesNeeded == 1) {
  66         *len = (uint8_t)(*ptr)[0];
  67     } else if (bytesNeeded == 2) {
  68         *len = get16(*ptr);
  69     } else if (bytesNeeded == 4) {
  70         *len = get32(*ptr);
  71     } else {
  72         *len = get64(*ptr);
  73     }
  74     *ptr += bytesNeeded;
  75     return CborNoError;
  76 }