13#ifndef INCLUDE_SANDALS_HH
14#define INCLUDE_SANDALS_HH
33#define SANDALS_ERROR(MSG) \
35 std::ostringstream os; \
37 throw std::runtime_error(os.str()); \
43#define SANDALS_ASSERT(COND, MSG) \
51#ifndef SANDALS_WARNING
52#define SANDALS_WARNING(MSG) \
54 std::cout << MSG << std::endl; \
59#ifndef SANDALS_ASSERT_WARNING
60#define SANDALS_ASSERT_WARNING(COND, MSG) \
63 SANDALS_WARNING(MSG); \
88 using Matrix0 = Eigen::Matrix<Real, 0, 0>;
90 using Matrix1 = Eigen::Matrix<Real, 1, 1>;
92 using Matrix2 = Eigen::Matrix<Real, 2, 2>;
94 using Matrix3 = Eigen::Matrix<Real, 3, 3>;
96 using Matrix4 = Eigen::Matrix<Real, 4, 4>;
98 using Matrix5 = Eigen::Matrix<Real, 5, 5>;
108 using VectorX = Eigen::Vector<Real, Eigen::Dynamic>;
109 using MatrixX = Eigen::Matrix<Real, Eigen::Dynamic, Eigen::Dynamic>;
126 static Real const INFTY = std::numeric_limits<Real>::infinity();
128 static Real const PI =
Real(3.141592653589793238462643383279502884197);
211 std::ostringstream os;
213 <<
"* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * *" << std::endl
214 <<
"* Copyright (c) 2025, Davide Stocco and Enrico Bertolazzi. *" << std::endl
215 <<
"* *" << std::endl
216 <<
"* The Sandals project is distributed under the BSD 2-Clause License. *" << std::endl
217 <<
"* *" << std::endl
218 <<
"* Davide Stocco Enrico Bertolazzi *" << std::endl
219 <<
"* University of Trento University of Trento *" << std::endl
220 <<
"* e-mail: davide.stocco@unitn.it e-mail: enrico.bertolazzi@unitn.it *" << std::endl
221 <<
"* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * *" << std::endl;
The namespace for the Sandals library.
Definition Sandals.hh:73
Eigen::Vector< Real, 6 > Vector6
Definition Sandals.hh:99
static Matrix8 const IDENTITY_MAT8
Definition Sandals.hh:196
Eigen::Vector< Real, Eigen::Dynamic > VectorX
Definition Sandals.hh:108
static Matrix2 const IDENTITY_MAT2
Definition Sandals.hh:148
Eigen::Matrix< Real, Eigen::Dynamic, Eigen::Dynamic > MatrixX
Definition Sandals.hh:109
double Real
Definition Sandals.hh:84
static Matrix8 const ZEROS_MAT8
Definition Sandals.hh:193
Eigen::Matrix< Real, 8, 8 > Matrix8
Definition Sandals.hh:104
static Matrix6 const ZEROS_MAT6
Definition Sandals.hh:177
static Matrix9 const ZEROS_MAT9
Definition Sandals.hh:201
static Vector9 const ONES_VEC9
Definition Sandals.hh:202
static Matrix4 const ZEROS_MAT4
Definition Sandals.hh:161
static Matrix5 const ONES_MAT5
Definition Sandals.hh:171
static Matrix1 const ZEROS_MAT1
Definition Sandals.hh:137
static Matrix8 const ONES_MAT8
Definition Sandals.hh:195
static Matrix6 const IDENTITY_MAT6
Definition Sandals.hh:180
static Vector1 const ZEROS_VEC1
Definition Sandals.hh:136
static Vector6 const ZEROS_VEC6
Definition Sandals.hh:176
static Real const EPSILON_HIGH
Definition Sandals.hh:123
static Vector7 const ZEROS_VEC7
Definition Sandals.hh:184
Eigen::Vector< Real, 8 > Vector8
Definition Sandals.hh:103
static Matrix3 const IDENTITY_MAT3
Definition Sandals.hh:156
Eigen::Vector< Real, 4 > Vector4
Definition Sandals.hh:95
static Matrix2 const NAN_MAT2
Definition Sandals.hh:143
static Matrix3 const NAN_MAT3
Definition Sandals.hh:151
static Matrix8 const NAN_MAT8
Definition Sandals.hh:191
static Matrix6 const NAN_MAT6
Definition Sandals.hh:175
static Vector3 const NAN_VEC3
Definition Sandals.hh:150
static Vector7 const ONES_VEC7
Definition Sandals.hh:186
static Real const EPSILON_LOW
Definition Sandals.hh:125
static Matrix4 const IDENTITY_MAT4
Definition Sandals.hh:164
static Vector4 const ONES_VEC4
Definition Sandals.hh:162
static Matrix7 const IDENTITY_MAT7
Definition Sandals.hh:188
Eigen::Matrix< Real, 5, 5 > Matrix5
Definition Sandals.hh:98
Eigen::Matrix< Real, 4, 4 > Matrix4
Definition Sandals.hh:96
static Matrix7 const NAN_MAT7
Definition Sandals.hh:183
static Matrix9 const ONES_MAT9
Definition Sandals.hh:203
static Matrix3 const ZEROS_MAT3
Definition Sandals.hh:153
static Vector5 const ZEROS_VEC5
Definition Sandals.hh:168
static Vector9 const ZEROS_VEC9
Definition Sandals.hh:200
static Matrix1 const NAN_MAT1
Definition Sandals.hh:135
static Vector8 const ONES_VEC8
Definition Sandals.hh:194
static Real const PI
Definition Sandals.hh:128
Eigen::Vector< Real, 5 > Vector5
Definition Sandals.hh:97
Eigen::Vector< Real, 3 > Vector3
Definition Sandals.hh:93
static Vector2 const ONES_VEC2
Definition Sandals.hh:146
static Matrix7 const ONES_MAT7
Definition Sandals.hh:187
static Vector7 const NAN_VEC7
Definition Sandals.hh:182
static Real const CBRT_EPSILON
Definition Sandals.hh:122
static Vector8 const NAN_VEC8
Definition Sandals.hh:190
static Matrix7 const ZEROS_MAT7
Definition Sandals.hh:185
static Real const EPSILON_MEDIUM
Definition Sandals.hh:124
static Matrix5 const IDENTITY_MAT5
Definition Sandals.hh:172
Eigen::Matrix< Real, 6, 6 > Matrix6
Definition Sandals.hh:100
static Real const INFTY
Definition Sandals.hh:126
static Real const RAD2DEG
Definition Sandals.hh:132
Eigen::Matrix< Real, 9, 9 > Matrix9
Definition Sandals.hh:106
static Matrix2 const ZEROS_MAT2
Definition Sandals.hh:145
static Matrix1 const IDENTITY_MAT1
Definition Sandals.hh:140
static Vector6 const NAN_VEC6
Definition Sandals.hh:174
static Vector1 const ONES_VEC1
Definition Sandals.hh:138
std::string Info()
Definition Sandals.hh:210
static Real const EPSILON
Definition Sandals.hh:120
Eigen::Matrix< Real, 2, 2 > Matrix2
Definition Sandals.hh:92
Eigen::Vector< Real, 9 > Vector9
Definition Sandals.hh:105
static Real const QUIET_NAN
Definition Sandals.hh:127
static Matrix1 const ONES_MAT1
Definition Sandals.hh:139
static Matrix4 const NAN_MAT4
Definition Sandals.hh:159
static Matrix9 const NAN_MAT9
Definition Sandals.hh:199
static Vector6 const ONES_VEC6
Definition Sandals.hh:178
static Vector2 const ZEROS_VEC2
Definition Sandals.hh:144
static Vector4 const ZEROS_VEC4
Definition Sandals.hh:160
Eigen::Vector< Real, 0 > Vector0
Definition Sandals.hh:87
Eigen::Matrix< Real, 0, 0 > Matrix0
Definition Sandals.hh:88
static Vector3 const ZEROS_VEC3
Definition Sandals.hh:152
static Vector2 const NAN_VEC2
Definition Sandals.hh:142
static Matrix4 const ONES_MAT4
Definition Sandals.hh:163
Eigen::Vector< Real, 2 > Vector2
Definition Sandals.hh:91
static Matrix3 const ONES_MAT3
Definition Sandals.hh:155
Eigen::Matrix< Real, 1, 1 > Matrix1
Definition Sandals.hh:90
Eigen::Matrix< Real, 3, 3 > Matrix3
Definition Sandals.hh:94
static Matrix6 const ONES_MAT6
Definition Sandals.hh:179
static Vector5 const ONES_VEC5
Definition Sandals.hh:170
static Matrix2 const ONES_MAT2
Definition Sandals.hh:147
static Vector8 const ZEROS_VEC8
Definition Sandals.hh:192
Eigen::Vector< Real, 1 > Vector1
Definition Sandals.hh:89
static Real const PIDIV2
Definition Sandals.hh:130
static Real const DEG2RAD
Definition Sandals.hh:131
static Vector5 const NAN_VEC5
Definition Sandals.hh:166
static Real const SQRT_EPSILON
Definition Sandals.hh:121
Eigen::Vector< Real, 7 > Vector7
Definition Sandals.hh:101
Eigen::Matrix< Real, 7, 7 > Matrix7
Definition Sandals.hh:102
static Vector9 const NAN_VEC9
Definition Sandals.hh:198
static Matrix5 const ZEROS_MAT5
Definition Sandals.hh:169
static Vector4 const NAN_VEC4
Definition Sandals.hh:158
static Vector1 const NAN_VEC1
Definition Sandals.hh:134
static Vector3 const ONES_VEC3
Definition Sandals.hh:154
static Real const PIMUL2
Definition Sandals.hh:129
static Matrix5 const NAN_MAT5
Definition Sandals.hh:167
int Integer
Definition Sandals.hh:85
static Matrix9 const IDENTITY_MAT9
Definition Sandals.hh:204