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 #include <stdlib.h>
  30
  31 static inline uint16_t get16(const uint8_t *ptr)
  32 {
  33     uint16_t result;
  34     memcpy(&result, ptr, sizeof(result));
  35     return cbor_ntohs(result);
  36 }
  37
  38 static inline uint32_t get32(const uint8_t *ptr)
  39 {
  40     uint32_t result;
  41     memcpy(&result, ptr, sizeof(result));
  42     return cbor_ntohl(result);
  43 }
  44
  45 static inline uint64_t get64(const uint8_t *ptr)
  46 {
  47     uint64_t result;
  48     memcpy(&result, ptr, sizeof(result));
  49     return cbor_ntohll(result);
  50 }
  51
  52 static CborError extract_number(const uint8_t **ptr, const uint8_t *end, uint64_t *len)
  53 {
  54     uint8_t additional_information = **ptr & SmallValueMask;
  55     ++*ptr;
  56     if (additional_information < Value8Bit) {
  57         *len = additional_information;
  58         return CborNoError;
  59     }
  60     if (unlikely(additional_information > Value64Bit))
  61         return CborErrorIllegalNumber;
  62
  63     size_t bytesNeeded = (size_t)(1 << (additional_information - Value8Bit));
  64     if (unlikely(bytesNeeded > (size_t)(end - *ptr))) {
  65         return CborErrorUnexpectedEOF;
  66     } else if (bytesNeeded == 1) {
  67         *len = (uint8_t)(*ptr)[0];
  68     } else if (bytesNeeded == 2) {
  69         *len = get16(*ptr);
  70     } else if (bytesNeeded == 4) {
  71         *len = get32(*ptr);
  72     } else {
  73         *len = get64(*ptr);
  74     }
  75     *ptr += bytesNeeded;
  76     return CborNoError;
  77 }