Twist/Wrench::zero() now take poses as arguments; added to_vector() function in Twist/Wrench