Fix BodyNode::getExternalForceGlobal().
Add comment on BodyNode::setMomentOfInertia()
Remove temporary comments
- Change math::isNan(const Eigen::Vector6d&) to math::isNan(const Eigen::MatrixXd&). This change make the function more general.
- Fix use of this function in BodyNode.