//
// Copyright (c) 2015-2020 CNRS INRIA
// Copyright (c) 2015 Wandercraft, 86 rue de Paris 91400 Orsay, France.
//

#include "pinocchio/multibody/joint.hpp"

#include <boost/test/unit_test.hpp>

using namespace pinocchio;

BOOST_AUTO_TEST_SUITE(JointFreeFlyer)

BOOST_AUTO_TEST_CASE(spatial)
{
  Motion v(Motion::Random());

  JointMotionSubspaceIdentityTpl<double, 0> constraint;
  Motion Sv = constraint * v.toVector();

  BOOST_CHECK(Sv == v);
}

BOOST_AUTO_TEST_SUITE_END()
