trimble callbacks use pose instead of odom; shortened quaternion copying code