Add nan value checking assertions to BodyNode