Fixed error with tf::Quaternion setting