2011-05-23 17:18:52 +10:00
|
|
|
/*
|
2015-04-13 18:05:28 +10:00
|
|
|
* Licensed 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
|
2011-05-23 17:18:52 +10:00
|
|
|
*
|
2015-04-13 18:05:28 +10:00
|
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
2014-09-11 15:34:46 +10:00
|
|
|
*
|
2015-04-13 18:05:28 +10:00
|
|
|
* 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.
|
2011-05-23 17:18:52 +10:00
|
|
|
*
|
2014-09-17 18:20:28 +10:00
|
|
|
* Copyright 2010-2014 Danny Robson <danny@nerdcruft.net>
|
2011-05-23 17:18:52 +10:00
|
|
|
*/
|
|
|
|
|
|
|
|
#include "maths.hpp"
|
|
|
|
|
2015-02-05 20:30:33 +11:00
|
|
|
#include "debug.hpp"
|
|
|
|
|
2011-05-23 17:18:52 +10:00
|
|
|
#include "float.hpp"
|
|
|
|
|
|
|
|
#include <cmath>
|
2011-08-29 14:31:22 +10:00
|
|
|
#include <type_traits>
|
2011-05-23 17:18:52 +10:00
|
|
|
|
|
|
|
|
2012-07-30 16:31:19 +10:00
|
|
|
//-----------------------------------------------------------------------------
|
2011-08-29 14:31:22 +10:00
|
|
|
template <typename T>
|
|
|
|
bool
|
|
|
|
is_pow2 (T value) {
|
2012-05-25 15:19:07 +10:00
|
|
|
typedef typename std::enable_if<std::is_integral<T>::value, bool>::type return_type;
|
2011-08-29 14:31:22 +10:00
|
|
|
return (return_type)(value && !(value & (value - 1)));
|
|
|
|
}
|
|
|
|
|
2012-07-30 16:31:19 +10:00
|
|
|
|
2011-08-29 14:31:22 +10:00
|
|
|
template bool is_pow2 (uint8_t);
|
|
|
|
template bool is_pow2 (uint16_t);
|
|
|
|
template bool is_pow2 (uint32_t);
|
|
|
|
template bool is_pow2 (uint64_t);
|
|
|
|
|
|
|
|
|
2014-09-17 16:41:38 +10:00
|
|
|
//-----------------------------------------------------------------------------
|
|
|
|
template <typename T>
|
|
|
|
T
|
|
|
|
log2up (T v)
|
|
|
|
{
|
|
|
|
return log2 ((v << 1) - 1);
|
|
|
|
}
|
|
|
|
|
|
|
|
template uint32_t log2up (uint32_t);
|
|
|
|
template uint64_t log2up (uint64_t);
|
|
|
|
|
|
|
|
|
2014-09-11 15:34:59 +10:00
|
|
|
//-----------------------------------------------------------------------------
|
|
|
|
template <typename T>
|
|
|
|
T
|
|
|
|
log2 (T v) {
|
|
|
|
static_assert (std::is_integral<T>::value,
|
|
|
|
"log2 is only implemented for integers");
|
|
|
|
|
|
|
|
T l = 0;
|
2014-09-17 16:41:19 +10:00
|
|
|
while (v >>= 1)
|
|
|
|
++l;
|
2014-09-11 15:34:59 +10:00
|
|
|
|
|
|
|
return l;
|
|
|
|
}
|
|
|
|
|
2014-09-17 16:41:19 +10:00
|
|
|
template uint8_t log2 (uint8_t);
|
|
|
|
template uint16_t log2 (uint16_t);
|
2014-09-11 15:34:59 +10:00
|
|
|
template uint32_t log2 (uint32_t);
|
|
|
|
template uint64_t log2 (uint64_t);
|
|
|
|
|
|
|
|
|
2012-07-30 16:31:19 +10:00
|
|
|
//-----------------------------------------------------------------------------
|
2011-05-23 17:18:52 +10:00
|
|
|
template <typename T>
|
|
|
|
double
|
|
|
|
rootsquare (T a, T b)
|
2011-07-16 15:53:53 +10:00
|
|
|
{ return sqrt (pow2 (a) + pow2 (b)); }
|
2011-05-23 17:18:52 +10:00
|
|
|
|
2012-07-30 16:31:19 +10:00
|
|
|
|
2011-05-23 17:18:52 +10:00
|
|
|
template double rootsquare (double, double);
|
|
|
|
template double rootsquare ( int, int);
|
|
|
|
|
|
|
|
|
2012-07-30 16:31:19 +10:00
|
|
|
//-----------------------------------------------------------------------------
|
2012-04-20 18:04:40 +10:00
|
|
|
template <typename T>
|
|
|
|
bool
|
|
|
|
is_integer (const T &value) {
|
|
|
|
T integer;
|
|
|
|
return exactly_equal (std::modf (value, &integer),
|
|
|
|
static_cast<T> (0.0));
|
|
|
|
}
|
|
|
|
|
2012-07-30 16:31:19 +10:00
|
|
|
|
2012-04-20 18:04:40 +10:00
|
|
|
template bool is_integer (const double&);
|
|
|
|
template bool is_integer (const float&);
|
|
|
|
|
|
|
|
|
2012-07-30 16:31:51 +10:00
|
|
|
//-----------------------------------------------------------------------------
|
|
|
|
template <>
|
|
|
|
unsigned
|
|
|
|
digits (const uint32_t &v) {
|
|
|
|
return (v >= 1000000000) ? 10 :
|
|
|
|
(v >= 100000000) ? 9 :
|
2014-09-11 15:34:46 +10:00
|
|
|
(v >= 10000000) ? 8 :
|
2012-07-30 16:31:51 +10:00
|
|
|
(v >= 1000000) ? 7 :
|
|
|
|
(v >= 100000) ? 6 :
|
2014-09-11 15:34:46 +10:00
|
|
|
(v >= 10000) ? 5 :
|
2012-07-30 16:31:51 +10:00
|
|
|
(v >= 1000) ? 4 :
|
|
|
|
(v >= 100) ? 3 :
|
|
|
|
(v >= 10) ? 2 :
|
|
|
|
1;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
//-----------------------------------------------------------------------------
|
2011-05-23 17:18:52 +10:00
|
|
|
template <>
|
|
|
|
bool
|
2011-07-16 15:53:53 +10:00
|
|
|
almost_equal (const float &a, const float &b)
|
2011-05-23 17:18:52 +10:00
|
|
|
{ return ieee_single::almost_equal (a, b); }
|
|
|
|
|
|
|
|
|
|
|
|
template <>
|
|
|
|
bool
|
2011-07-16 15:53:53 +10:00
|
|
|
almost_equal (const double &a, const double &b)
|
2011-05-23 17:18:52 +10:00
|
|
|
{ return ieee_double::almost_equal (a, b); }
|
|
|
|
|
|
|
|
|
2012-07-30 16:31:19 +10:00
|
|
|
//-----------------------------------------------------------------------------
|
2011-08-29 14:31:22 +10:00
|
|
|
template <typename T>
|
|
|
|
T
|
|
|
|
round_pow2 (T value) {
|
2012-05-25 15:19:07 +10:00
|
|
|
typedef typename std::enable_if<std::is_integral<T>::value, T>::type return_type;
|
2011-08-29 14:31:22 +10:00
|
|
|
|
|
|
|
--value;
|
|
|
|
|
|
|
|
for (unsigned i = 1; i < sizeof (T) * 8; i <<= 1) {
|
|
|
|
value |= value >> i;
|
|
|
|
}
|
|
|
|
|
|
|
|
++value;
|
|
|
|
return (return_type)value;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
template uint8_t round_pow2 (uint8_t);
|
|
|
|
template uint16_t round_pow2 (uint16_t);
|
|
|
|
template uint32_t round_pow2 (uint32_t);
|
|
|
|
template uint64_t round_pow2 (uint64_t);
|
2012-05-03 15:55:45 +10:00
|
|
|
|
|
|
|
|
2015-02-05 20:30:33 +11:00
|
|
|
//-----------------------------------------------------------------------------
|
|
|
|
// Simple instantiations. Some functions aren't used internally to the library
|
|
|
|
// so it's easier to instantiate early and check for broken code at library
|
|
|
|
// build time.
|
|
|
|
|
2015-02-05 20:30:45 +11:00
|
|
|
template float limit (float, float, float);
|
|
|
|
|
2015-02-05 20:30:33 +11:00
|
|
|
template float smoothstep (float, float, float);
|
|
|
|
template double smoothstep (double, double, double);
|