[FreeJoint] Quick fix for position integration