dearsky/pico-hsm
1
0
Fork 0
Code Issues 17 Pull Requests 4 Actions Packages Projects Releases 26 Wiki Activity

Add support for OTP raw read/write.

Browse Source 
Signed-off-by: Pol Henarejos <pol.henarejos@cttc.es>
This commit is contained in:
Pol Henarejos
2024-10-28 00:15:48 +01:00
parent d1ee43baab
commit 9fa3758dad
2 changed files with 21 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
pico-keys-sdk

Submodule pico-keys-sdk updated: 6216cd24be...62c3d0c360

27
src/hsm/cmd_extras.c
View File

@@ -260,24 +260,37 @@ int cmd_extras() {
return SW_WRONG_LENGTH();
}
uint16_t row = (apdu.data[0] << 8) | apdu.data[1];
bool israw = P2(apdu) == 0x1;
if (apdu.nc == 2) {
if (row > 0xbf) {
if (row > 0xbf && row < 0xf48) {
return SW_WRONG_DATA();
}
memcpy(res_APDU, otp_buffer(row), apdu.ne);
if (israw) {
memcpy(res_APDU, otp_buffer_raw(row), apdu.ne);
}
else {
memcpy(res_APDU, otp_buffer(row), apdu.ne);
}
res_APDU_size = apdu.ne;
}
else {
apdu.nc -= 2;
apdu.data += 2;
if (apdu.nc % 2) {
if (apdu.nc > 1024) {
return SW_WRONG_LENGTH();
}
if (apdu.nc % (israw ? 4 : 2)) {
return SW_WRONG_DATA();
}
if ((uintptr_t)apdu.data & 1) { // Not aligned
memmove(apdu.data - 1, apdu.data, apdu.nc);
apdu.data--;
uint8_t adata[1024] __attribute__((aligned(4)));
memcpy(adata, apdu.data, apdu.nc);
int ret = 0;
if (israw) {
ret = otp_write_data_raw(row, adata, apdu.nc);
}
else {
ret = otp_write_data(row, adata, apdu.nc);
}
int ret = otp_write_data(row, apdu.data, apdu.nc);
if (ret != 0) {
return SW_EXEC_ERROR();
}