void Encrypt(uint8_t *block, uint8_t *keyBytes)
{
uint32_t *v = (uint32_t *)block;
uint32_t *k = (uint32_t *)keyBytes;
uint8_t i;
/* Whitening */
v[0] ^= READ_ROUND_KEY_DOUBLE_WORD(k[0]);
v[1] ^= READ_ROUND_KEY_DOUBLE_WORD(k[1]);
v[2] ^= READ_ROUND_KEY_DOUBLE_WORD(k[2]);
v[3] ^= READ_ROUND_KEY_DOUBLE_WORD(k[3]);
/* Chaskey permutation */
for (i = 0; i < NUMBER_OF_ROUNDS; ++i)
{
v[0] += v[1]; v[1]=rot32l5(v[1]); v[1] ^= v[0]; v[0]=rot32l16(v[0]);
v[2] += v[3]; v[3]=rot32l8(v[3]); v[3] ^= v[2];
v[0] += v[3]; v[3]=rot32l13(v[3]); v[3] ^= v[0];
v[2] += v[1]; v[1]=rot32l7(v[1]); v[1] ^= v[2]; v[2]=rot32l16(v[2]);
}
/* Whitening */
v[0] ^= READ_ROUND_KEY_DOUBLE_WORD(k[0]);
v[1] ^= READ_ROUND_KEY_DOUBLE_WORD(k[1]);
v[2] ^= READ_ROUND_KEY_DOUBLE_WORD(k[2]);
v[3] ^= READ_ROUND_KEY_DOUBLE_WORD(k[3]);
}
void QuarterRound(uint32_t *state, uint8_t a, uint8_t b, uint8_t c, uint8_t d)
{
state[a] += state[b];
state[d] ^= state[a];
state[d] = rot32l16(state[d]);
state[c] += state[d];
state[b] ^= state[c];
state[b] = rot32l12(state[b]);
state[a] += state[b];
state[d] ^= state[a];
state[d] = rot32l8(state[d]);
state[c] += state[d];
state[b] ^= state[c];
state[b] = rot32l7(state[b]);
}
