1*83d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
22e192b24SSimon Glass /*
32e192b24SSimon Glass * Copyright (C) 2014 Marek Vasut <marex@denx.de>
42e192b24SSimon Glass *
52e192b24SSimon Glass * Command for en/de-crypting block of memory with AES-128-CBC cipher.
62e192b24SSimon Glass */
72e192b24SSimon Glass
82e192b24SSimon Glass #include <common.h>
92e192b24SSimon Glass #include <command.h>
102e192b24SSimon Glass #include <environment.h>
11b80c0b99SStefano Babic #include <uboot_aes.h>
122e192b24SSimon Glass #include <malloc.h>
132e192b24SSimon Glass #include <asm/byteorder.h>
142e192b24SSimon Glass #include <linux/compiler.h>
152e192b24SSimon Glass
162e192b24SSimon Glass /**
172e192b24SSimon Glass * do_aes() - Handle the "aes" command-line command
182e192b24SSimon Glass * @cmdtp: Command data struct pointer
192e192b24SSimon Glass * @flag: Command flag
202e192b24SSimon Glass * @argc: Command-line argument count
212e192b24SSimon Glass * @argv: Array of command-line arguments
222e192b24SSimon Glass *
232e192b24SSimon Glass * Returns zero on success, CMD_RET_USAGE in case of misuse and negative
242e192b24SSimon Glass * on error.
252e192b24SSimon Glass */
do_aes(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])262e192b24SSimon Glass static int do_aes(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
272e192b24SSimon Glass {
28af09eba6SАндрей Мозжухин uint32_t key_addr, iv_addr, src_addr, dst_addr, len;
29af09eba6SАндрей Мозжухин uint8_t *key_ptr, *iv_ptr, *src_ptr, *dst_ptr;
302e192b24SSimon Glass uint8_t key_exp[AES_EXPAND_KEY_LENGTH];
312e192b24SSimon Glass uint32_t aes_blocks;
322e192b24SSimon Glass int enc;
332e192b24SSimon Glass
34af09eba6SАндрей Мозжухин if (argc != 7)
352e192b24SSimon Glass return CMD_RET_USAGE;
362e192b24SSimon Glass
372e192b24SSimon Glass if (!strncmp(argv[1], "enc", 3))
382e192b24SSimon Glass enc = 1;
392e192b24SSimon Glass else if (!strncmp(argv[1], "dec", 3))
402e192b24SSimon Glass enc = 0;
412e192b24SSimon Glass else
422e192b24SSimon Glass return CMD_RET_USAGE;
432e192b24SSimon Glass
442e192b24SSimon Glass key_addr = simple_strtoul(argv[2], NULL, 16);
45af09eba6SАндрей Мозжухин iv_addr = simple_strtoul(argv[3], NULL, 16);
46af09eba6SАндрей Мозжухин src_addr = simple_strtoul(argv[4], NULL, 16);
47af09eba6SАндрей Мозжухин dst_addr = simple_strtoul(argv[5], NULL, 16);
48af09eba6SАндрей Мозжухин len = simple_strtoul(argv[6], NULL, 16);
492e192b24SSimon Glass
502e192b24SSimon Glass key_ptr = (uint8_t *)key_addr;
51af09eba6SАндрей Мозжухин iv_ptr = (uint8_t *)iv_addr;
522e192b24SSimon Glass src_ptr = (uint8_t *)src_addr;
532e192b24SSimon Glass dst_ptr = (uint8_t *)dst_addr;
542e192b24SSimon Glass
552e192b24SSimon Glass /* First we expand the key. */
562e192b24SSimon Glass aes_expand_key(key_ptr, key_exp);
572e192b24SSimon Glass
582e192b24SSimon Glass /* Calculate the number of AES blocks to encrypt. */
592e192b24SSimon Glass aes_blocks = DIV_ROUND_UP(len, AES_KEY_LENGTH);
602e192b24SSimon Glass
612e192b24SSimon Glass if (enc)
62af09eba6SАндрей Мозжухин aes_cbc_encrypt_blocks(key_exp, iv_ptr, src_ptr, dst_ptr,
63af09eba6SАндрей Мозжухин aes_blocks);
642e192b24SSimon Glass else
65af09eba6SАндрей Мозжухин aes_cbc_decrypt_blocks(key_exp, iv_ptr, src_ptr, dst_ptr,
66af09eba6SАндрей Мозжухин aes_blocks);
672e192b24SSimon Glass
682e192b24SSimon Glass return 0;
692e192b24SSimon Glass }
702e192b24SSimon Glass
712e192b24SSimon Glass /***************************************************/
722e192b24SSimon Glass #ifdef CONFIG_SYS_LONGHELP
732e192b24SSimon Glass static char aes_help_text[] =
74af09eba6SАндрей Мозжухин "enc key iv src dst len - Encrypt block of data $len bytes long\n"
752e192b24SSimon Glass " at address $src using a key at address\n"
76af09eba6SАндрей Мозжухин " $key with initialization vector at address\n"
77af09eba6SАндрей Мозжухин " $iv. Store the result at address $dst.\n"
78af09eba6SАндрей Мозжухин " The $len size must be multiple of 16 bytes.\n"
79af09eba6SАндрей Мозжухин " The $key and $iv must be 16 bytes long.\n"
80af09eba6SАндрей Мозжухин "aes dec key iv src dst len - Decrypt block of data $len bytes long\n"
812e192b24SSimon Glass " at address $src using a key at address\n"
82af09eba6SАндрей Мозжухин " $key with initialization vector at address\n"
83af09eba6SАндрей Мозжухин " $iv. Store the result at address $dst.\n"
84af09eba6SАндрей Мозжухин " The $len size must be multiple of 16 bytes.\n"
85af09eba6SАндрей Мозжухин " The $key and $iv must be 16 bytes long.";
862e192b24SSimon Glass #endif
872e192b24SSimon Glass
882e192b24SSimon Glass U_BOOT_CMD(
89af09eba6SАндрей Мозжухин aes, 7, 1, do_aes,
902e192b24SSimon Glass "AES 128 CBC encryption",
912e192b24SSimon Glass aes_help_text
922e192b24SSimon Glass );
93