Fix incorrect condition expression of for-loop in BodyNode::init
Fix bug in BodyNode::updateBiasForce()
- Joint damping force wasn't added in forward dynamics.
Merge branch 'master'