WPILibC++ 2023.4.3
find_whole.hpp
Go to the documentation of this file.
1/*################################################################################
2 ##
3 ## Copyright (C) 2016-2022 Keith O'Hara
4 ##
5 ## This file is part of the GCE-Math C++ library.
6 ##
7 ## Licensed under the Apache License, Version 2.0 (the "License");
8 ## you may not use this file except in compliance with the License.
9 ## You may obtain a copy of the License at
10 ##
11 ## http://www.apache.org/licenses/LICENSE-2.0
12 ##
13 ## Unless required by applicable law or agreed to in writing, software
14 ## distributed under the License is distributed on an "AS IS" BASIS,
15 ## WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
16 ## See the License for the specific language governing permissions and
17 ## limitations under the License.
18 ##
19 ################################################################################*/
20
21/*
22 * find the whole number part of x = n + r, where -0.5 <= r <= 0.5
23 */
24
25#ifndef _gcem_find_whole_HPP
26#define _gcem_find_whole_HPP
27
28namespace internal
29{
30
31template<typename T>
32constexpr
34find_whole(const T x)
35noexcept
36{
37 return( abs(x - internal::floor_check(x)) >= T(0.5) ? \
38 // if
39 static_cast<llint_t>(internal::floor_check(x) + sgn(x)) :
40 // else
41 static_cast<llint_t>(internal::floor_check(x)) );
42}
43
44}
45
46#endif
UnitType abs(const UnitType x) noexcept
Compute absolute value.
Definition: math.h:721
long long int llint_t
Definition: gcem_options.hpp:71
Definition: Eigen_Colamd.h:50
constexpr llint_t find_whole(const T x) noexcept
Definition: find_whole.hpp:34
constexpr T floor_check(const T x) noexcept
Definition: floor.hpp:96
constexpr int sgn(const T x) noexcept
Compile-time sign function.
Definition: sgn.hpp:34