Add nan value checking assertions to BodyNode
Merge branch 'origin/master'