added mtsDoubleVec to WrenchStamped type