15 #ifndef INCLUDED_core_kinematics_Stub_hh
16 #define INCLUDED_core_kinematics_Stub_hh
25 #include <numeric/xyzMatrix.hh>
26 #include <numeric/xyzVector.hh>
33 #include <utility/vector1.hh>
36 namespace kinematics {
130 Matrix delta(
M *
M.transposed() - Matrix::identity() );
131 return ( ( delta.col_x().length() +
132 delta.col_y().length() +
133 delta.col_z().length() ) < tolerance );
140 return M.transposed() * ( xyz -
v );
161 Real const d_sin_theta( d * std::sin( theta ) );
163 d * std::cos( theta ),
164 d_sin_theta * std::cos( phi ),
165 d_sin_theta * std::sin( phi ) ) );
189 using namespace numeric;
191 a.
M.col_x().distance_squared(b.
M.col_x() ) +
192 a.
M.col_y().distance_squared(b.
M.col_y() ) +
193 a.
M.col_z().distance_squared(b.
M.col_z() ) +
194 a.
v.distance_squared( b.
v )
210 #endif // INCLUDED_core_kinematics_Stub_HH