Adding new function for explicited translating added mass origin, rather than hiding it in parseURDFNode