kicad/thirdparty/3dxware_sdk/inc/navlib/navlib_operators.h

104 lines
2.9 KiB
C
Raw Normal View History

#ifndef NAVLIB_OPERATORS_H_INCLUDED_
#define NAVLIB_OPERATORS_H_INCLUDED_
/*
* This program source code file is part of KiCad, a free EDA CAD application.
*
* Copyright (c) 2014-2021 3Dconnexion.
*
* This program is free software: you can redistribute it and/or modify it
* under the 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.
*
* This program is distributed in the hope that it will be useful, but
* WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
* General Public License for more details.
*
* You should have received a copy of the GNU General Public License along
* with this program. If not, see <http://www.gnu.org/licenses/>.
*/
/**
* @file navlib_operators.h
* @brief the operator overloads for variable types used in the 3dconnexion
* interface.
*/
#include <navlib/navlib_types.h>
// stdlib
#include <float.h>
#include <math.h>
_NAVLIB_BEGIN
/// <summary>
/// Compare floating point numbers.
/// </summary>
/// <param name="a">First value to compare.</param>
/// <param name="b">Second value to compare.</param>
/// <param name="epsilon">Maximum relative error.</param>
/// <returns></returns>
/// <remarks>
/// From https://randomascii.wordpress.com/2012/02/25/comparing-floating-point-numbers-2012-edition.
/// Copyright Bruce Dawson.
/// </remarks>
template <class T> bool equals(T a, T b, T epsilon = static_cast<T>(FLT_EPSILON)) {
T diff = fabs(a - b);
if (diff < epsilon) {
return true;
}
a = fabs(a);
b = fabs(b);
T largest = (a > b) ? a : b;
if (diff <= largest * epsilon) {
return true;
}
return false;
}
inline bool operator==(const vector_t &lhs, const vector_t &rhs) {
return (equals(lhs.x, rhs.x) && equals(lhs.y, rhs.y) && equals(lhs.z, rhs.z));
}
inline bool operator!=(const vector_t &lhs, const vector_t &rhs) {
return !(lhs == rhs);
}
inline bool operator==(const point_t &lhs, const point_t &rhs) {
return (equals(lhs.x, rhs.x) && equals(lhs.y, rhs.y) && equals(lhs.z, rhs.z));
}
inline bool operator!=(const point_t &lhs, const point_t &rhs) {
return !(lhs == rhs);
}
inline bool operator==(const box_t &lhs, const box_t &rhs) {
return lhs.min == rhs.min && lhs.max == rhs.max;
}
inline bool operator!=(const box_t &lhs, const box_t &rhs) {
return !(lhs == rhs);
}
inline bool operator==(const matrix_t &lhs, const matrix_t &rhs) {
for (size_t i = 0; i < sizeof(rhs.m) / sizeof(rhs.m[0]); ++i) {
if (!equals(lhs.m[i], rhs.m[i])) {
return false;
}
}
return true;
}
inline bool operator!=(const matrix_t &lhs, const matrix_t &rhs) {
return !(lhs == rhs);
}
inline nlOptions_t operator|(nlOptions_t lhs, nlOptions_t rhs) {
return static_cast<nlOptions_t>(static_cast<int>(lhs) | static_cast<int>(rhs));
}
_NAVLIB_END
#endif /* NAVLIB_OPERATORS_H_INCLUDED_ */