Skip to content

Commit 86b40d7

Browse files
MegMlljorisv
authored andcommitted
JointSpline - Disable assert
1 parent ef9b1e3 commit 86b40d7

File tree

1 file changed

+7
-4
lines changed

1 file changed

+7
-4
lines changed

include/pinocchio/multibody/joint/joint-spline.hpp

Lines changed: 7 additions & 4 deletions
Original file line numberDiff line numberDiff line change
@@ -222,8 +222,10 @@ namespace pinocchio
222222
template<typename ConfigVector>
223223
void calc(JointDataDerived & data, const Eigen::MatrixBase<ConfigVector> & qs) const
224224
{
225-
assert(
226-
qs[0] >= 0.0 && qs[0] <= 1.0 && "Spline joint configuration (q) must be between 0 and 1.");
225+
// TODO : Fix it with casadi, or not include include when compiled with casadi
226+
// assert(
227+
// qs[0] >= 0.0 && qs[0] <= 1.0 && "Spline joint configuration (q) must be between 0
228+
// and 1.");
227229
data.joint_q = qs.template segment<NQ>(idx_q());
228230

229231
SpanIndexes indexes = FindSpan<Scalar, Options>::run(qs, degree, nbCtrlFrames, knots);
@@ -259,8 +261,9 @@ namespace pinocchio
259261
const Eigen::MatrixBase<ConfigVector> & qs,
260262
const Eigen::MatrixBase<TangentVector> & vs) const
261263
{
262-
assert(
263-
qs[0] >= 0.0 && qs[0] <= 1.0 && "Spline joint configuration (q) must be between 0 and 1.");
264+
// assert(
265+
// qs[0] >= 0.0 && qs[0] <= 1.0 && "Spline joint configuration (q) must be between 0
266+
// and 1.");
264267

265268
data.joint_q = qs.template segment<NQ>(idx_q());
266269
data.joint_v = vs.template segment<NV>(idx_v());

0 commit comments

Comments
 (0)