8f34c2760d
project:cfg:BoardConfig_IPC: Added fastboot BoardConfig file and firmware post-scripts, distinguishing between the BoardConfigs for Luckfox Pico Pro and Luckfox Pico Max. project:app: Added fastboot_client and rk_smart_door for quick boot applications; updated rkipc app to adapt to the latest media library. media:samples: Added more usage examples. media:rockit: Fixed bugs; removed support for retrieving data frames from VPSS. media:isp: Updated rkaiq library and related tools to support connection to RKISP_Tuner. sysdrv:Makefile: Added support for compiling drv_ko on Luckfox Pico Ultra W using Ubuntu; added support for custom root filesystem. sysdrv:tools:board: Updated Buildroot optional mirror sources, updated some software versions, and stored device tree files and configuration files that undergo multiple modifications for U-Boot and kernel separately. sysdrv:source:mcu: Used RISC-V MCU SDK with RT-Thread system, mainly for initializing camera AE during quick boot. sysdrv:source:uboot: Added support for fastboot; added high baud rate DDR bin for serial firmware upgrades. sysdrv:source:kernel: Upgraded to version 5.10.160; increased NPU frequency for RV1106G3; added support for fastboot. Signed-off-by: luckfox-eng29 <eng29@luckfox.com>
76 lines
1.5 KiB
C
76 lines
1.5 KiB
C
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include "sm4_core.h"
|
|
|
|
struct ctr_state {
|
|
unsigned char ivec[SM4_BLOCK_SIZE];
|
|
unsigned char ecount[SM4_BLOCK_SIZE];
|
|
unsigned int num;
|
|
};
|
|
|
|
static void rk_init_ctr(struct ctr_state * state, const unsigned char *iv)
|
|
{
|
|
state->num = 0;
|
|
memset(state->ecount, 0, SM4_BLOCK_SIZE);
|
|
memcpy(state->ivec, iv, SM4_BLOCK_SIZE);
|
|
}
|
|
|
|
/* increment counter (128-bit int) by 1 */
|
|
static void rk_ctr128_inc(unsigned char *counter) {
|
|
unsigned int n=SM4_BLOCK_SIZE;
|
|
unsigned char c;
|
|
|
|
do {
|
|
--n;
|
|
c = counter[n];
|
|
++c;
|
|
counter[n] = c;
|
|
if (c) return;
|
|
} while (n);
|
|
}
|
|
|
|
static void rk_crypto_ctr128_encrypt(void *ctx, const unsigned char *in, unsigned char *out,
|
|
unsigned int len, unsigned char *ivec, unsigned char *ecount_buf,
|
|
unsigned int *num, block128_f block)
|
|
{
|
|
unsigned int n, l=0;
|
|
|
|
n = *num;
|
|
while (l<len) {
|
|
if (n==0) {
|
|
(*block)(ivec, ecount_buf, ctx);
|
|
rk_ctr128_inc(ivec);
|
|
}
|
|
out[l] = in[l] ^ ecount_buf[n];
|
|
++l;
|
|
n = (n+1) % SM4_BLOCK_SIZE;
|
|
}
|
|
|
|
*num = n;
|
|
}
|
|
|
|
int rk_sm4_ctr_encrypt(const unsigned char *in, unsigned char *out,
|
|
unsigned int length, const unsigned char *key, const int key_len,
|
|
unsigned char *ivec, const int enc)
|
|
{
|
|
sm4_context ctx;
|
|
struct ctr_state state;
|
|
|
|
if(key_len != 16)
|
|
return -1;
|
|
|
|
if(length == 0)
|
|
return -1;
|
|
|
|
rk_init_ctr(&state, ivec);
|
|
rk_sm4_setkey_enc(&ctx, key);
|
|
rk_crypto_ctr128_encrypt((void*)(&ctx),in, out, length,
|
|
state.ivec, state.ecount,
|
|
&state.num, rk_rk_sm4_crypt_ecb);
|
|
|
|
return 0;
|
|
}
|
|
|
|
|