Line data    Source code

       1             : /* fd_aes_ref.c was imported from the OpenSSL project circa 2023-Aug.
       2             :    Original source files:  crypto/evp/e_aes.c crypto/modes/gcm128.c */
       3             : 
       4             : #include "fd_aes_gcm.h"
       5             : 
       6             : #include <assert.h>
       7             : 
       8     4284528 : #define fd_gcm_init  fd_gcm_init_4bit
       9     4001692 : #define fd_gcm_gmult fd_gcm_gmult_4bit
      10    12749728 : #define fd_gcm_ghash fd_gcm_ghash_4bit
      11             : 
      12             : static void
      13             : fd_aes_gcm_setiv( fd_aes_gcm_ref_t * gcm,
      14     4284528 :                   uchar const        iv[ 12 ] ) {
      15             : 
      16     4284528 :   uint ctr;
      17     4284528 :   gcm->len.u[ 0 ] = 0;  /* AAD length */
      18     4284528 :   gcm->len.u[ 1 ] = 0;  /* Message length */
      19     4284528 :   gcm->ares = 0;
      20     4284528 :   gcm->mres = 0;
      21             : 
      22     4284528 :   memcpy( gcm->Yi.c, iv, 12 );
      23     4284528 :   gcm->Yi.c[12] = 0;
      24     4284528 :   gcm->Yi.c[13] = 0;
      25     4284528 :   gcm->Yi.c[14] = 0;
      26     4284528 :   gcm->Yi.c[15] = 1;
      27     4284528 :   ctr = 1;
      28             : 
      29     4284528 :   gcm->Xi.u[0] = 0;
      30     4284528 :   gcm->Xi.u[1] = 0;
      31             : 
      32     4284528 :   fd_aes_encrypt( gcm->Yi.c, gcm->EK0.c, &gcm->key );
      33     4284528 :   ctr++;
      34             : 
      35     4284528 :   gcm->Yi.d[3] = fd_uint_bswap( ctr );
      36     4284528 : }
      37             : 
      38             : void
      39             : fd_aes_128_gcm_init_ref( fd_aes_gcm_ref_t * gcm,
      40             :                          uchar const        key[ 16 ],
      41     4284528 :                          uchar const        iv[ 12 ] ) {
      42             : 
      43             :   /* TODO: Check key size */
      44             : 
      45     4284528 :   memset( gcm, 0, sizeof(fd_aes_gcm_t) );
      46             : 
      47     4284528 :   fd_aes_key_ref_t * ks = &gcm->key;
      48     4284528 :   fd_aes_set_encrypt_key( key, 128, ks );
      49             : 
      50     4284528 :   fd_aes_encrypt( gcm->H.c, gcm->H.c, ks );
      51     4284528 :   gcm->H.u[ 0 ] = fd_ulong_bswap( gcm->H.u[ 0 ] );
      52     4284528 :   gcm->H.u[ 1 ] = fd_ulong_bswap( gcm->H.u[ 1 ] );
      53             : 
      54     4284528 :   fd_gcm_init( gcm->Htable, gcm->H.u );
      55     4284528 :   fd_aes_gcm_setiv( gcm, iv );
      56     4284528 : }
      57             : 
      58             : static int
      59             : fd_gcm128_aad( fd_aes_gcm_ref_t * aes_gcm,
      60             :                uchar const *      aad,
      61     4284528 :                ulong              aad_sz ) {
      62             : 
      63     4284528 :   ulong alen = aes_gcm->len.u[ 0 ];
      64             : 
      65     4284528 :   if( FD_UNLIKELY( aes_gcm->len.u[ 1 ] ) )
      66           0 :     return -2;
      67             : 
      68     4284528 :   alen += aad_sz;
      69     4284528 :   if (alen > (1UL<<61) || (sizeof(aad_sz) == 8 && alen < aad_sz))
      70           0 :     return -1;
      71     4284528 :   aes_gcm->len.u[0] = alen;
      72             : 
      73     4284528 :   uint n = aes_gcm->ares;
      74     4284528 :   if (n) {
      75           0 :     while (n && aad_sz) {
      76           0 :       aes_gcm->Xi.c[n] ^= *(aad++);
      77           0 :       --aad_sz;
      78           0 :       n = (n + 1) % 16;
      79           0 :     }
      80           0 :     if (n == 0)
      81           0 :       fd_gcm_gmult( aes_gcm->Xi.u, aes_gcm->Htable );
      82           0 :     else {
      83           0 :       aes_gcm->ares = n;
      84           0 :       return 0;
      85           0 :     }
      86           0 :   }
      87     4284528 :   ulong i;
      88     4284528 :   if ((i = (aad_sz & (ulong)-16))) {
      89     4042035 :     fd_gcm_ghash( aes_gcm->Xi.u, aes_gcm->Htable, aad, i );
      90     4042035 :     aad += i;
      91     4042035 :     aad_sz -= i;
      92     4042035 :   }
      93     4284528 :   if (aad_sz) {
      94     4284528 :     n = (unsigned int)aad_sz;
      95    42643474 :     for (i = 0; i < aad_sz; ++i)
      96    38358946 :       aes_gcm->Xi.c[i] ^= aad[i];
      97     4284528 :   }
      98             : 
      99     4284528 :   aes_gcm->ares = n;
     100     4284528 :   return 0;
     101     4284528 : }
     102             : 
     103             : /* TODO separate reference code and GCM128 */
     104             : 
     105             : static int
     106             : fd_gcm128_encrypt( fd_aes_gcm_ref_t * ctx,
     107             :                    uchar const *      in,
     108             :                    uchar *            out,
     109     2142516 :                    ulong              len ) {
     110             : 
     111     2142516 :   uint n, ctr, mres;
     112     2142516 :   ulong i;
     113     2142516 :   ulong mlen = ctx->len.u[1];
     114     2142516 :   void *key = &ctx->key;
     115             : 
     116     2142516 :   mlen += len;
     117     2142516 :   if (mlen > ((1UL<<36) - 32) || (sizeof(len) == 8 && mlen < len))
     118           0 :     return -1;
     119     2142516 :   ctx->len.u[1] = mlen;
     120             : 
     121     2142516 :   mres = ctx->mres;
     122             : 
     123     2142516 :   if (ctx->ares) {
     124             :     /* First call to encrypt finalizes GHASH(AAD) */
     125     2142516 :     if (len == 0) {
     126     2000093 :       fd_gcm_gmult( ctx->Xi.u, ctx->Htable );
     127     2000093 :       ctx->ares = 0;
     128     2000093 :       return 0;
     129     2000093 :     }
     130      142423 :     memcpy(ctx->Xn, ctx->Xi.c, sizeof(ctx->Xi));
     131      142423 :     ctx->Xi.u[0] = 0;
     132      142423 :     ctx->Xi.u[1] = 0;
     133      142423 :     mres = sizeof(ctx->Xi);
     134      142423 :     ctx->ares = 0;
     135      142423 :   }
     136             : 
     137      142423 :   ctr = fd_uint_bswap( ctx->Yi.d[3] );
     138             : 
     139      142423 :   n = mres % 16;
     140   103505614 :   for (i = 0; i < len; ++i) {
     141   103363191 :     if (n == 0) {
     142     6544299 :       fd_aes_encrypt( ctx->Yi.c, ctx->EKi.c, key );
     143     6544299 :       ++ctr;
     144     6544299 :       ctx->Yi.d[3] = fd_uint_bswap( ctr );
     145     6544299 :     }
     146   103363191 :     ctx->Xn[mres++] = out[i] = in[i] ^ ctx->EKi.c[n];
     147   103363191 :     n = (n + 1) % 16;
     148   103363191 :     if (mres == sizeof(ctx->Xn)) {
     149     2102016 :       fd_gcm_ghash( ctx->Xi.u, ctx->Htable, ctx->Xn, sizeof(ctx->Xn) );
     150     2102016 :       mres = 0;
     151     2102016 :     }
     152   103363191 :   }
     153             : 
     154      142423 :   ctx->mres = mres;
     155      142423 :   return 0;
     156     2142516 : }
     157             : 
     158             : static int
     159             : fd_gcm128_decrypt( fd_aes_gcm_ref_t * ctx,
     160             :                    uchar const *      in,
     161             :                    uchar *            out,
     162     2142012 :                    ulong              len ) {
     163             : 
     164     2142012 :   uint n, ctr, mres;
     165     2142012 :   ulong i;
     166     2142012 :   ulong mlen = ctx->len.u[1];
     167     2142012 :   void * key = &ctx->key;
     168             : 
     169     2142012 :   mlen += len;
     170     2142012 :   if (mlen > ((1UL<<36) - 32) || (sizeof(len) == 8 && mlen < len))
     171           0 :     return -1;
     172     2142012 :   ctx->len.u[1] = mlen;
     173             : 
     174     2142012 :   mres = ctx->mres;
     175             : 
     176     2142012 :   if (ctx->ares) {
     177             :     /* First call to decrypt finalizes GHASH(AAD) */
     178     2142012 :     if (len == 0) {
     179     2001599 :       fd_gcm_gmult( ctx->Xi.u, ctx->Htable );
     180     2001599 :       ctx->ares = 0;
     181     2001599 :       return 0;
     182     2001599 :     }
     183      140413 :     memcpy(ctx->Xn, ctx->Xi.c, sizeof(ctx->Xi));
     184      140413 :     ctx->Xi.u[0] = 0;
     185      140413 :     ctx->Xi.u[1] = 0;
     186      140413 :     mres = sizeof(ctx->Xi);
     187      140413 :     ctx->ares = 0;
     188      140413 :   }
     189             : 
     190      140413 :   ctr = fd_uint_bswap( ctx->Yi.d[3] );
     191             : 
     192      140413 :   n = mres % 16;
     193   103870056 :   for (i = 0; i < len; ++i) {
     194   103729643 :     uchar c;
     195   103729643 :     if (n == 0) {
     196     6562294 :       fd_aes_encrypt( ctx->Yi.c, ctx->EKi.c, key );
     197     6562294 :       ++ctr;
     198     6562294 :       ctx->Yi.d[3] = fd_uint_bswap( ctr );
     199     6562294 :     }
     200   103729643 :     out[i] = (ctx->Xn[mres++] = c = in[i]) ^ ctx->EKi.c[n];
     201   103729643 :     n = (n + 1) % 16;
     202   103729643 :     if (mres == sizeof(ctx->Xn)) {
     203     2112018 :       fd_gcm_ghash( ctx->Xi.u, ctx->Htable, ctx->Xn, sizeof(ctx->Xn) );
     204     2112018 :       mres = 0;
     205     2112018 :     }
     206   103729643 :   }
     207             : 
     208      140413 :   ctx->mres = mres;
     209      140413 :   return 0;
     210     2142012 : }
     211             : 
     212             : static void
     213     4284528 : fd_gcm128_finish( fd_aes_gcm_ref_t * ctx ) {
     214             : 
     215     4284528 :   ulong alen = ctx->len.u[0] << 3;  // 176
     216     4284528 :   ulong clen = ctx->len.u[1] << 3;  // 9296
     217             : 
     218     4284528 :   struct {
     219     4284528 :     ulong hi;
     220     4284528 :     ulong lo;
     221     4284528 :   } bitlen;
     222     4284528 :   uint mres = ctx->mres;
     223             : 
     224     4284528 :   if( mres ) {
     225      282626 :     uint blocks = (mres + 15u) & 0xfffffff0u; // 16
     226             : 
     227      282626 :     memset(ctx->Xn + mres, 0, blocks - mres);
     228      282626 :     mres = blocks;
     229      282626 :     if (mres == sizeof(ctx->Xn)) {
     230      209131 :       fd_gcm_ghash( ctx->Xi.u, ctx->Htable, ctx->Xn, mres );
     231      209131 :       mres = 0;
     232      209131 :     }
     233     4001902 :   } else if( ctx->ares ) {
     234           0 :     fd_gcm_gmult( ctx->Xi.u, ctx->Htable );
     235           0 :   }
     236             : 
     237     4284528 :   alen = fd_ulong_bswap( alen );
     238     4284528 :   clen = fd_ulong_bswap( clen );
     239             : 
     240     4284528 :   bitlen.hi = alen;
     241     4284528 :   bitlen.lo = clen;
     242     4284528 :   memcpy( ctx->Xn + mres, &bitlen, sizeof(bitlen) );
     243     4284528 :   mres += (uint)sizeof(bitlen);
     244     4284528 :   fd_gcm_ghash( ctx->Xi.u, ctx->Htable, ctx->Xn, mres );
     245             : 
     246     4284528 :   ctx->Xi.u[0] ^= ctx->EK0.u[0];
     247     4284528 :   ctx->Xi.u[1] ^= ctx->EK0.u[1];
     248     4284528 : }
     249             : 
     250             : void
     251             : fd_aes_gcm_encrypt_ref( fd_aes_gcm_ref_t * aes_gcm,
     252             :                         uchar *            c,
     253             :                         uchar const *      p,
     254             :                         ulong              sz,
     255             :                         uchar const *      aad,
     256             :                         ulong              aad_sz,
     257     2142516 :                         uchar              tag[ 16 ] ) {
     258             : 
     259     2142516 :   fd_gcm128_aad( aes_gcm, aad, aad_sz );
     260             : 
     261     2142516 :   ulong bulk = 0UL;
     262     2142516 :   assert( 0==fd_gcm128_encrypt( aes_gcm, p+bulk, c+bulk, sz-bulk ) );
     263             : 
     264             :   /* CRYPTO_gcm128_tag */
     265     2142516 :   fd_gcm128_finish( aes_gcm );
     266     2142516 :   fd_memcpy( tag, aes_gcm->Xi.c, 16 );
     267     2142516 : }
     268             : 
     269             : int
     270             : fd_aes_gcm_decrypt_ref( fd_aes_gcm_ref_t * aes_gcm,
     271             :                         uchar const *      c,
     272             :                         uchar *            p,
     273             :                         ulong              sz,
     274             :                         uchar const *      aad,
     275             :                         ulong              aad_sz,
     276     2142012 :                         uchar const        tag[ 16 ] ) {
     277             : 
     278     2142012 :   fd_gcm128_aad( aes_gcm, aad, aad_sz );
     279             : 
     280     2142012 :   ulong bulk = 0UL;
     281     2142012 :   assert( 0==fd_gcm128_decrypt( aes_gcm, c+bulk, p+bulk, sz-bulk ) );
     282             : 
     283             :   /* CRYPTO_gcm128_finish */
     284     2142012 :   fd_gcm128_finish( aes_gcm );
     285     2142012 :   return 0==memcmp( aes_gcm->Xi.c, tag, 16 );  /* TODO USE CONSTANT TIME COMPARE */
     286     2142012 : }