mirror of
https://gitlab.com/kicad/code/kicad.git
synced 2024-11-22 08:55:02 +00:00
c99a4f4d85
The commit only adds the headers and code required by the SpaceMouse implementation to compile and link. This extract from the 3Dconnexion SDK is added to the third party directory to allow developers to build without needing to acquire a cmake enabled version.
104 lines
2.9 KiB
C++
104 lines
2.9 KiB
C++
#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_ */ |