100 lines
2.3 KiB
C
100 lines
2.3 KiB
C
/* Utility functions for manipulating block_t structures; 128bit
|
|
blocks of data for AES & CMAC */
|
|
|
|
#include "block.h"
|
|
|
|
#include <stdbool.h>
|
|
#include <stdint.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
|
|
#ifdef HOST_BUILD
|
|
void block_print(char const *const label, uint8_t const *const b) {
|
|
if (label != NULL) {
|
|
printf("%s: ", label);
|
|
} else {
|
|
printf("\n");
|
|
}
|
|
for (int i = 0; i < 16; i++) {
|
|
printf("%.2x", b[i]);
|
|
if (!((i + 1) % 4)) {
|
|
printf(" ");
|
|
}
|
|
}
|
|
printf("\n");
|
|
return;
|
|
}
|
|
|
|
void block_print_bytes(char const *const label, uint8_t const *const b,
|
|
uint32_t num_bytes) {
|
|
printf("%s: ", label);
|
|
for (int i = 0; i < num_bytes; i++) {
|
|
printf("%.2x", b[i]);
|
|
if (!((i + 1) % 4)) {
|
|
printf(" ");
|
|
}
|
|
}
|
|
printf("\n");
|
|
}
|
|
#endif /* HOST_BUILD */
|
|
|
|
void block_xor(uint8_t *dest, uint8_t *const a, uint8_t *const b) {
|
|
for (uint_fast8_t i = 0; i < 4; i++) {
|
|
*((uint32_t *)dest + i) = *((uint32_t *)a + i) ^ *((uint32_t *)b + i);
|
|
}
|
|
return;
|
|
}
|
|
|
|
void block_shiftr(uint8_t *dest, uint8_t *const a, uint_fast8_t num) {
|
|
uint_fast8_t n = (num <= 8 ? num : 8);
|
|
for (int_fast8_t i = 15; i >= 0; i--) {
|
|
/* Shift right from LSB to MSB */
|
|
dest[i] = a[i] >> n;
|
|
if (i != 0) {
|
|
dest[i] |= (a[i - 1] << (8 - n));
|
|
}
|
|
}
|
|
if (num - n != 0) {
|
|
block_shiftr(dest, dest, num - n);
|
|
}
|
|
return;
|
|
}
|
|
|
|
void block_shiftl(uint8_t *dest, uint8_t *const a, uint_fast8_t num) {
|
|
uint_fast8_t n = (num <= 8 ? num : 8);
|
|
for (int_fast8_t i = 0; i < 16; i++) {
|
|
dest[i] = a[i] << n;
|
|
if (i != 15) {
|
|
dest[i] |= (a[i + 1] >> (8 - n));
|
|
}
|
|
}
|
|
if (num - n != 0) {
|
|
block_shiftl(dest, dest, num - n);
|
|
}
|
|
return;
|
|
}
|
|
|
|
void block_incr(uint8_t *in) {
|
|
for (int_fast8_t i = 15; i > 0; i--) {
|
|
uint8_t prev = in[i];
|
|
in[i] += 1;
|
|
if (in[i] > prev) {
|
|
/* No overflow, changes propagate no further */
|
|
break;
|
|
}
|
|
}
|
|
return;
|
|
}
|
|
|
|
void block_decr(uint8_t *in) {
|
|
for (int_fast8_t i = 15; i > 0; i--) {
|
|
uint8_t prev = in[i];
|
|
in[i] -= 1;
|
|
if (in[i] < prev) {
|
|
/* No overflow, changes propagate no further */
|
|
break;
|
|
}
|
|
}
|
|
return;
|
|
}
|