main.c

Since this source code is common to both the board and QEMU, we must set appropriate conditionals in order to compile the necessary code according to the desired target.

The following code can be copied:

#ifdef IMX53QSB

#include "mxc_serial.h"

volatile unsigned int * const UART0DR = (unsigned int *)0x53fbc040;

#define R32   (volatile unsigned long *)

#define CSU_BASE_ADDR   0x63F9C000

// register the secure monitor vector

extern void init_secure_monitor();

enum
{
    CSL0  = CSU_BASE_ADDR + 0x00,      
    CSL1  = CSU_BASE_ADDR + 0x04,      
    CSL2  = CSU_BASE_ADDR + 0x08,     // GPIO7
    CSL3  = CSU_BASE_ADDR + 0x0c,
    CSL4  = CSU_BASE_ADDR + 0x10,
    CSL5  = CSU_BASE_ADDR + 0x14,
    CSL6  = CSU_BASE_ADDR + 0x18,
    CSL7  = CSU_BASE_ADDR + 0x1c,
    CSL8  = CSU_BASE_ADDR + 0x20,
    CSL9  = CSU_BASE_ADDR + 0x24,
    CSL10 = CSU_BASE_ADDR + 0x28,
    CSL11 = CSU_BASE_ADDR + 0x2c,
    CSL12 = CSU_BASE_ADDR + 0x30,     // GPIO7
    CSL13 = CSU_BASE_ADDR + 0x34,
    CSL14 = CSU_BASE_ADDR + 0x38,
    CSL15 = CSU_BASE_ADDR + 0x3c,
    CSL16 = CSU_BASE_ADDR + 0x40,
    CSL17 = CSU_BASE_ADDR + 0x44,
    CSL18 = CSU_BASE_ADDR + 0x48,
    CSL19 = CSU_BASE_ADDR + 0x4c,
    CSL20 = CSU_BASE_ADDR + 0x50,
    CSL21 = CSU_BASE_ADDR + 0x54,
    CSL22 = CSU_BASE_ADDR + 0x58,
    CSL23 = CSU_BASE_ADDR + 0x5c,
    CSL24 = CSU_BASE_ADDR + 0x60,
    CSL25 = CSU_BASE_ADDR + 0x64,     // ESDHC
    CSL26 = CSU_BASE_ADDR + 0x68,
    CSL27 = CSU_BASE_ADDR + 0x6c,
    CSL28 = CSU_BASE_ADDR + 0x70,     // ESDHC
    CSL29 = CSU_BASE_ADDR + 0x74,
    CSL30 = CSU_BASE_ADDR + 0x78,
    CSL31 = CSU_BASE_ADDR + 0x7c,
};

void enable_hwfirewall(void)
{
    *R32 CSL0  = 0x00ff00ff;
    *R32 CSL1  = 0x00ff00ff;
    *R32 CSL2  = 0x00ff00ff;
    *R32 CSL3  = 0x00ff00ff;
    *R32 CSL4  = 0x00ff00ff;
    *R32 CSL5  = 0x00ff00ff;
    *R32 CSL6  = 0x00ff00ff;
    *R32 CSL7  = 0x00ff00ff;
    *R32 CSL8  = 0x00ff00ff;
    *R32 CSL9  = 0x00ff00ff;
    *R32 CSL10 = 0x00ff00ff;
    *R32 CSL11 = 0x00ff00ff;
    *R32 CSL12 = 0x00ff00ff;
    *R32 CSL13 = 0x00ff00ff;
    *R32 CSL14 = 0x00ff00ff;
    *R32 CSL15 = 0x00ff00ff;
    *R32 CSL16 = 0x00ff00ff;
    *R32 CSL17 = 0x00ff00ff;
    *R32 CSL18 = 0x00ff00ff;
    *R32 CSL19 = 0x00ff00ff;
    *R32 CSL20 = 0x00ff00ff;
    *R32 CSL21 = 0x00ff00ff;
    *R32 CSL22 = 0x00ff00ff;
    *R32 CSL23 = 0x00ff00ff;
    *R32 CSL24 = 0x00ff00ff;
    *R32 CSL25 = 0x003b003b;
    *R32 CSL26 = 0x00ff00ff;
    *R32 CSL27 = 0x00ff00ff;
    *R32 CSL28 = 0x003b003b;
    *R32 CSL29 = 0x00ff00ff;
    *R32 CSL30 = 0x00ff00ff;
    *R32 CSL31 = 0x00ff00ff;
}

// code in TrustZone Normal World
void normal_world()
{
    while(1)
    {
      print_uart0(" Say hello in TrustZone ^^Normal^^ World!\n");
      // transit to Secure Monitor (Dst: Secure World)
      asm volatile ("smc #0\n\t");
    }
}
#endif

#ifdef QEMU

volatile unsigned int * const UART0DR = (unsigned int *)0x10009000;

#endif

/*0x53fbc040 UART  i.MX53 QSB*/
/*UART_PHYS   0x53fbc000 + UTXD  0x40 (Transmitter Register) */

/*0x53fbc0b4*/
/*UART_PHYS   0x53fbc000 + UTS  0xb4*/
//volatile unsigned int * const UART0DR = (unsigned int *)0x53fbc040; /*0x10009000 cortex-a8 qemu*/

void print_uart0(const char *s) {
    while(*s != '\0') { /* Loop until end of string */
      *UART0DR = (unsigned int)(*s); /* Transmit char */
      s++; /* Next char */
    }
}

void bootmain(void)
{

#ifdef IMX53QSB
    enable_hwfirewall();

    iomuxc_init();
    mxc_serial_init();

    print_uart0("Test ARM TrustZone on i.MX53 Quick Start Board.\n");

    // register the TrustZone secure monitor vector
    print_uart0("Register the TrustZone Secure Monitor Vector.\n");
    init_secure_monitor(normal_world);
    print_uart0("Secure Monitor Vector Registration Successfully!\n");

    int i;
    for(i=0; i<10; i++)
    {
            cprintf("## Say hello in TrustZone ^^Secure^^ World! %d\n", i);
            // transit to Secure Monitor (Dst: Normal World)
            asm volatile ("smc #0\n\t");
    };

    print_uart0("Finish the TrustZone world-transition test! Congrat!!!!\n");
#endif

    print_uart0("Hello world!\n");
}