2011-05-23 17:18:52 +10:00
|
|
|
/*
|
2011-06-21 20:26:32 +10:00
|
|
|
* This file is part of libgim.
|
2011-05-23 17:18:52 +10:00
|
|
|
*
|
2011-06-21 20:26:32 +10:00
|
|
|
* libgim is free software: you can redistribute it and/or modify it under the
|
2011-05-23 17:18:52 +10:00
|
|
|
* terms of the GNU General Public License as published by the Free Software
|
|
|
|
* Foundation, either version 3 of the License, or (at your option) any later
|
|
|
|
* version.
|
2014-09-11 15:34:46 +10:00
|
|
|
*
|
2011-06-21 20:26:32 +10:00
|
|
|
* libgim is distributed in the hope that it will be useful, but WITHOUT ANY
|
2011-05-23 17:18:52 +10:00
|
|
|
* WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
|
|
|
|
* FOR A PARTICULAR PURPOSE. See the GNU General Public License for more
|
|
|
|
* details.
|
2014-09-11 15:34:46 +10:00
|
|
|
*
|
2011-05-23 17:18:52 +10:00
|
|
|
* You should have received a copy of the GNU General Public License
|
2011-06-21 20:26:32 +10:00
|
|
|
* along with libgim. If not, see <http://www.gnu.org/licenses/>.
|
2011-05-23 17:18:52 +10:00
|
|
|
*
|
2012-04-23 13:06:41 +10:00
|
|
|
* Copyright 2010 Danny Robson <danny@nerdcruft.net>
|
2011-05-23 17:18:52 +10:00
|
|
|
*/
|
|
|
|
|
|
|
|
#include "maths.hpp"
|
|
|
|
|
|
|
|
#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-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
|
|
|
|
|
|
|
|
2012-07-30 16:31:19 +10:00
|
|
|
//-----------------------------------------------------------------------------
|
2012-05-03 15:55:45 +10:00
|
|
|
template <typename T>
|
|
|
|
int
|
|
|
|
sign (T val) {
|
|
|
|
return val >= 0 ? 1 : -1;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
template <>
|
|
|
|
int
|
|
|
|
sign (float val) {
|
2014-07-02 15:47:09 +10:00
|
|
|
return static_cast<int> (copysign (1.0f, val));
|
2012-05-03 15:55:45 +10:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
template <>
|
|
|
|
int
|
|
|
|
sign (double val) {
|
2014-07-02 15:47:09 +10:00
|
|
|
return static_cast<int> (copysign (1.0, val));
|
2012-05-03 15:55:45 +10:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
template int sign (int);
|
|
|
|
|