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     4304022 : #define fd_gcm_init  fd_gcm_init_4bit
       9     4001692 : #define fd_gcm_gmult fd_gcm_gmult_4bit
      10    13191578 : #define fd_gcm_ghash fd_gcm_ghash_4bit
      11             : 
      12             : static void
      13             : fd_aes_gcm_setiv( fd_aes_gcm_ref_t * gcm,
      14     4304022 :                   uchar const        iv[ 12 ] ) {
      15             : 
      16     4304022 :   uint ctr;
      17     4304022 :   gcm->len.u[ 0 ] = 0;  /* AAD length */
      18     4304022 :   gcm->len.u[ 1 ] = 0;  /* Message length */
      19     4304022 :   gcm->ares = 0;
      20     4304022 :   gcm->mres = 0;
      21             : 
      22     4304022 :   memcpy( gcm->Yi.c, iv, 12 );
      23     4304022 :   gcm->Yi.c[12] = 0;
      24     4304022 :   gcm->Yi.c[13] = 0;
      25     4304022 :   gcm->Yi.c[14] = 0;
      26     4304022 :   gcm->Yi.c[15] = 1;
      27     4304022 :   ctr = 1;
      28             : 
      29     4304022 :   gcm->Xi.u[0] = 0;
      30     4304022 :   gcm->Xi.u[1] = 0;
      31             : 
      32     4304022 :   fd_aes_encrypt( gcm->Yi.c, gcm->EK0.c, &gcm->key );
      33     4304022 :   ctr++;
      34             : 
      35     4304022 :   gcm->Yi.d[3] = fd_uint_bswap( ctr );
      36     4304022 : }
      37             : 
      38             : void
      39             : fd_aes_128_gcm_init_ref( fd_aes_gcm_ref_t * gcm,
      40             :                          uchar const        key[ 16 ],
      41     4304022 :                          uchar const        iv[ 12 ] ) {
      42             : 
      43             :   /* TODO: Check key size */
      44             : 
      45     4304022 :   memset( gcm, 0, sizeof(fd_aes_gcm_t) );
      46             : 
      47     4304022 :   fd_aes_key_ref_t * ks = &gcm->key;
      48     4304022 :   fd_aes_set_encrypt_key( key, 128, ks );
      49             : 
      50     4304022 :   fd_aes_encrypt( gcm->H.c, gcm->H.c, ks );
      51     4304022 :   gcm->H.u[ 0 ] = fd_ulong_bswap( gcm->H.u[ 0 ] );
      52     4304022 :   gcm->H.u[ 1 ] = fd_ulong_bswap( gcm->H.u[ 1 ] );
      53             : 
      54     4304022 :   fd_gcm_init( gcm->Htable, gcm->H.u );
      55     4304022 :   fd_aes_gcm_setiv( gcm, iv );
      56     4304022 : }
      57             : 
      58             : static int
      59             : fd_gcm128_aad( fd_aes_gcm_ref_t * aes_gcm,
      60             :                uchar const *      aad,
      61     4304022 :                ulong              aad_sz ) {
      62             : 
      63     4304022 :   ulong alen = aes_gcm->len.u[ 0 ];
      64             : 
      65     4304022 :   if( FD_UNLIKELY( aes_gcm->len.u[ 1 ] ) )
      66           0 :     return -2;
      67             : 
      68     4304022 :   alen += aad_sz;
      69     4304022 :   if (alen > (1UL<<61) || (sizeof(aad_sz) == 8 && alen < aad_sz))
      70           0 :     return -1;
      71     4304022 :   aes_gcm->len.u[0] = alen;
      72             : 
      73     4304022 :   uint n = aes_gcm->ares;
      74     4304022 :   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     4304022 :   ulong i;
      88     4304022 :   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     4304022 :   if (aad_sz) {
      94     4304022 :     n = (unsigned int)aad_sz;
      95    42916390 :     for (i = 0; i < aad_sz; ++i)
      96    38612368 :       aes_gcm->Xi.c[i] ^= aad[i];
      97     4304022 :   }
      98             : 
      99     4304022 :   aes_gcm->ares = n;
     100     4304022 :   return 0;
     101     4304022 : }
     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     2152263 :                    ulong              len ) {
     110             : 
     111     2152263 :   uint n, ctr, mres;
     112     2152263 :   ulong i;
     113     2152263 :   ulong mlen = ctx->len.u[1];
     114     2152263 :   void *key = &ctx->key;
     115             : 
     116     2152263 :   mlen += len;
     117     2152263 :   if (mlen > ((1UL<<36) - 32) || (sizeof(len) == 8 && mlen < len))
     118           0 :     return -1;
     119     2152263 :   ctx->len.u[1] = mlen;
     120             : 
     121     2152263 :   mres = ctx->mres;
     122             : 
     123     2152263 :   if (ctx->ares) {
     124             :     /* First call to encrypt finalizes GHASH(AAD) */
     125     2152263 :     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      152170 :     memcpy(ctx->Xn, ctx->Xi.c, sizeof(ctx->Xi));
     131      152170 :     ctx->Xi.u[0] = 0;
     132      152170 :     ctx->Xi.u[1] = 0;
     133      152170 :     mres = sizeof(ctx->Xi);
     134      152170 :     ctx->ares = 0;
     135      152170 :   }
     136             : 
     137      152170 :   ctr = fd_uint_bswap( ctx->Yi.d[3] );
     138             : 
     139      152170 :   n = mres % 16;
     140   113413705 :   for (i = 0; i < len; ++i) {
     141   113261535 :     if (n == 0) {
     142     7168382 :       fd_aes_encrypt( ctx->Yi.c, ctx->EKi.c, key );
     143     7168382 :       ++ctr;
     144     7168382 :       ctx->Yi.d[3] = fd_uint_bswap( ctr );
     145     7168382 :     }
     146   113261535 :     ctx->Xn[mres++] = out[i] = in[i] ^ ctx->EKi.c[n];
     147   113261535 :     n = (n + 1) % 16;
     148   113261535 :     if (mres == sizeof(ctx->Xn)) {
     149     2303595 :       fd_gcm_ghash( ctx->Xi.u, ctx->Htable, ctx->Xn, sizeof(ctx->Xn) );
     150     2303595 :       mres = 0;
     151     2303595 :     }
     152   113261535 :   }
     153             : 
     154      152170 :   ctx->mres = mres;
     155      152170 :   return 0;
     156     2152263 : }
     157             : 
     158             : static int
     159             : fd_gcm128_decrypt( fd_aes_gcm_ref_t * ctx,
     160             :                    uchar const *      in,
     161             :                    uchar *            out,
     162     2151759 :                    ulong              len ) {
     163             : 
     164     2151759 :   uint n, ctr, mres;
     165     2151759 :   ulong i;
     166     2151759 :   ulong mlen = ctx->len.u[1];
     167     2151759 :   void * key = &ctx->key;
     168             : 
     169     2151759 :   mlen += len;
     170     2151759 :   if (mlen > ((1UL<<36) - 32) || (sizeof(len) == 8 && mlen < len))
     171           0 :     return -1;
     172     2151759 :   ctx->len.u[1] = mlen;
     173             : 
     174     2151759 :   mres = ctx->mres;
     175             : 
     176     2151759 :   if (ctx->ares) {
     177             :     /* First call to decrypt finalizes GHASH(AAD) */
     178     2151759 :     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      150160 :     memcpy(ctx->Xn, ctx->Xi.c, sizeof(ctx->Xi));
     184      150160 :     ctx->Xi.u[0] = 0;
     185      150160 :     ctx->Xi.u[1] = 0;
     186      150160 :     mres = sizeof(ctx->Xi);
     187      150160 :     ctx->ares = 0;
     188      150160 :   }
     189             : 
     190      150160 :   ctr = fd_uint_bswap( ctx->Yi.d[3] );
     191             : 
     192      150160 :   n = mres % 16;
     193   113778148 :   for (i = 0; i < len; ++i) {
     194   113627988 :     uchar c;
     195   113627988 :     if (n == 0) {
     196     7186377 :       fd_aes_encrypt( ctx->Yi.c, ctx->EKi.c, key );
     197     7186377 :       ++ctr;
     198     7186377 :       ctx->Yi.d[3] = fd_uint_bswap( ctr );
     199     7186377 :     }
     200   113627988 :     out[i] = (ctx->Xn[mres++] = c = in[i]) ^ ctx->EKi.c[n];
     201   113627988 :     n = (n + 1) % 16;
     202   113627988 :     if (mres == sizeof(ctx->Xn)) {
     203     2313597 :       fd_gcm_ghash( ctx->Xi.u, ctx->Htable, ctx->Xn, sizeof(ctx->Xn) );
     204     2313597 :       mres = 0;
     205     2313597 :     }
     206   113627988 :   }
     207             : 
     208      150160 :   ctx->mres = mres;
     209      150160 :   return 0;
     210     2151759 : }
     211             : 
     212             : static void
     213     4304022 : fd_gcm128_finish( fd_aes_gcm_ref_t * ctx ) {
     214             : 
     215     4304022 :   ulong alen = ctx->len.u[0] << 3;  // 176
     216     4304022 :   ulong clen = ctx->len.u[1] << 3;  // 9296
     217             : 
     218     4304022 :   struct {
     219     4304022 :     ulong hi;
     220     4304022 :     ulong lo;
     221     4304022 :   } bitlen;
     222     4304022 :   uint mres = ctx->mres;
     223             : 
     224     4304022 :   if( mres ) {
     225      302120 :     uint blocks = (mres + 15u) & 0xfffffff0u; // 16
     226             : 
     227      302120 :     memset(ctx->Xn + mres, 0, blocks - mres);
     228      302120 :     mres = blocks;
     229      302120 :     if (mres == sizeof(ctx->Xn)) {
     230      228329 :       fd_gcm_ghash( ctx->Xi.u, ctx->Htable, ctx->Xn, mres );
     231      228329 :       mres = 0;
     232      228329 :     }
     233     4001902 :   } else if( ctx->ares ) {
     234           0 :     fd_gcm_gmult( ctx->Xi.u, ctx->Htable );
     235           0 :   }
     236             : 
     237     4304022 :   alen = fd_ulong_bswap( alen );
     238     4304022 :   clen = fd_ulong_bswap( clen );
     239             : 
     240     4304022 :   bitlen.hi = alen;
     241     4304022 :   bitlen.lo = clen;
     242     4304022 :   memcpy( ctx->Xn + mres, &bitlen, sizeof(bitlen) );
     243     4304022 :   mres += (uint)sizeof(bitlen);
     244     4304022 :   fd_gcm_ghash( ctx->Xi.u, ctx->Htable, ctx->Xn, mres );
     245             : 
     246     4304022 :   ctx->Xi.u[0] ^= ctx->EK0.u[0];
     247     4304022 :   ctx->Xi.u[1] ^= ctx->EK0.u[1];
     248     4304022 : }
     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     2152263 :                         uchar              tag[ 16 ] ) {
     258             : 
     259     2152263 :   fd_gcm128_aad( aes_gcm, aad, aad_sz );
     260             : 
     261     2152263 :   ulong bulk = 0UL;
     262     2152263 :   assert( 0==fd_gcm128_encrypt( aes_gcm, p+bulk, c+bulk, sz-bulk ) );
     263             : 
     264             :   /* CRYPTO_gcm128_tag */
     265     2152263 :   fd_gcm128_finish( aes_gcm );
     266     2152263 :   fd_memcpy( tag, aes_gcm->Xi.c, 16 );
     267     2152263 : }
     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     2151759 :                         uchar const        tag[ 16 ] ) {
     277             : 
     278     2151759 :   fd_gcm128_aad( aes_gcm, aad, aad_sz );
     279             : 
     280     2151759 :   ulong bulk = 0UL;
     281     2151759 :   assert( 0==fd_gcm128_decrypt( aes_gcm, c+bulk, p+bulk, sz-bulk ) );
     282             : 
     283             :   /* CRYPTO_gcm128_finish */
     284     2151759 :   fd_gcm128_finish( aes_gcm );
     285     2151759 :   return 0==memcmp( aes_gcm->Xi.c, tag, 16 );  /* TODO USE CONSTANT TIME COMPARE */
     286     2151759 : }