[fio.git] / verify.c

/*
 * IO verification helpers
 */
#include <unistd.h>
#include <fcntl.h>
#include <string.h>
#include <assert.h>

#include "fio.h"

#include "crc/md5.h"
#include "crc/crc64.h"
#include "crc/crc32.h"
#include "crc/crc16.h"
#include "crc/crc7.h"
#include "crc/sha256.h"
#include "crc/sha512.h"

static void fill_random_bytes(struct thread_data *td, void *p, unsigned int len)
{
	unsigned int todo;
	int r;

	while (len) {
		r = os_random_long(&td->verify_state);

		/*
		 * lrand48_r seems to be broken and only fill the bottom
		 * 32-bits, even on 64-bit archs with 64-bit longs
		 */
		todo = sizeof(r);
		if (todo > len)
			todo = len;

		memcpy(p, &r, todo);

		len -= todo;
		p += todo;
	}
}

static void fill_pattern(struct thread_data *td, void *p, unsigned int len)
{
	switch (td->o.verify_pattern_bytes) {
	case 0:
		fill_random_bytes(td, p, len);
		break;
	case 1:
		memset(p, td->o.verify_pattern, len);
		break;
	case 2:
	case 3:
	case 4: {
		unsigned int pattern = td->o.verify_pattern;
		unsigned int i = 0;
		unsigned char c1, c2, c3, c4;
		unsigned char *b = p;

		c1 = pattern & 0xff;
		pattern >>= 8;
		c2 = pattern & 0xff;
		pattern >>= 8;
		c3 = pattern & 0xff;
		pattern >>= 8;
		c4 = pattern & 0xff;

		while (i < len) {
			b[i++] = c1;
			if (i == len)
				break;
			b[i++] = c2;
			if (td->o.verify_pattern_bytes == 2 || i == len)
				continue;
			b[i++] = c3;
			if (td->o.verify_pattern_bytes == 3 || i == len)
				continue;
			b[i++] = c4;
		}
		break;
		}
	}
}

static void memswp(void *buf1, void *buf2, unsigned int len)
{
	char swap[200];

	assert(len <= sizeof(swap));

	memcpy(&swap, buf1, len);
	memcpy(buf1, buf2, len);
	memcpy(buf2, &swap, len);
}

static void hexdump(void *buffer, int len)
{
	unsigned char *p = buffer;
	int i;

	for (i = 0; i < len; i++)
		log_info("%02x", p[i]);
	log_info("\n");
}

/*
 * Prepare for seperation of verify_header and checksum header
 */
static inline unsigned int __hdr_size(int verify_type)
{
	unsigned int len;

	switch (verify_type) {
	case VERIFY_NONE:
	case VERIFY_NULL:
	case VERIFY_PATTERN:
		len = 0;
		break;
	case VERIFY_MD5:
		len = sizeof(struct vhdr_md5);
		break;
	case VERIFY_CRC64:
		len = sizeof(struct vhdr_crc64);
		break;
	case VERIFY_CRC32:
		len = sizeof(struct vhdr_crc32);
		break;
	case VERIFY_CRC16:
		len = sizeof(struct vhdr_crc16);
		break;
	case VERIFY_CRC7:
		len = sizeof(struct vhdr_crc7);
		break;
	case VERIFY_SHA256:
		len = sizeof(struct vhdr_sha256);
		break;
	case VERIFY_SHA512:
		len = sizeof(struct vhdr_sha512);
		break;
	case VERIFY_META:
		len = sizeof(struct vhdr_meta);
		break;
	default:
		log_err("fio: unknown verify header!\n");
		assert(0);
	}

	return len + sizeof(struct verify_header);
}

static inline unsigned int hdr_size(struct verify_header *hdr)
{
	return __hdr_size(hdr->verify_type);
}

static void *hdr_priv(struct verify_header *hdr)
{
	void *priv = hdr;

	return priv + sizeof(struct verify_header);
}

/*
 * Return data area 'header_num'
 */
static inline void *io_u_verify_off(struct verify_header *hdr,
				    struct io_u *io_u,
				    unsigned char header_num)
{
	return io_u->buf + header_num * hdr->len + hdr_size(hdr);
}

static int verify_io_u_meta(struct verify_header *hdr, struct thread_data *td,
                            struct io_u *io_u, unsigned int header_num)
{
	struct vhdr_meta *vh = hdr_priv(hdr);

	if (vh->offset != io_u->offset + header_num * td->o.verify_interval) {
		log_err("meta: verify failed at %llu/%u\n",
		              io_u->offset + header_num * hdr->len,
		              hdr->len);
		return EIO;
	}

	return 0;
}

static int verify_io_u_sha512(struct verify_header *hdr, struct io_u *io_u,
			      unsigned int header_num)
{
	void *p = io_u_verify_off(hdr, io_u, header_num);
	struct vhdr_sha512 *vh = hdr_priv(hdr);
	uint8_t sha512[128];
	struct sha512_ctx sha512_ctx = {
		.buf = sha512,
	};

	sha512_init(&sha512_ctx);
	sha512_update(&sha512_ctx, p, hdr->len - hdr_size(hdr));

	if (memcmp(vh->sha512, sha512_ctx.buf, sizeof(sha512))) {
		log_err("sha512: verify failed at %llu/%u\n",
		              io_u->offset + header_num * hdr->len,
		              hdr->len);
		hexdump(vh->sha512, sizeof(vh->sha512));
		hexdump(sha512_ctx.buf, sizeof(sha512));
		return EIO;
	}

	return 0;
}

static int verify_io_u_sha256(struct verify_header *hdr, struct io_u *io_u,
			      unsigned int header_num)
{
	void *p = io_u_verify_off(hdr, io_u, header_num);
	struct vhdr_sha256 *vh = hdr_priv(hdr);
	uint8_t sha256[128];
	struct sha256_ctx sha256_ctx = {
		.buf = sha256,
	};

	sha256_init(&sha256_ctx);
	sha256_update(&sha256_ctx, p, hdr->len - hdr_size(hdr));

	if (memcmp(vh->sha256, sha256_ctx.buf, sizeof(sha256))) {
		log_err("sha256: verify failed at %llu/%u\n",
		              io_u->offset + header_num * hdr->len,
		              hdr->len);
		hexdump(vh->sha256, sizeof(vh->sha256));
		hexdump(sha256_ctx.buf, sizeof(sha256));
		return EIO;
	}

	return 0;
}

static int verify_io_u_crc7(struct verify_header *hdr, struct io_u *io_u,
                            unsigned char header_num)
{
	void *p = io_u_verify_off(hdr, io_u, header_num);
	struct vhdr_crc7 *vh = hdr_priv(hdr);
	unsigned char c;

	c = crc7(p, hdr->len - hdr_size(hdr));

	if (c != vh->crc7) {
		log_err("crc7: verify failed at %llu/%u\n",
		                io_u->offset + header_num * hdr->len,
				hdr->len);
		log_err("crc7: wanted %x, got %x\n", vh->crc7, c);
		return EIO;
	}

	return 0;
}

static int verify_io_u_crc16(struct verify_header *hdr, struct io_u *io_u,
                             unsigned int header_num)
{
	void *p = io_u_verify_off(hdr, io_u, header_num);
	struct vhdr_crc16 *vh = hdr_priv(hdr);
	unsigned short c;

	c = crc16(p, hdr->len - hdr_size(hdr));

	if (c != vh->crc16) {
		log_err("crc16: verify failed at %llu/%u\n",
		                io_u->offset + header_num * hdr->len,
				hdr->len);
		log_err("crc16: wanted %x, got %x\n", vh->crc16, c);
		return EIO;
	}

	return 0;
}

static int verify_io_u_crc64(struct verify_header *hdr, struct io_u *io_u,
                             unsigned int header_num)
{
	void *p = io_u_verify_off(hdr, io_u, header_num);
	struct vhdr_crc64 *vh = hdr_priv(hdr);
	unsigned long long c;

	c = crc64(p, hdr->len - hdr_size(hdr));

	if (c != vh->crc64) {
		log_err("crc64: verify failed at %llu/%u\n",
				io_u->offset + header_num * hdr->len,
				hdr->len);
		log_err("crc64: wanted %llx, got %llx\n", (unsigned long long) vh->crc64, c);
		return EIO;
	}

	return 0;
}

static int verify_io_u_crc32(struct verify_header *hdr, struct io_u *io_u,
		             unsigned int header_num)
{
	void *p = io_u_verify_off(hdr, io_u, header_num);
	struct vhdr_crc32 *vh = hdr_priv(hdr);
	uint32_t c;

	c = crc32(p, hdr->len - hdr_size(hdr));

	if (c != vh->crc32) {
		log_err("crc32: verify failed at %llu/%u\n",
		                io_u->offset + header_num * hdr->len,
				hdr->len);
		log_err("crc32: wanted %x, got %x\n", vh->crc32, c);
		return EIO;
	}

	return 0;
}

static int verify_io_u_md5(struct verify_header *hdr, struct io_u *io_u,
		           unsigned int header_num)
{
	void *p = io_u_verify_off(hdr, io_u, header_num);
	struct vhdr_md5 *vh = hdr_priv(hdr);
	uint32_t hash[MD5_HASH_WORDS];
	struct md5_ctx md5_ctx = {
		.hash = hash,
	};

	md5_init(&md5_ctx);
	md5_update(&md5_ctx, p, hdr->len - hdr_size(hdr));

	if (memcmp(vh->md5_digest, md5_ctx.hash, sizeof(hash))) {
		log_err("md5: verify failed at %llu/%u\n",
		              io_u->offset + header_num * hdr->len,
		              hdr->len);
		hexdump(vh->md5_digest, sizeof(vh->md5_digest));
		hexdump(md5_ctx.hash, sizeof(hash));
		return EIO;
	}

	return 0;
}

static unsigned int hweight8(unsigned int w)
{
	unsigned int res = w - ((w >> 1) & 0x55);

	res = (res & 0x33) + ((res >> 2) & 0x33);
	return (res + (res >> 4)) & 0x0F;
}

int verify_io_u_pattern(unsigned long pattern, unsigned long pattern_size,
                        char *buf, unsigned int len, unsigned int mod)
{
	unsigned int i;
	char split_pattern[4];

	for (i = 0; i < 4; i++) {
		split_pattern[i] = pattern & 0xff;
		pattern >>= 8;
	}

	for (i = 0; i < len; i++) {
		if (buf[i] != split_pattern[mod]) {
			unsigned int bits;

			bits = hweight8(buf[i] ^ split_pattern[mod]);
			log_err("fio: got pattern %x, wanted %x. Bad bits %d\n",
				buf[i], split_pattern[mod], bits);
			log_err("fio: bad pattern block offset %u\n", i);
			return EIO;
		}
		mod++;
		if (mod == pattern_size)
			mod = 0;
	}

	return 0;
}

int verify_io_u(struct thread_data *td, struct io_u *io_u)
{
	struct verify_header *hdr;
	unsigned int hdr_size, hdr_inc, hdr_num = 0;
	void *p;
	int ret;

	if (td->o.verify == VERIFY_NULL || io_u->ddir != DDIR_READ)
		return 0;

	hdr_inc = io_u->buflen;
	if (td->o.verify_interval)
		hdr_inc = td->o.verify_interval;

	ret = 0;
	for (p = io_u->buf; p < io_u->buf + io_u->buflen; p += hdr_inc, hdr_num++) {
		if (ret && td->o.verify_fatal) {
			td->terminate = 1;
			break;
		}
		hdr_size = __hdr_size(td->o.verify);
		if (td->o.verify_offset)
			memswp(p, p + td->o.verify_offset, hdr_size);
		hdr = p;

		if (hdr->fio_magic != FIO_HDR_MAGIC) {
			log_err("Bad verify header %x\n", hdr->fio_magic);
			return EIO;
		}

		switch (hdr->verify_type) {
		case VERIFY_MD5:
			ret = verify_io_u_md5(hdr, io_u, hdr_num);
			break;
		case VERIFY_CRC64:
			ret = verify_io_u_crc64(hdr, io_u, hdr_num);
			break;
		case VERIFY_CRC32:
			ret = verify_io_u_crc32(hdr, io_u, hdr_num);
			break;
		case VERIFY_CRC16:
			ret = verify_io_u_crc16(hdr, io_u, hdr_num);
			break;
		case VERIFY_CRC7:
			ret = verify_io_u_crc7(hdr, io_u, hdr_num);
			break;
		case VERIFY_SHA256:
			ret = verify_io_u_sha256(hdr, io_u, hdr_num);
			break;
		case VERIFY_SHA512:
			ret = verify_io_u_sha512(hdr, io_u, hdr_num);
			break;
		case VERIFY_META:
			ret = verify_io_u_meta(hdr, td, io_u, hdr_num);
			break;
		case VERIFY_PATTERN:
			ret = verify_io_u_pattern(td->o.verify_pattern,
			                          td->o.verify_pattern_bytes,
			                          p + hdr_size,
			                          hdr_inc - hdr_size,
			                          hdr_size % 4);
			if (ret)
				log_err("fio: verify failed at %llu/%u\n",
					io_u->offset + hdr_num * hdr->len,
					hdr->len);
			break;
		default:
			log_err("Bad verify type %u\n", hdr->verify_type);
			ret = EINVAL;
		}
	}

	return ret;
}

static void fill_meta(struct verify_header *hdr, struct thread_data *td,
                      struct io_u *io_u, unsigned int header_num)
{
	struct vhdr_meta *vh = hdr_priv(hdr);

	vh->thread = td->thread_number;

	vh->time_sec = io_u->start_time.tv_sec;
	vh->time_usec = io_u->start_time.tv_usec;

	vh->numberio = td->io_issues[DDIR_WRITE];

	vh->offset = io_u->offset + header_num * td->o.verify_interval;
}

static void fill_sha512(struct verify_header *hdr, void *p, unsigned int len)
{
	struct vhdr_sha512 *vh = hdr_priv(hdr);
	struct sha512_ctx sha512_ctx = {
		.buf = vh->sha512,
	};

	sha512_init(&sha512_ctx);
	sha512_update(&sha512_ctx, p, len);
}

static void fill_sha256(struct verify_header *hdr, void *p, unsigned int len)
{
	struct vhdr_sha256 *vh = hdr_priv(hdr);
	struct sha256_ctx sha256_ctx = {
		.buf = vh->sha256,
	};

	sha256_init(&sha256_ctx);
	sha256_update(&sha256_ctx, p, len);
}

static void fill_crc7(struct verify_header *hdr, void *p, unsigned int len)
{
	struct vhdr_crc7 *vh = hdr_priv(hdr);

	vh->crc7 = crc7(p, len);
}

static void fill_crc16(struct verify_header *hdr, void *p, unsigned int len)
{
	struct vhdr_crc16 *vh = hdr_priv(hdr);

	vh->crc16 = crc16(p, len);
}

static void fill_crc32(struct verify_header *hdr, void *p, unsigned int len)
{
	struct vhdr_crc32 *vh = hdr_priv(hdr);

	vh->crc32 = crc32(p, len);
}

static void fill_crc64(struct verify_header *hdr, void *p, unsigned int len)
{
	struct vhdr_crc64 *vh = hdr_priv(hdr);

	vh->crc64 = crc64(p, len);
}

static void fill_md5(struct verify_header *hdr, void *p, unsigned int len)
{
	struct vhdr_md5 *vh = hdr_priv(hdr);
	struct md5_ctx md5_ctx = {
		.hash = (uint32_t *) vh->md5_digest,
	};

	md5_init(&md5_ctx);
	md5_update(&md5_ctx, p, len);
}

/*
 * fill body of io_u->buf with random data and add a header with the
 * crc32 or md5 sum of that data.
 */
void populate_verify_io_u(struct thread_data *td, struct io_u *io_u)
{
	struct verify_header *hdr;
	void *p = io_u->buf, *data;
	unsigned int hdr_inc, data_len, header_num = 0;

	if (td->o.verify == VERIFY_NULL)
		return;

	fill_pattern(td, p, io_u->buflen);

	hdr_inc = io_u->buflen;
	if (td->o.verify_interval)
		hdr_inc = td->o.verify_interval;

	for (;p < io_u->buf + io_u->buflen; p += hdr_inc) {
		hdr = p;

		hdr->fio_magic = FIO_HDR_MAGIC;
		hdr->verify_type = td->o.verify;
		hdr->len = hdr_inc;
		data_len = hdr_inc - hdr_size(hdr);

		data = p + hdr_size(hdr);
		switch (td->o.verify) {
		case VERIFY_MD5:
			fill_md5(hdr, data, data_len);
			break;
		case VERIFY_CRC64:
			fill_crc64(hdr, data, data_len);
			break;
		case VERIFY_CRC32:
			fill_crc32(hdr, data, data_len);
			break;
		case VERIFY_CRC16:
			fill_crc16(hdr, data, data_len);
			break;
		case VERIFY_CRC7:
			fill_crc7(hdr, data, data_len);
			break;
		case VERIFY_SHA256:
			fill_sha256(hdr, data, data_len);
			break;
		case VERIFY_SHA512:
			fill_sha512(hdr, data, data_len);
			break;
		case VERIFY_META:
			fill_meta(hdr, td, io_u, header_num);
			break;
		case VERIFY_PATTERN:
			break;
		default:
			log_err("fio: bad verify type: %d\n", td->o.verify);
			assert(0);
		}
		if (td->o.verify_offset)
			memswp(p, p + td->o.verify_offset, hdr_size(hdr));
		header_num++;
	}
}

int get_next_verify(struct thread_data *td, struct io_u *io_u)
{
	struct io_piece *ipo = NULL;

	/*
	 * this io_u is from a requeue, we already filled the offsets
	 */
	if (io_u->file)
		return 0;

	if (!RB_EMPTY_ROOT(&td->io_hist_tree)) {
		struct rb_node *n = rb_first(&td->io_hist_tree);

		ipo = rb_entry(n, struct io_piece, rb_node);
		rb_erase(n, &td->io_hist_tree);
	} else if (!list_empty(&td->io_hist_list)) {
		ipo = list_entry(td->io_hist_list.next, struct io_piece, list);
		list_del(&ipo->list);
	}

	if (ipo) {
		io_u->offset = ipo->offset;
		io_u->buflen = ipo->len;
		io_u->file = ipo->file;

		if ((io_u->file->flags & FIO_FILE_OPEN) == 0) {
			int r = td_io_open_file(td, io_u->file);

			if (r)
				return 1;
		}

		get_file(ipo->file);
		assert(io_u->file->flags & FIO_FILE_OPEN);
		io_u->ddir = DDIR_READ;
		io_u->xfer_buf = io_u->buf;
		io_u->xfer_buflen = io_u->buflen;
		free(ipo);
		return 0;
	}

	return 1;
}
Commit	Line	Data
e29d1b70 JA	1	/*
	2	* IO verification helpers
	3	*/
	4	#include <unistd.h>
	5	#include <fcntl.h>
	6	#include <string.h>
97af62ce	7	#include <assert.h>
e29d1b70 JA	8
e29d1b70 JA	9	#include "fio.h"
e29d1b70	10
eef6eea1 JA	11	#include "crc/md5.h"
	12	#include "crc/crc64.h"
	13	#include "crc/crc32.h"
	14	#include "crc/crc16.h"
	15	#include "crc/crc7.h"
	16	#include "crc/sha256.h"
	17	#include "crc/sha512.h"
cd14cc10	18
90059d65	19	static void fill_random_bytes(struct thread_data td, void p, unsigned int len)
e29d1b70 JA	20	{
e29d1b70 JA	21	unsigned int todo;
4c5946c6	22	int r;
e29d1b70 JA	23
e29d1b70 JA	24	while (len) {
4c5946c6	25	r = os_random_long(&td->verify_state);
e29d1b70 JA	26
	27	/*
	28	* lrand48_r seems to be broken and only fill the bottom
	29	* 32-bits, even on 64-bit archs with 64-bit longs
	30	*/
	31	todo = sizeof(r);
	32	if (todo > len)
	33	todo = len;
	34
	35	memcpy(p, &r, todo);
	36
	37	len -= todo;
	38	p += todo;
	39	}
	40	}
	41
90059d65 JA	42	static void fill_pattern(struct thread_data td, void p, unsigned int len)
	43	{
	44	switch (td->o.verify_pattern_bytes) {
	45	case 0:
	46	fill_random_bytes(td, p, len);
	47	break;
	48	case 1:
	49	memset(p, td->o.verify_pattern, len);
	50	break;
	51	case 2:
	52	case 3:
	53	case 4: {
	54	unsigned int pattern = td->o.verify_pattern;
	55	unsigned int i = 0;
	56	unsigned char c1, c2, c3, c4;
	57	unsigned char *b = p;
	58
	59	c1 = pattern & 0xff;
	60	pattern >>= 8;
	61	c2 = pattern & 0xff;
	62	pattern >>= 8;
	63	c3 = pattern & 0xff;
	64	pattern >>= 8;
	65	c4 = pattern & 0xff;
	66
	67	while (i < len) {
	68	b[i++] = c1;
	69	if (i == len)
	70	break;
	71	b[i++] = c2;
	72	if (td->o.verify_pattern_bytes == 2 \|\| i == len)
	73	continue;
	74	b[i++] = c3;
	75	if (td->o.verify_pattern_bytes == 3 \|\| i == len)
	76	continue;
	77	b[i++] = c4;
	78	}
	79	break;
	80	}
	81	}
	82	}
	83
4764aec9	84	static void memswp(void buf1, void buf2, unsigned int len)
546a9142	85	{
dee6de74 SL	86	char swap[200];
	87
	88	assert(len <= sizeof(swap));
90059d65	89
546a9142 SL	90	memcpy(&swap, buf1, len);
	91	memcpy(buf1, buf2, len);
	92	memcpy(buf2, &swap, len);
	93	}
	94
e29d1b70 JA	95	static void hexdump(void *buffer, int len)
	96	{
	97	unsigned char *p = buffer;
	98	int i;
	99
	100	for (i = 0; i < len; i++)
6d86144d JA	101	log_info("%02x", p[i]);
6d86144d JA	102	log_info("\n");
e29d1b70 JA	103	}
e29d1b70 JA	104
87677832 JA	105	/*
	106	* Prepare for seperation of verify_header and checksum header
	107	*/
546dfd9f	108	static inline unsigned int __hdr_size(int verify_type)
87677832	109	{
546dfd9f	110	unsigned int len;
87677832	111
546dfd9f JA	112	switch (verify_type) {
	113	case VERIFY_NONE:
	114	case VERIFY_NULL:
bfb41d98	115	case VERIFY_PATTERN:
546dfd9f JA	116	len = 0;
	117	break;
	118	case VERIFY_MD5:
	119	len = sizeof(struct vhdr_md5);
	120	break;
	121	case VERIFY_CRC64:
	122	len = sizeof(struct vhdr_crc64);
	123	break;
	124	case VERIFY_CRC32:
	125	len = sizeof(struct vhdr_crc32);
	126	break;
	127	case VERIFY_CRC16:
	128	len = sizeof(struct vhdr_crc16);
	129	break;
	130	case VERIFY_CRC7:
	131	len = sizeof(struct vhdr_crc7);
	132	break;
	133	case VERIFY_SHA256:
	134	len = sizeof(struct vhdr_sha256);
	135	break;
	136	case VERIFY_SHA512:
	137	len = sizeof(struct vhdr_sha512);
	138	break;
7437ee87 SL	139	case VERIFY_META:
	140	len = sizeof(struct vhdr_meta);
	141	break;
546dfd9f JA	142	default:
	143	log_err("fio: unknown verify header!\n");
	144	assert(0);
	145	}
	146
	147	return len + sizeof(struct verify_header);
87677832 JA	148	}
	149
	150	static inline unsigned int hdr_size(struct verify_header *hdr)
	151	{
546dfd9f JA	152	return __hdr_size(hdr->verify_type);
	153	}
	154
	155	static void hdr_priv(struct verify_header hdr)
	156	{
	157	void *priv = hdr;
	158
	159	return priv + sizeof(struct verify_header);
87677832 JA	160	}
87677832 JA	161
d9f2caf3 JA	162	/*
	163	* Return data area 'header_num'
	164	*/
	165	static inline void io_u_verify_off(struct verify_header hdr,
	166	struct io_u *io_u,
	167	unsigned char header_num)
	168	{
87677832	169	return io_u->buf + header_num * hdr->len + hdr_size(hdr);
d9f2caf3 JA	170	}
d9f2caf3 JA	171
7437ee87 SL	172	static int verify_io_u_meta(struct verify_header hdr, struct thread_data td,
	173	struct io_u *io_u, unsigned int header_num)
	174	{
	175	struct vhdr_meta *vh = hdr_priv(hdr);
	176
	177	if (vh->offset != io_u->offset + header_num * td->o.verify_interval) {
	178	log_err("meta: verify failed at %llu/%u\n",
	179	io_u->offset + header_num * hdr->len,
	180	hdr->len);
d16d4e09	181	return EIO;
7437ee87 SL	182	}
	183
	184	return 0;
	185	}
	186
cd14cc10 JA	187	static int verify_io_u_sha512(struct verify_header hdr, struct io_u io_u,
	188	unsigned int header_num)
	189	{
	190	void *p = io_u_verify_off(hdr, io_u, header_num);
546dfd9f	191	struct vhdr_sha512 *vh = hdr_priv(hdr);
cd14cc10 JA	192	uint8_t sha512[128];
	193	struct sha512_ctx sha512_ctx = {
	194	.buf = sha512,
	195	};
	196
	197	sha512_init(&sha512_ctx);
87677832	198	sha512_update(&sha512_ctx, p, hdr->len - hdr_size(hdr));
cd14cc10	199
546dfd9f	200	if (memcmp(vh->sha512, sha512_ctx.buf, sizeof(sha512))) {
cd14cc10 JA	201	log_err("sha512: verify failed at %llu/%u\n",
	202	io_u->offset + header_num * hdr->len,
	203	hdr->len);
546dfd9f	204	hexdump(vh->sha512, sizeof(vh->sha512));
cd14cc10	205	hexdump(sha512_ctx.buf, sizeof(sha512));
d16d4e09	206	return EIO;
cd14cc10 JA	207	}
	208
	209	return 0;
	210	}
	211
	212	static int verify_io_u_sha256(struct verify_header hdr, struct io_u io_u,
	213	unsigned int header_num)
	214	{
	215	void *p = io_u_verify_off(hdr, io_u, header_num);
546dfd9f	216	struct vhdr_sha256 *vh = hdr_priv(hdr);
cd14cc10 JA	217	uint8_t sha256[128];
	218	struct sha256_ctx sha256_ctx = {
	219	.buf = sha256,
	220	};
	221
	222	sha256_init(&sha256_ctx);
87677832	223	sha256_update(&sha256_ctx, p, hdr->len - hdr_size(hdr));
cd14cc10	224
546dfd9f	225	if (memcmp(vh->sha256, sha256_ctx.buf, sizeof(sha256))) {
cd14cc10 JA	226	log_err("sha256: verify failed at %llu/%u\n",
	227	io_u->offset + header_num * hdr->len,
	228	hdr->len);
546dfd9f	229	hexdump(vh->sha256, sizeof(vh->sha256));
cd14cc10	230	hexdump(sha256_ctx.buf, sizeof(sha256));
d16d4e09	231	return EIO;
cd14cc10 JA	232	}
	233
	234	return 0;
	235	}
	236
3f9f4e26 SL	237	static int verify_io_u_crc7(struct verify_header hdr, struct io_u io_u,
3f9f4e26 SL	238	unsigned char header_num)
1e154bdb	239	{
d9f2caf3	240	void *p = io_u_verify_off(hdr, io_u, header_num);
546dfd9f	241	struct vhdr_crc7 *vh = hdr_priv(hdr);
1e154bdb JA	242	unsigned char c;
1e154bdb JA	243
87677832	244	c = crc7(p, hdr->len - hdr_size(hdr));
1e154bdb	245
546dfd9f	246	if (c != vh->crc7) {
3f9f4e26 SL	247	log_err("crc7: verify failed at %llu/%u\n",
	248	io_u->offset + header_num * hdr->len,
	249	hdr->len);
546dfd9f	250	log_err("crc7: wanted %x, got %x\n", vh->crc7, c);
d16d4e09	251	return EIO;
1e154bdb JA	252	}
	253
	254	return 0;
	255	}
	256
3f9f4e26 SL	257	static int verify_io_u_crc16(struct verify_header hdr, struct io_u io_u,
3f9f4e26 SL	258	unsigned int header_num)
969f7ed3	259	{
d9f2caf3	260	void *p = io_u_verify_off(hdr, io_u, header_num);
546dfd9f	261	struct vhdr_crc16 *vh = hdr_priv(hdr);
969f7ed3 JA	262	unsigned short c;
969f7ed3 JA	263
87677832	264	c = crc16(p, hdr->len - hdr_size(hdr));
969f7ed3	265
546dfd9f	266	if (c != vh->crc16) {
3f9f4e26 SL	267	log_err("crc16: verify failed at %llu/%u\n",
	268	io_u->offset + header_num * hdr->len,
	269	hdr->len);
546dfd9f	270	log_err("crc16: wanted %x, got %x\n", vh->crc16, c);
d16d4e09	271	return EIO;
969f7ed3 JA	272	}
	273
	274	return 0;
	275	}
	276
3f9f4e26 SL	277	static int verify_io_u_crc64(struct verify_header hdr, struct io_u io_u,
3f9f4e26 SL	278	unsigned int header_num)
d77a7af3	279	{
d9f2caf3	280	void *p = io_u_verify_off(hdr, io_u, header_num);
546dfd9f	281	struct vhdr_crc64 *vh = hdr_priv(hdr);
d77a7af3 JA	282	unsigned long long c;
d77a7af3 JA	283
87677832	284	c = crc64(p, hdr->len - hdr_size(hdr));
d77a7af3	285
546dfd9f	286	if (c != vh->crc64) {
3f9f4e26 SL	287	log_err("crc64: verify failed at %llu/%u\n",
	288	io_u->offset + header_num * hdr->len,
	289	hdr->len);
546dfd9f	290	log_err("crc64: wanted %llx, got %llx\n", (unsigned long long) vh->crc64, c);
d16d4e09	291	return EIO;
d77a7af3 JA	292	}
	293
	294	return 0;
	295	}
	296
3f9f4e26 SL	297	static int verify_io_u_crc32(struct verify_header hdr, struct io_u io_u,
3f9f4e26 SL	298	unsigned int header_num)
e29d1b70	299	{
d9f2caf3	300	void *p = io_u_verify_off(hdr, io_u, header_num);
546dfd9f JA	301	struct vhdr_crc32 *vh = hdr_priv(hdr);
546dfd9f JA	302	uint32_t c;
e29d1b70	303
87677832	304	c = crc32(p, hdr->len - hdr_size(hdr));
e29d1b70	305
546dfd9f	306	if (c != vh->crc32) {
3f9f4e26 SL	307	log_err("crc32: verify failed at %llu/%u\n",
	308	io_u->offset + header_num * hdr->len,
	309	hdr->len);
546dfd9f	310	log_err("crc32: wanted %x, got %x\n", vh->crc32, c);
d16d4e09	311	return EIO;
e29d1b70 JA	312	}
	313
	314	return 0;
	315	}
	316
3f9f4e26 SL	317	static int verify_io_u_md5(struct verify_header hdr, struct io_u io_u,
3f9f4e26 SL	318	unsigned int header_num)
e29d1b70	319	{
d9f2caf3	320	void *p = io_u_verify_off(hdr, io_u, header_num);
546dfd9f	321	struct vhdr_md5 *vh = hdr_priv(hdr);
8c432325 JA	322	uint32_t hash[MD5_HASH_WORDS];
	323	struct md5_ctx md5_ctx = {
	324	.hash = hash,
	325	};
e29d1b70	326
61f821f1	327	md5_init(&md5_ctx);
87677832	328	md5_update(&md5_ctx, p, hdr->len - hdr_size(hdr));
e29d1b70	329
546dfd9f	330	if (memcmp(vh->md5_digest, md5_ctx.hash, sizeof(hash))) {
3f9f4e26 SL	331	log_err("md5: verify failed at %llu/%u\n",
	332	io_u->offset + header_num * hdr->len,
	333	hdr->len);
546dfd9f	334	hexdump(vh->md5_digest, sizeof(vh->md5_digest));
8c432325	335	hexdump(md5_ctx.hash, sizeof(hash));
d16d4e09	336	return EIO;
e29d1b70 JA	337	}
	338
	339	return 0;
	340	}
	341
3f199b01 JA	342	static unsigned int hweight8(unsigned int w)
	343	{
	344	unsigned int res = w - ((w >> 1) & 0x55);
	345
	346	res = (res & 0x33) + ((res >> 2) & 0x33);
	347	return (res + (res >> 4)) & 0x0F;
	348	}
	349
a944e335	350	int verify_io_u_pattern(unsigned long pattern, unsigned long pattern_size,
4764aec9	351	char *buf, unsigned int len, unsigned int mod)
a944e335 SL	352	{
	353	unsigned int i;
	354	char split_pattern[4];
	355
	356	for (i = 0; i < 4; i++) {
	357	split_pattern[i] = pattern & 0xff;
	358	pattern >>= 8;
	359	}
	360
	361	for (i = 0; i < len; i++) {
3f199b01 JA	362	if (buf[i] != split_pattern[mod]) {
	363	unsigned int bits;
	364
	365	bits = hweight8(buf[i] ^ split_pattern[mod]);
	366	log_err("fio: got pattern %x, wanted %x. Bad bits %d\n",
	367	buf[i], split_pattern[mod], bits);
	368	log_err("fio: bad pattern block offset %u\n", i);
d16d4e09	369	return EIO;
3f199b01	370	}
a944e335 SL	371	mod++;
	372	if (mod == pattern_size)
	373	mod = 0;
	374	}
	375
	376	return 0;
	377	}
	378
36690c9b	379	int verify_io_u(struct thread_data td, struct io_u io_u)
e29d1b70	380	{
3f9f4e26	381	struct verify_header *hdr;
a944e335	382	unsigned int hdr_size, hdr_inc, hdr_num = 0;
95646108	383	void *p;
e29d1b70 JA	384	int ret;
e29d1b70 JA	385
1dcc0498	386	if (td->o.verify == VERIFY_NULL \|\| io_u->ddir != DDIR_READ)
36690c9b JA	387	return 0;
36690c9b JA	388
3f9f4e26	389	hdr_inc = io_u->buflen;
a59e170d JA	390	if (td->o.verify_interval)
a59e170d JA	391	hdr_inc = td->o.verify_interval;
e29d1b70	392
a12a3b4d	393	ret = 0;
3f199b01	394	for (p = io_u->buf; p < io_u->buf + io_u->buflen; p += hdr_inc, hdr_num++) {
a12a3b4d JA	395	if (ret && td->o.verify_fatal) {
	396	td->terminate = 1;
	397	break;
	398	}
a944e335	399	hdr_size = __hdr_size(td->o.verify);
a59e170d	400	if (td->o.verify_offset)
a944e335	401	memswp(p, p + td->o.verify_offset, hdr_size);
95646108	402	hdr = p;
e29d1b70	403
3f199b01 JA	404	if (hdr->fio_magic != FIO_HDR_MAGIC) {
	405	log_err("Bad verify header %x\n", hdr->fio_magic);
	406	return EIO;
	407	}
	408
3f9f4e26 SL	409	switch (hdr->verify_type) {
	410	case VERIFY_MD5:
	411	ret = verify_io_u_md5(hdr, io_u, hdr_num);
	412	break;
	413	case VERIFY_CRC64:
	414	ret = verify_io_u_crc64(hdr, io_u, hdr_num);
	415	break;
	416	case VERIFY_CRC32:
	417	ret = verify_io_u_crc32(hdr, io_u, hdr_num);
	418	break;
	419	case VERIFY_CRC16:
	420	ret = verify_io_u_crc16(hdr, io_u, hdr_num);
	421	break;
	422	case VERIFY_CRC7:
	423	ret = verify_io_u_crc7(hdr, io_u, hdr_num);
	424	break;
cd14cc10 JA	425	case VERIFY_SHA256:
	426	ret = verify_io_u_sha256(hdr, io_u, hdr_num);
	427	break;
	428	case VERIFY_SHA512:
	429	ret = verify_io_u_sha512(hdr, io_u, hdr_num);
	430	break;
7437ee87 SL	431	case VERIFY_META:
	432	ret = verify_io_u_meta(hdr, td, io_u, hdr_num);
	433	break;
bfb41d98 JA	434	case VERIFY_PATTERN:
	435	ret = verify_io_u_pattern(td->o.verify_pattern,
	436	td->o.verify_pattern_bytes,
	437	p + hdr_size,
	438	hdr_inc - hdr_size,
	439	hdr_size % 4);
	440	if (ret)
	441	log_err("fio: verify failed at %llu/%u\n",
	442	io_u->offset + hdr_num * hdr->len,
	443	hdr->len);
	444	break;
3f9f4e26 SL	445	default:
3f9f4e26 SL	446	log_err("Bad verify type %u\n", hdr->verify_type);
d16d4e09	447	ret = EINVAL;
3f9f4e26	448	}
3f9f4e26	449	}
a7dfe862	450
a12a3b4d	451	return ret;
e29d1b70 JA	452	}
e29d1b70 JA	453
7437ee87 SL	454	static void fill_meta(struct verify_header hdr, struct thread_data td,
	455	struct io_u *io_u, unsigned int header_num)
	456	{
	457	struct vhdr_meta *vh = hdr_priv(hdr);
	458
	459	vh->thread = td->thread_number;
	460
	461	vh->time_sec = io_u->start_time.tv_sec;
	462	vh->time_usec = io_u->start_time.tv_usec;
	463
	464	vh->numberio = td->io_issues[DDIR_WRITE];
	465
	466	vh->offset = io_u->offset + header_num * td->o.verify_interval;
	467	}
	468
cd14cc10 JA	469	static void fill_sha512(struct verify_header hdr, void p, unsigned int len)
cd14cc10 JA	470	{
546dfd9f	471	struct vhdr_sha512 *vh = hdr_priv(hdr);
cd14cc10	472	struct sha512_ctx sha512_ctx = {
546dfd9f	473	.buf = vh->sha512,
cd14cc10 JA	474	};
	475
	476	sha512_init(&sha512_ctx);
	477	sha512_update(&sha512_ctx, p, len);
	478	}
	479
	480	static void fill_sha256(struct verify_header hdr, void p, unsigned int len)
	481	{
546dfd9f	482	struct vhdr_sha256 *vh = hdr_priv(hdr);
cd14cc10	483	struct sha256_ctx sha256_ctx = {
546dfd9f	484	.buf = vh->sha256,
cd14cc10 JA	485	};
	486
	487	sha256_init(&sha256_ctx);
	488	sha256_update(&sha256_ctx, p, len);
	489	}
	490
1e154bdb JA	491	static void fill_crc7(struct verify_header hdr, void p, unsigned int len)
1e154bdb JA	492	{
546dfd9f JA	493	struct vhdr_crc7 *vh = hdr_priv(hdr);
	494
	495	vh->crc7 = crc7(p, len);
1e154bdb JA	496	}
1e154bdb JA	497
969f7ed3 JA	498	static void fill_crc16(struct verify_header hdr, void p, unsigned int len)
969f7ed3 JA	499	{
546dfd9f JA	500	struct vhdr_crc16 *vh = hdr_priv(hdr);
	501
	502	vh->crc16 = crc16(p, len);
969f7ed3 JA	503	}
969f7ed3 JA	504
e29d1b70 JA	505	static void fill_crc32(struct verify_header hdr, void p, unsigned int len)
e29d1b70 JA	506	{
546dfd9f JA	507	struct vhdr_crc32 *vh = hdr_priv(hdr);
	508
	509	vh->crc32 = crc32(p, len);
e29d1b70 JA	510	}
e29d1b70 JA	511
d77a7af3 JA	512	static void fill_crc64(struct verify_header hdr, void p, unsigned int len)
d77a7af3 JA	513	{
546dfd9f JA	514	struct vhdr_crc64 *vh = hdr_priv(hdr);
	515
	516	vh->crc64 = crc64(p, len);
d77a7af3 JA	517	}
d77a7af3 JA	518
e29d1b70 JA	519	static void fill_md5(struct verify_header hdr, void p, unsigned int len)
e29d1b70 JA	520	{
546dfd9f	521	struct vhdr_md5 *vh = hdr_priv(hdr);
8c432325	522	struct md5_ctx md5_ctx = {
546dfd9f	523	.hash = (uint32_t *) vh->md5_digest,
8c432325	524	};
e29d1b70	525
61f821f1	526	md5_init(&md5_ctx);
e29d1b70	527	md5_update(&md5_ctx, p, len);
e29d1b70 JA	528	}
	529
	530	/*
	531	* fill body of io_u->buf with random data and add a header with the
	532	* crc32 or md5 sum of that data.
	533	*/
	534	void populate_verify_io_u(struct thread_data td, struct io_u io_u)
	535	{
baefa9be	536	struct verify_header *hdr;
95646108	537	void p = io_u->buf, data;
7437ee87	538	unsigned int hdr_inc, data_len, header_num = 0;
e29d1b70	539
9cc3d150 JA	540	if (td->o.verify == VERIFY_NULL)
	541	return;
	542
90059d65	543	fill_pattern(td, p, io_u->buflen);
546a9142 SL	544
546a9142 SL	545	hdr_inc = io_u->buflen;
a59e170d JA	546	if (td->o.verify_interval)
a59e170d JA	547	hdr_inc = td->o.verify_interval;
baefa9be	548
95646108 JA	549	for (;p < io_u->buf + io_u->buflen; p += hdr_inc) {
95646108 JA	550	hdr = p;
3f9f4e26 SL	551
	552	hdr->fio_magic = FIO_HDR_MAGIC;
	553	hdr->verify_type = td->o.verify;
546a9142	554	hdr->len = hdr_inc;
87677832	555	data_len = hdr_inc - hdr_size(hdr);
3f9f4e26	556
87677832	557	data = p + hdr_size(hdr);
3f9f4e26 SL	558	switch (td->o.verify) {
	559	case VERIFY_MD5:
	560	fill_md5(hdr, data, data_len);
	561	break;
	562	case VERIFY_CRC64:
	563	fill_crc64(hdr, data, data_len);
	564	break;
	565	case VERIFY_CRC32:
	566	fill_crc32(hdr, data, data_len);
	567	break;
	568	case VERIFY_CRC16:
	569	fill_crc16(hdr, data, data_len);
	570	break;
	571	case VERIFY_CRC7:
	572	fill_crc7(hdr, data, data_len);
	573	break;
cd14cc10 JA	574	case VERIFY_SHA256:
	575	fill_sha256(hdr, data, data_len);
	576	break;
	577	case VERIFY_SHA512:
	578	fill_sha512(hdr, data, data_len);
	579	break;
7437ee87 SL	580	case VERIFY_META:
	581	fill_meta(hdr, td, io_u, header_num);
	582	break;
bfb41d98 JA	583	case VERIFY_PATTERN:
bfb41d98 JA	584	break;
3f9f4e26 SL	585	default:
	586	log_err("fio: bad verify type: %d\n", td->o.verify);
	587	assert(0);
	588	}
a59e170d	589	if (td->o.verify_offset)
87677832	590	memswp(p, p + td->o.verify_offset, hdr_size(hdr));
7437ee87	591	header_num++;
e29d1b70	592	}
e29d1b70 JA	593	}
	594
	595	int get_next_verify(struct thread_data td, struct io_u io_u)
	596	{
8de8f047	597	struct io_piece *ipo = NULL;
e29d1b70	598
d2d7fa53 JA	599	/*
	600	* this io_u is from a requeue, we already filled the offsets
	601	*/
	602	if (io_u->file)
	603	return 0;
	604
8de8f047 JA	605	if (!RB_EMPTY_ROOT(&td->io_hist_tree)) {
8de8f047 JA	606	struct rb_node *n = rb_first(&td->io_hist_tree);
e29d1b70	607
8de8f047	608	ipo = rb_entry(n, struct io_piece, rb_node);
4b87898e	609	rb_erase(n, &td->io_hist_tree);
8de8f047 JA	610	} else if (!list_empty(&td->io_hist_list)) {
	611	ipo = list_entry(td->io_hist_list.next, struct io_piece, list);
	612	list_del(&ipo->list);
	613	}
e29d1b70	614
8de8f047	615	if (ipo) {
e29d1b70 JA	616	io_u->offset = ipo->offset;
e29d1b70 JA	617	io_u->buflen = ipo->len;
36167d82	618	io_u->file = ipo->file;
97af62ce JA	619
	620	if ((io_u->file->flags & FIO_FILE_OPEN) == 0) {
	621	int r = td_io_open_file(td, io_u->file);
	622
	623	if (r)
	624	return 1;
	625	}
	626
	627	get_file(ipo->file);
	628	assert(io_u->file->flags & FIO_FILE_OPEN);
e29d1b70	629	io_u->ddir = DDIR_READ;
36167d82 JA	630	io_u->xfer_buf = io_u->buf;
36167d82 JA	631	io_u->xfer_buflen = io_u->buflen;
e29d1b70 JA	632	free(ipo);
	633	return 0;
	634	}
	635
	636	return 1;
	637	}