#include "rar.hpp"
 #include "sha256.hpp"
 
 static const uint32 K[64] = 
 {
   0x428a2f98, 0x71374491, 0xb5c0fbcf, 0xe9b5dba5,
   0x3956c25b, 0x59f111f1, 0x923f82a4, 0xab1c5ed5,
   0xd807aa98, 0x12835b01, 0x243185be, 0x550c7dc3,
   0x72be5d74, 0x80deb1fe, 0x9bdc06a7, 0xc19bf174,
   0xe49b69c1, 0xefbe4786, 0x0fc19dc6, 0x240ca1cc,
   0x2de92c6f, 0x4a7484aa, 0x5cb0a9dc, 0x76f988da,
   0x983e5152, 0xa831c66d, 0xb00327c8, 0xbf597fc7,
   0xc6e00bf3, 0xd5a79147, 0x06ca6351, 0x14292967,
   0x27b70a85, 0x2e1b2138, 0x4d2c6dfc, 0x53380d13,
   0x650a7354, 0x766a0abb, 0x81c2c92e, 0x92722c85,
   0xa2bfe8a1, 0xa81a664b, 0xc24b8b70, 0xc76c51a3,
   0xd192e819, 0xd6990624, 0xf40e3585, 0x106aa070,
   0x19a4c116, 0x1e376c08, 0x2748774c, 0x34b0bcb5,
   0x391c0cb3, 0x4ed8aa4a, 0x5b9cca4f, 0x682e6ff3,
   0x748f82ee, 0x78a5636f, 0x84c87814, 0x8cc70208,
   0x90befffa, 0xa4506ceb, 0xbef9a3f7, 0xc67178f2
 };
 
 // SHA-256 functions. We could optimize Ch and Maj a little,
 // but with no visible speed benefit.
 #define Ch(x, y, z)  ((x & y) ^ (~x & z))
 #define Maj(x, y, z) ((x & y) ^ (x & z) ^ (y & z))
 
 // Sigma functions.
 #define Sg0(x) (rotr32(x, 2) ^ rotr32(x,13) ^ rotr32(x, 22))
 #define Sg1(x) (rotr32(x, 6) ^ rotr32(x,11) ^ rotr32(x, 25))
 #define sg0(x) (rotr32(x, 7) ^ rotr32(x,18) ^ (x >> 3))
 #define sg1(x) (rotr32(x,17) ^ rotr32(x,19) ^ (x >> 10))
 
 void sha256_init(sha256_context *ctx)
 {
   ctx->H[0] = 0x6a09e667; // Set the initial hash value.
   ctx->H[1] = 0xbb67ae85;
   ctx->H[2] = 0x3c6ef372;
   ctx->H[3] = 0xa54ff53a;
   ctx->H[4] = 0x510e527f;
   ctx->H[5] = 0x9b05688c;
   ctx->H[6] = 0x1f83d9ab;
   ctx->H[7] = 0x5be0cd19;
   ctx->Count    = 0;      // Processed data counter.
 }
 
 
 static void sha256_transform(sha256_context *ctx)
 {
   uint32 W[64]; // Words of message schedule.
   uint32 v[8];  // FIPS a, b, c, d, e, f, g, h working variables.
 
   // Prepare message schedule.
   for (uint I = 0; I < 16; I++)
     W[I] = RawGetBE4(ctx->Buffer + I * 4);
   for (uint I = 16; I < 64; I++)
     W[I] = sg1(W[I-2]) + W[I-7] + sg0(W[I-15]) + W[I-16];
 
   uint32 *H=ctx->H;
   v[0]=H[0]; v[1]=H[1]; v[2]=H[2]; v[3]=H[3];
   v[4]=H[4]; v[5]=H[5]; v[6]=H[6]; v[7]=H[7];
 
   for (uint I = 0; I < 64; I++)
   {
     uint T1 = v[7] + Sg1(v[4]) + Ch(v[4], v[5], v[6]) + K[I] + W[I];
 
     // It is possible to eliminate variable copying if we unroll loop
     // and rename variables every time. But my test did not show any speed
     // gain on i7 for such full or partial unrolling.
     v[7] = v[6];
     v[6] = v[5];
     v[5] = v[4];
     v[4] = v[3] + T1;
 
     // It works a little faster when moved here from beginning of loop.
     uint T2 = Sg0(v[0]) + Maj(v[0], v[1], v[2]);
 
     v[3] = v[2];
     v[2] = v[1];
     v[1] = v[0];
     v[0] = T1 + T2;
   }
 
   H[0]+=v[0]; H[1]+=v[1]; H[2]+=v[2]; H[3]+=v[3];
   H[4]+=v[4]; H[5]+=v[5]; H[6]+=v[6]; H[7]+=v[7];
 }
 
 
 void sha256_process(sha256_context *ctx, const void *Data, size_t Size)
 {
   const byte *Src=(const byte *)Data;
   size_t BufPos = (uint)ctx->Count & 0x3f;
   ctx->Count+=Size;
   while (Size > 0)
   {
     size_t BufSpace=sizeof(ctx->Buffer)-BufPos;
     size_t CopySize=Size>BufSpace ? BufSpace:Size;
 
     memcpy(ctx->Buffer+BufPos,Src,CopySize);
 
     Src+=CopySize;
     BufPos+=CopySize;
     Size-=CopySize;
     if (BufPos == 64)
     {
       BufPos = 0;
       sha256_transform(ctx);
     }
   }
 }
 
 
 void sha256_done(sha256_context *ctx, byte *Digest)
 {
   uint64 BitLength = ctx->Count * 8;
   uint BufPos = (uint)ctx->Count & 0x3f;
   ctx->Buffer[BufPos++] = 0x80; // Padding the message with "1" bit.
 
   if (BufPos!=56) // We need 56 bytes block followed by 8 byte length.
   {
     if (BufPos>56)
     {
       while (BufPos<64)
         ctx->Buffer[BufPos++] = 0;
       BufPos=0;
     }
     if (BufPos==0)
       sha256_transform(ctx);
     memset(ctx->Buffer+BufPos,0,56-BufPos);
   }
 
   RawPutBE4((uint32)(BitLength>>32), ctx->Buffer + 56);
   RawPutBE4((uint32)(BitLength), ctx->Buffer + 60);
 
   sha256_transform(ctx);
 
   RawPutBE4(ctx->H[0], Digest +  0);
   RawPutBE4(ctx->H[1], Digest +  4);
   RawPutBE4(ctx->H[2], Digest +  8);
   RawPutBE4(ctx->H[3], Digest + 12);
   RawPutBE4(ctx->H[4], Digest + 16);
   RawPutBE4(ctx->H[5], Digest + 20);
   RawPutBE4(ctx->H[6], Digest + 24);
   RawPutBE4(ctx->H[7], Digest + 28);
 
   sha256_init(ctx);
 }