support ASM encryption module
This commit is contained in:
parent
5012757673
commit
4d6562a0bc
6 changed files with 333 additions and 1 deletions
116
lib/include/asm.h
Normal file
116
lib/include/asm.h
Normal file
|
@ -0,0 +1,116 @@
|
|||
/*
|
||||
* Copyright (c) 2010, Mariano Alvira <mar@devl.org> and other contributors
|
||||
* to the MC1322x project (http://mc1322x.devl.org)
|
||||
* All rights reserved.
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted provided that the following conditions
|
||||
* are met:
|
||||
* 1. Redistributions of source code must retain the above copyright
|
||||
* notice, this list of conditions and the following disclaimer.
|
||||
* 2. Redistributions in binary form must reproduce the above copyright
|
||||
* notice, this list of conditions and the following disclaimer in the
|
||||
* documentation and/or other materials provided with the distribution.
|
||||
* 3. Neither the name of the Institute nor the names of its contributors
|
||||
* may be used to endorse or promote products derived from this software
|
||||
* without specific prior written permission.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY THE INSTITUTE AND CONTRIBUTORS ``AS IS'' AND
|
||||
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||
* ARE DISCLAIMED. IN NO EVENT SHALL THE INSTITUTE OR CONTRIBUTORS BE LIABLE
|
||||
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
||||
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
||||
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
||||
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
||||
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
||||
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
||||
* SUCH DAMAGE.
|
||||
*
|
||||
* This file is part of libmc1322x: see http://mc1322x.devl.org
|
||||
* for details.
|
||||
*
|
||||
*
|
||||
*/
|
||||
|
||||
#ifndef ASM_H
|
||||
#define ASM_H
|
||||
|
||||
/* Structure-based register definitions */
|
||||
/* Example use:
|
||||
ASM->KEY0 = 0xaabbccdd;
|
||||
ASM->CONTROL1bits = (struct ASM_CONTROL1) {
|
||||
.MASK_IRQ = 1,
|
||||
.CBC = 1,
|
||||
};
|
||||
ASM->CONTROL1bits.SELF_TEST = 1;
|
||||
*/
|
||||
|
||||
struct ASM_struct {
|
||||
uint32_t KEY0;
|
||||
uint32_t KEY1;
|
||||
uint32_t KEY2;
|
||||
uint32_t KEY3;
|
||||
uint32_t DATA0;
|
||||
uint32_t DATA1;
|
||||
uint32_t DATA2;
|
||||
uint32_t DATA3;
|
||||
uint32_t CTR0;
|
||||
uint32_t CTR1;
|
||||
uint32_t CTR2;
|
||||
uint32_t CTR3;
|
||||
uint32_t CTR0_RESULT;
|
||||
uint32_t CTR1_RESULT;
|
||||
uint32_t CTR2_RESULT;
|
||||
uint32_t CTR3_RESULT;
|
||||
uint32_t CBC0_RESULT;
|
||||
uint32_t CBC1_RESULT;
|
||||
uint32_t CBC2_RESULT;
|
||||
uint32_t CBC3_RESULT;
|
||||
|
||||
union {
|
||||
uint32_t CONTROL0;
|
||||
struct ASM_CONTROL0 {
|
||||
uint32_t :24;
|
||||
uint32_t START:1;
|
||||
uint32_t CLEAR:1;
|
||||
uint32_t LOAD_MAC:1;
|
||||
uint32_t :4;
|
||||
uint32_t CLEAR_IRQ:1;
|
||||
} CONTROL0bits;
|
||||
};
|
||||
union {
|
||||
uint32_t CONTROL1;
|
||||
struct ASM_CONTROL1 {
|
||||
uint32_t ON:1;
|
||||
uint32_t NORMAL_MODE:1;
|
||||
uint32_t BYPASS:1;
|
||||
uint32_t :21;
|
||||
uint32_t CBC:1;
|
||||
uint32_t CTR:1;
|
||||
uint32_t SELF_TEST:1;
|
||||
uint32_t :4;
|
||||
uint32_t MASK_IRQ:1;
|
||||
} CONTROL1bits;
|
||||
};
|
||||
union {
|
||||
uint32_t STATUS;
|
||||
struct ASM_STATUS {
|
||||
uint32_t :24;
|
||||
uint32_t DONE:1;
|
||||
uint32_t TEST_PASS:1;
|
||||
uint32_t :6;
|
||||
} STATUSbits;
|
||||
};
|
||||
|
||||
uint32_t reserved;
|
||||
|
||||
uint32_t MAC0;
|
||||
uint32_t MAC1;
|
||||
uint32_t MAC2;
|
||||
uint32_t MAC3;
|
||||
};
|
||||
|
||||
static volatile struct ASM_struct * const ASM = (void *) (0x80008000);
|
||||
|
||||
#endif
|
|
@ -166,5 +166,7 @@ extern void uart1_isr(void) __attribute__((weak));
|
|||
|
||||
extern void maca_isr(void) __attribute__((weak));
|
||||
|
||||
extern void asm_isr(void) __attribute__((weak));
|
||||
|
||||
|
||||
#endif
|
||||
|
|
|
@ -46,5 +46,6 @@
|
|||
#include "packet.h"
|
||||
#include "uart1.h"
|
||||
#include "utils.h"
|
||||
#include "asm.h"
|
||||
|
||||
#endif
|
||||
|
|
|
@ -86,6 +86,9 @@ void irq(void)
|
|||
cal_isr();
|
||||
}
|
||||
}
|
||||
if(bit_is_set(pending, INT_NUM_ASM)) {
|
||||
if(asm_isr != 0) { asm_isr(); }
|
||||
}
|
||||
|
||||
*INTFRC = 0; /* stop forcing interrupts */
|
||||
|
||||
|
|
|
@ -10,7 +10,8 @@ TARGETS := blink-red blink-green blink-blue blink-white blink-allio \
|
|||
uart1-loopback \
|
||||
tmr tmr-ints \
|
||||
sleep \
|
||||
printf
|
||||
printf \
|
||||
asm
|
||||
|
||||
# these targets are built with space reserved for variables needed by ROM services
|
||||
# this space is initialized with a rom call to rom_data_init
|
||||
|
|
209
tests/asm.c
Normal file
209
tests/asm.c
Normal file
|
@ -0,0 +1,209 @@
|
|||
/*
|
||||
* Copyright (c) 2010, Mariano Alvira <mar@devl.org> and other contributors
|
||||
* to the MC1322x project (http://mc1322x.devl.org)
|
||||
* All rights reserved.
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted provided that the following conditions
|
||||
* are met:
|
||||
* 1. Redistributions of source code must retain the above copyright
|
||||
* notice, this list of conditions and the following disclaimer.
|
||||
* 2. Redistributions in binary form must reproduce the above copyright
|
||||
* notice, this list of conditions and the following disclaimer in the
|
||||
* documentation and/or other materials provided with the distribution.
|
||||
* 3. Neither the name of the Institute nor the names of its contributors
|
||||
* may be used to endorse or promote products derived from this software
|
||||
* without specific prior written permission.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY THE INSTITUTE AND CONTRIBUTORS ``AS IS'' AND
|
||||
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||
* ARE DISCLAIMED. IN NO EVENT SHALL THE INSTITUTE OR CONTRIBUTORS BE LIABLE
|
||||
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
||||
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
||||
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
||||
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
||||
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
||||
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
||||
* SUCH DAMAGE.
|
||||
*
|
||||
* This file is part of libmc1322x: see http://mc1322x.devl.org
|
||||
* for details.
|
||||
*
|
||||
*
|
||||
*/
|
||||
|
||||
#include <mc1322x.h>
|
||||
#include <board.h>
|
||||
#include <stdio.h>
|
||||
|
||||
#include "tests.h"
|
||||
#include "config.h"
|
||||
|
||||
void asm_isr(void) {
|
||||
printf("asm isr\n\r");
|
||||
ASM->CONTROL0bits.CLEAR_IRQ = 1;
|
||||
}
|
||||
|
||||
|
||||
void main(void) {
|
||||
volatile int i;
|
||||
|
||||
/* trim the reference osc. to 24MHz */
|
||||
trim_xtal();
|
||||
|
||||
uart_init(INC, MOD, SAMP);
|
||||
|
||||
vreg_init();
|
||||
|
||||
enable_irq(ASM);
|
||||
|
||||
print_welcome("asm");
|
||||
|
||||
printf("ASM Control 0: %08x\n\r", (unsigned int)ASM->CONTROL0);
|
||||
printf("ASM Control 1: %08x\n\r", (unsigned int)ASM->CONTROL1);
|
||||
printf("ASM Status: %08x\n\r", (unsigned int)ASM->STATUS);
|
||||
printf("ASM Test pass: %d\n\r", ASM->STATUSbits.TEST_PASS);
|
||||
|
||||
/* ASM module is disabled until self-test passes */
|
||||
printf("\n\r*** ASM self-test ***\n\r");
|
||||
|
||||
ASM->CONTROL1bits.ON = 1;
|
||||
ASM->CONTROL1bits.SELF_TEST = 1;
|
||||
ASM->CONTROL0bits.START = 1;
|
||||
|
||||
/* Self test takes 3330 periph. clocks (default 24Mhz) */
|
||||
/* to complete. This doesn't wait 3330 exactly, but should be long enough */
|
||||
|
||||
for(i = 0; i < 3330; i++) { continue; }
|
||||
|
||||
printf("ASM Test pass: %d\n\r", ASM->STATUSbits.TEST_PASS);
|
||||
|
||||
/* must clear the self test bit when done */
|
||||
ASM->CONTROL1bits.SELF_TEST = 0;
|
||||
|
||||
|
||||
/* ASM starts in "BOOT" mode which uses an internal secret key
|
||||
* to load encrypted data from an external source */
|
||||
/* must set to NORMAL mode */
|
||||
ASM->CONTROL1bits.NORMAL_MODE = 1;
|
||||
|
||||
/* setting the bypass bit will disable the encryption */
|
||||
/* bypass defaults to off */
|
||||
ASM->CONTROL1bits.BYPASS = 0;
|
||||
|
||||
printf("\n\r*** set ASM key ***\n\r");
|
||||
ASM->KEY0 = 0xccddeeff;
|
||||
ASM->KEY1 = 0x8899aabb;
|
||||
ASM->KEY2 = 0x44556677;
|
||||
ASM->KEY3 = 0x00112233;
|
||||
|
||||
/* KEY registers appear to be write-only (which is a good thing) */
|
||||
/* even though the datasheet says you can read them */
|
||||
printf("ASM Key [3,2,1,0] : 0x%08x%08x%08x%08x\n",
|
||||
(unsigned int) ASM->KEY3,
|
||||
(unsigned int) ASM->KEY2,
|
||||
(unsigned int) ASM->KEY1,
|
||||
(unsigned int) ASM->KEY0);
|
||||
|
||||
printf("\n\r*** CTR test ***\n\r");
|
||||
printf("Encrypt\n\r");
|
||||
ASM->CONTROL1bits.CTR = 1;
|
||||
|
||||
ASM->DATA0 = 0xdeaddead;
|
||||
ASM->DATA1 = 0xbeefbeef;
|
||||
ASM->DATA2 = 0xfaceface;
|
||||
ASM->DATA3 = 0x01234567;
|
||||
|
||||
printf("ASM Data [3,2,1,0] : 0x%08x%08x%08x%08x\n",
|
||||
(unsigned int) ASM->DATA3,
|
||||
(unsigned int) ASM->DATA2,
|
||||
(unsigned int) ASM->DATA1,
|
||||
(unsigned int) ASM->DATA0);
|
||||
|
||||
ASM->CTR0 = 0x33333333;
|
||||
ASM->CTR1 = 0x22222222;
|
||||
ASM->CTR2 = 0x11111111;
|
||||
ASM->CTR3 = 0x00000000;
|
||||
|
||||
printf("ASM CTR [3,2,1,0] : 0x%08x%08x%08x%08x\n",
|
||||
(unsigned int) ASM->CTR3,
|
||||
(unsigned int) ASM->CTR2,
|
||||
(unsigned int) ASM->CTR1,
|
||||
(unsigned int) ASM->CTR0);
|
||||
|
||||
ASM->CONTROL0bits.START = 1;
|
||||
while(ASM->STATUSbits.DONE == 0) { continue; }
|
||||
|
||||
printf("ASM CTR RESULT [3,2,1,0]: 0x%08x%08x%08x%08x\n",
|
||||
(unsigned int) ASM->CTR3_RESULT,
|
||||
(unsigned int) ASM->CTR2_RESULT,
|
||||
(unsigned int) ASM->CTR1_RESULT,
|
||||
(unsigned int) ASM->CTR0_RESULT);
|
||||
|
||||
printf("Decrypt\n\r");
|
||||
|
||||
ASM->DATA0 = ASM->CTR0_RESULT;
|
||||
ASM->DATA1 = ASM->CTR1_RESULT;
|
||||
ASM->DATA2 = ASM->CTR2_RESULT;
|
||||
ASM->DATA3 = ASM->CTR3_RESULT;
|
||||
|
||||
ASM->CONTROL0bits.START = 1;
|
||||
while(ASM->STATUSbits.DONE == 0) { continue; }
|
||||
|
||||
printf("ASM CTR RESULT [3,2,1,0]: 0x%08x%08x%08x%08x\n",
|
||||
(unsigned int) ASM->CTR3_RESULT,
|
||||
(unsigned int) ASM->CTR2_RESULT,
|
||||
(unsigned int) ASM->CTR1_RESULT,
|
||||
(unsigned int) ASM->CTR0_RESULT);
|
||||
|
||||
printf("\n\r*** CBC MAC generation ***\n\r");
|
||||
|
||||
ASM->CONTROL1bits.CTR = 0;
|
||||
ASM->CONTROL1bits.CBC = 1;
|
||||
|
||||
/* CBC is like a hash */
|
||||
/* it doesn't use the CTR data */
|
||||
/* the accumulated MAC is in the MAC registers */
|
||||
/* you must use the CLEAR bit to reset the MAC state */
|
||||
|
||||
ASM->DATA0 = 0xdeaddead;
|
||||
ASM->DATA1 = 0xbeefbeef;
|
||||
ASM->DATA2 = 0xfaceface;
|
||||
ASM->DATA3 = 0x01234567;
|
||||
|
||||
ASM->CONTROL0bits.CLEAR = 1;
|
||||
|
||||
ASM->CONTROL0bits.START = 1;
|
||||
while(ASM->STATUSbits.DONE == 0) { continue; }
|
||||
|
||||
printf("ASM CBC RESULT [3,2,1,0]: 0x%08x%08x%08x%08x\n",
|
||||
(unsigned int) ASM->CBC3_RESULT,
|
||||
(unsigned int) ASM->CBC2_RESULT,
|
||||
(unsigned int) ASM->CBC1_RESULT,
|
||||
(unsigned int) ASM->CBC0_RESULT);
|
||||
|
||||
printf("\n\r*** CCM (CTR+CBC) ***\n\r");
|
||||
|
||||
ASM->CONTROL1bits.CTR = 1;
|
||||
ASM->CONTROL1bits.CBC = 1;
|
||||
ASM->CONTROL0bits.CLEAR = 1;
|
||||
|
||||
ASM->CONTROL0bits.START = 1;
|
||||
while(ASM->STATUSbits.DONE == 0) { continue; }
|
||||
|
||||
printf("ASM CTR RESULT [3,2,1,0]: 0x%08x%08x%08x%08x\n",
|
||||
(unsigned int) ASM->CTR3_RESULT,
|
||||
(unsigned int) ASM->CTR2_RESULT,
|
||||
(unsigned int) ASM->CTR1_RESULT,
|
||||
(unsigned int) ASM->CTR0_RESULT);
|
||||
|
||||
printf("ASM CBC RESULT [3,2,1,0]: 0x%08x%08x%08x%08x\n",
|
||||
(unsigned int) ASM->CBC3_RESULT,
|
||||
(unsigned int) ASM->CBC2_RESULT,
|
||||
(unsigned int) ASM->CBC1_RESULT,
|
||||
(unsigned int) ASM->CBC0_RESULT);
|
||||
|
||||
while(1) {
|
||||
}
|
||||
}
|
Loading…
Reference in a new issue