Fix dynamics algorithm of SoftBodyNode according to revised dynamics note