text: /**********************************************************************
    Copyright(c) 2011-2016 Intel Corporation All rights reserved.
  
    Redistribution and use in source and binary forms, with or without
    modification, are permitted provided that the following conditions
    are met:
      * Redistributions of source code must retain the above copyright
        notice, this list of conditions and the following disclaimer.
      * Redistributions in binary form must reproduce the above copyright
        notice, this list of conditions and the following disclaimer in
        the documentation and/or other materials provided with the
        distribution.
      * Neither the name of Intel Corporation nor the names of its
        contributors may be used to endorse or promote products derived
        from this software without specific prior written permission.
  
    THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
    "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
    LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
    A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
    OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
    SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
    LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
    DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
    THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
    (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
    OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  **********************************************************************/
  
  #if defined(__clang__)
  # pragma clang attribute push (__attribute__((target("avx2"))), apply_to=function)
  #elif defined(__ICC)
  # pragma intel optimization_parameter target_arch=AVX2
  #elif defined(__ICL)
  # pragma [intel] optimization_parameter target_arch=AVX2
  #elif (__GNUC__ >= 5)
  # pragma GCC target("avx2")
  #endif
  
  #include "md5_mb.h"
  #include "memcpy_inline.h"
  
  #ifdef _MSC_VER
  #include <intrin.h>
  #define inline __inline
  #endif
  
  static inline void hash_init_digest(MD5_WORD_T * digest);
  static inline uint32_t hash_pad(uint8_t padblock[MD5_BLOCK_SIZE * 2], uint64_t total_len);
  static MD5_HASH_CTX *md5_ctx_mgr_resubmit(MD5_HASH_CTX_MGR * mgr, MD5_HASH_CTX * ctx);
  
  void md5_ctx_mgr_init_avx2(MD5_HASH_CTX_MGR * mgr)
  {
  	md5_mb_mgr_init_avx2(&mgr->mgr);
  }
  
  MD5_HASH_CTX *md5_ctx_mgr_submit_avx2(MD5_HASH_CTX_MGR * mgr, MD5_HASH_CTX * ctx,
  				      const void *buffer, uint32_t len, HASH_CTX_FLAG flags)
  {
  	if (flags & (~HASH_ENTIRE)) {
  		// User should not pass anything other than FIRST, UPDATE, or LAST
  		ctx->error = HASH_CTX_ERROR_INVALID_FLAGS;
  		return ctx;
  	}
  
  	if (ctx->status & HASH_CTX_STS_PROCESSING) {
  		// Cannot submit to a currently processing job.
  		ctx->error = HASH_CTX_ERROR_ALREADY_PROCESSING;
  		return ctx;
  	}
  
  	if ((ctx->status & HASH_CTX_STS_COMPLETE) && !(flags & HASH_FIRST)) {
  		// Cannot update a finished job.
  		ctx->error = HASH_CTX_ERROR_ALREADY_COMPLETED;
  		return ctx;
  	}
  
  	if (flags & HASH_FIRST) {
  		// Init digest
  		hash_init_digest(ctx->job.result_digest);
  
  		// Reset byte counter
  		ctx->total_length = 0;
  
  		// Clear extra blocks
  		ctx->partial_block_buffer_length = 0;
  	}
  	// If we made it here, there were no errors during this call to submit
  	ctx->error = HASH_CTX_ERROR_NONE;
  
  	// Store buffer ptr info from user
  	ctx->incoming_buffer = buffer;
  	ctx->incoming_buffer_length = len;
  
  	// Store the user's request flags and mark this ctx as currently being processed.
  	ctx->status = (flags & HASH_LAST) ?
  	    (HASH_CTX_STS) (HASH_CTX_STS_PROCESSING | HASH_CTX_STS_LAST) :
  	    HASH_CTX_STS_PROCESSING;
  
  	// Advance byte counter
  	ctx->total_length += len;
  
  	// If there is anything currently buffered in the extra blocks, append to it until it contains a whole block.
  	// Or if the user's buffer contains less than a whole block, append as much as possible to the extra block.
  	if ((ctx->partial_block_buffer_length) | (len < MD5_BLOCK_SIZE)) {
  		// Compute how many bytes to copy from user buffer into extra block
  		uint32_t copy_len = MD5_BLOCK_SIZE - ctx->partial_block_buffer_length;
  		if (len < copy_len)
  			copy_len = len;
  
  		if (copy_len) {
  			// Copy and update relevant pointers and counters
  			memcpy_varlen(&ctx->partial_block_buffer
  				      [ctx->partial_block_buffer_length], buffer, copy_len);
  
  			ctx->partial_block_buffer_length += copy_len;
  			ctx->incoming_buffer = (const void *)((const char *)buffer + copy_len);
  			ctx->incoming_buffer_length = len - copy_len;
  		}
  		// The extra block should never contain more than 1 block here
  		assert(ctx->partial_block_buffer_length <= MD5_BLOCK_SIZE);
  
  		// If the extra block buffer contains exactly 1 block, it can be hashed.
  		if (ctx->partial_block_buffer_length >= MD5_BLOCK_SIZE) {
  			ctx->partial_block_buffer_length = 0;
  
  			ctx->job.buffer = ctx->partial_block_buffer;
  			ctx->job.len = 1;
  			ctx = (MD5_HASH_CTX *) md5_mb_mgr_submit_avx2(&mgr->mgr, &ctx->job);
  		}
  	}
  
  	return md5_ctx_mgr_resubmit(mgr, ctx);
  }
  
  MD5_HASH_CTX *md5_ctx_mgr_flush_avx2(MD5_HASH_CTX_MGR * mgr)
  {
  	MD5_HASH_CTX *ctx;
  
  	while (1) {
  		ctx = (MD5_HASH_CTX *) md5_mb_mgr_flush_avx2(&mgr->mgr);
  
  		// If flush returned 0, there are no more jobs in flight.
  		if (!ctx)
  			return NULL;
  
  		// If flush returned a job, verify that it is safe to return to the user.
  		// If it is not ready, resubmit the job to finish processing.
  		ctx = md5_ctx_mgr_resubmit(mgr, ctx);
  
  		// If md5_ctx_mgr_resubmit returned a job, it is ready to be returned.
  		if (ctx)
  			return ctx;
  
  		// Otherwise, all jobs currently being managed by the HASH_CTX_MGR still need processing. Loop.
  	}
  }
  
  static MD5_HASH_CTX *md5_ctx_mgr_resubmit(MD5_HASH_CTX_MGR * mgr, MD5_HASH_CTX * ctx)
  {
  	while (ctx) {
  
  		if (ctx->status & HASH_CTX_STS_COMPLETE) {
  			ctx->status = HASH_CTX_STS_COMPLETE;	// Clear PROCESSING bit
  			return ctx;
  		}
  		// If the extra blocks are empty, begin hashing what remains in the user's buffer.
  		if (ctx->partial_block_buffer_length == 0 && ctx->incoming_buffer_length) {
  			const void *buffer = ctx->incoming_buffer;
  			uint32_t len = ctx->incoming_buffer_length;
  
  			// Only entire blocks can be hashed. Copy remainder to extra blocks buffer.
  			uint32_t copy_len = len & (MD5_BLOCK_SIZE - 1);
  
  			if (copy_len) {
  				len -= copy_len;
  				//memcpy(ctx->partial_block_buffer, ((const char*)buffer + len), copy_len);
  				memcpy_varlen(ctx->partial_block_buffer,
  					      ((const char *)buffer + len), copy_len);
  				ctx->partial_block_buffer_length = copy_len;
  			}
  
  			ctx->incoming_buffer_length = 0;
  
  			// len should be a multiple of the block size now
  			assert((len % MD5_BLOCK_SIZE) == 0);
  
  			// Set len to the number of blocks to be hashed in the user's buffer
  			len >>= MD5_LOG2_BLOCK_SIZE;
  
  			if (len) {
  				ctx->job.buffer = (uint8_t *) buffer;
  				ctx->job.len = len;
  				ctx = (MD5_HASH_CTX *) md5_mb_mgr_submit_avx2(&mgr->mgr,
  									      &ctx->job);
  				continue;
  			}
  		}
  		// If the extra blocks are not empty, then we are either on the last block(s)
  		// or we need more user input before continuing.
  		if (ctx->status & HASH_CTX_STS_LAST) {
  
  			uint8_t *buf = ctx->partial_block_buffer;
  			uint32_t n_extra_blocks = hash_pad(buf, ctx->total_length);
  
  			ctx->status =
  			    (HASH_CTX_STS) (HASH_CTX_STS_PROCESSING | HASH_CTX_STS_COMPLETE);
  
  			ctx->job.buffer = buf;
  			ctx->job.len = (uint32_t) n_extra_blocks;
  			ctx = (MD5_HASH_CTX *) md5_mb_mgr_submit_avx2(&mgr->mgr, &ctx->job);
  			continue;
  		}
  
  		if (ctx)
  			ctx->status = HASH_CTX_STS_IDLE;
  		return ctx;
  	}
  
  	return NULL;
  }
  
  static inline void hash_init_digest(MD5_WORD_T * digest)
  {
  	static const MD5_WORD_T hash_initial_digest[MD5_DIGEST_NWORDS] =
  	    { MD5_INITIAL_DIGEST };
  	//memcpy(digest, hash_initial_digest, sizeof(hash_initial_digest));
  	memcpy_fixedlen(digest, hash_initial_digest, sizeof(hash_initial_digest));
  }
  
  static inline uint32_t hash_pad(uint8_t padblock[MD5_BLOCK_SIZE * 2], uint64_t total_len)
  {
  	uint32_t i = (uint32_t) (total_len & (MD5_BLOCK_SIZE - 1));
  
  	// memset(&padblock[i], 0, MD5_BLOCK_SIZE);
  	memclr_fixedlen(&padblock[i], MD5_BLOCK_SIZE);
  	padblock[i] = 0x80;
  
  	i += ((MD5_BLOCK_SIZE - 1) & (0 - (total_len + MD5_PADLENGTHFIELD_SIZE + 1))) + 1 +
  	    MD5_PADLENGTHFIELD_SIZE;
  
  	*((uint64_t *) & padblock[i - 8]) = ((uint64_t) total_len << 3);
  
  	return i >> MD5_LOG2_BLOCK_SIZE;	// Number of extra blocks to hash
  }
  
  struct slver {
  	uint16_t snum;
  	uint8_t ver;
  	uint8_t core;
  };
  struct slver md5_ctx_mgr_init_avx2_slver_04020186;
  struct slver md5_ctx_mgr_init_avx2_slver = { 0x0186, 0x02, 0x04 };
  
  struct slver md5_ctx_mgr_submit_avx2_slver_04020187;
  struct slver md5_ctx_mgr_submit_avx2_slver = { 0x0187, 0x02, 0x04 };
  
  struct slver md5_ctx_mgr_flush_avx2_slver_04020188;
  struct slver md5_ctx_mgr_flush_avx2_slver = { 0x0188, 0x02, 0x04 };
  
  #if defined(__clang__)
  # pragma clang attribute pop
  #endif
  