Add BodyNode::updateAcceleration() inside of BodyNode::update_ddq().