Move evalVelocity() and evalOmega() from BodyNodeDynamics class to BodyNode class because these functions are related with kinematics not dynamics.