added conversion method from mtsDoubleVec to Wrench