1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207
|
#ifndef AWS_COMMON_MATH_FALLBACK_INL
#define AWS_COMMON_MATH_FALLBACK_INL
/**
* Copyright Amazon.com, Inc. or its affiliates. All Rights Reserved.
* SPDX-License-Identifier: Apache-2.0.
*/
/*
* This header is already included, but include it again to make editor
* highlighting happier.
*/
#include <aws/common/common.h>
#include <aws/common/math.h>
AWS_EXTERN_C_BEGIN
/**
* Multiplies a * b. If the result overflows, returns 2^64 - 1.
*/
AWS_STATIC_IMPL uint64_t aws_mul_u64_saturating(uint64_t a, uint64_t b) {
if (a > 0 && b > 0 && a > (UINT64_MAX / b))
return UINT64_MAX;
return a * b;
}
/**
* If a * b overflows, returns AWS_OP_ERR; otherwise multiplies
* a * b, returns the result in *r, and returns AWS_OP_SUCCESS.
*/
AWS_STATIC_IMPL int aws_mul_u64_checked(uint64_t a, uint64_t b, uint64_t *r) {
if (a > 0 && b > 0 && a > (UINT64_MAX / b))
return aws_raise_error(AWS_ERROR_OVERFLOW_DETECTED);
*r = a * b;
return AWS_OP_SUCCESS;
}
/**
* Multiplies a * b. If the result overflows, returns 2^32 - 1.
*/
AWS_STATIC_IMPL uint32_t aws_mul_u32_saturating(uint32_t a, uint32_t b) {
if (a > 0 && b > 0 && a > (UINT32_MAX / b))
return UINT32_MAX;
return a * b;
}
/**
* If a * b overflows, returns AWS_OP_ERR; otherwise multiplies
* a * b, returns the result in *r, and returns AWS_OP_SUCCESS.
*/
AWS_STATIC_IMPL int aws_mul_u32_checked(uint32_t a, uint32_t b, uint32_t *r) {
if (a > 0 && b > 0 && a > (UINT32_MAX / b))
return aws_raise_error(AWS_ERROR_OVERFLOW_DETECTED);
*r = a * b;
return AWS_OP_SUCCESS;
}
/**
* Adds a + b. If the result overflows returns 2^64 - 1.
*/
AWS_STATIC_IMPL uint64_t aws_add_u64_saturating(uint64_t a, uint64_t b) {
if ((b > 0) && (a > (UINT64_MAX - b)))
return UINT64_MAX;
return a + b;
}
/**
* If a + b overflows, returns AWS_OP_ERR; otherwise adds
* a + b, returns the result in *r, and returns AWS_OP_SUCCESS.
*/
AWS_STATIC_IMPL int aws_add_u64_checked(uint64_t a, uint64_t b, uint64_t *r) {
if ((b > 0) && (a > (UINT64_MAX - b)))
return aws_raise_error(AWS_ERROR_OVERFLOW_DETECTED);
*r = a + b;
return AWS_OP_SUCCESS;
}
/**
* Adds a + b. If the result overflows returns 2^32 - 1.
*/
AWS_STATIC_IMPL uint32_t aws_add_u32_saturating(uint32_t a, uint32_t b) {
if ((b > 0) && (a > (UINT32_MAX - b)))
return UINT32_MAX;
return a + b;
}
/**
* If a + b overflows, returns AWS_OP_ERR; otherwise adds
* a + b, returns the result in *r, and returns AWS_OP_SUCCESS.
*/
AWS_STATIC_IMPL int aws_add_u32_checked(uint32_t a, uint32_t b, uint32_t *r) {
if ((b > 0) && (a > (UINT32_MAX - b)))
return aws_raise_error(AWS_ERROR_OVERFLOW_DETECTED);
*r = a + b;
return AWS_OP_SUCCESS;
}
/*
* These are pure C implementations of the count leading/trailing zeros calls
* They should not be necessary unless using a really esoteric compiler with
* no intrinsics for these functions whatsoever.
*/
#if !defined(__clang__) && !defined(__GNUC__)
/**
* Search from the MSB to LSB, looking for a 1
*/
AWS_STATIC_IMPL size_t aws_clz_u32(uint32_t n) {
return aws_clz_i32((int32_t)n);
}
AWS_STATIC_IMPL size_t aws_clz_i32(int32_t n) {
size_t idx = 0;
if (n == 0) {
return sizeof(n) * 8;
}
/* sign bit is the first bit */
if (n < 0) {
return 0;
}
while (n >= 0) {
++idx;
n <<= 1;
}
return idx;
}
AWS_STATIC_IMPL size_t aws_clz_u64(uint64_t n) {
return aws_clz_i64((int64_t)n);
}
AWS_STATIC_IMPL size_t aws_clz_i64(int64_t n) {
size_t idx = 0;
if (n == 0) {
return sizeof(n) * 8;
}
/* sign bit is the first bit */
if (n < 0) {
return 0;
}
while (n >= 0) {
++idx;
n <<= 1;
}
return idx;
}
AWS_STATIC_IMPL size_t aws_clz_size(size_t n) {
# if SIZE_BITS == 64
return aws_clz_u64(n);
# else
return aws_clz_u32(n);
# endif
}
/**
* Search from the LSB to MSB, looking for a 1
*/
AWS_STATIC_IMPL size_t aws_ctz_u32(uint32_t n) {
return aws_ctz_i32((int32_t)n);
}
AWS_STATIC_IMPL size_t aws_ctz_i32(int32_t n) {
int32_t idx = 0;
const int32_t max_bits = (int32_t)(SIZE_BITS / sizeof(uint8_t));
if (n == 0) {
return sizeof(n) * 8;
}
while (idx < max_bits) {
if (n & (1 << idx)) {
break;
}
++idx;
}
return (size_t)idx;
}
AWS_STATIC_IMPL size_t aws_ctz_u64(uint64_t n) {
return aws_ctz_i64((int64_t)n);
}
AWS_STATIC_IMPL size_t aws_ctz_i64(int64_t n) {
int64_t idx = 0;
const int64_t max_bits = (int64_t)(SIZE_BITS / sizeof(uint8_t));
if (n == 0) {
return sizeof(n) * 8;
}
while (idx < max_bits) {
if (n & (1ULL << idx)) {
break;
}
++idx;
}
return (size_t)idx;
}
AWS_STATIC_IMPL size_t aws_ctz_size(size_t n) {
# if SIZE_BITS == 64
return aws_ctz_u64(n);
# else
return aws_ctz_u32(n);
# endif
}
#endif
AWS_EXTERN_C_END
#endif /* AWS_COMMON_MATH_FALLBACK_INL */
|