[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

[Xen-devel] [PATCH 03/14] arm: implement startup code.



arm: implement startup code.

 xen/arch/arm/xen/Makefile |    1 +
 xen/arch/arm/xen/start.S  |  273 
++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 xen/include/asm-arm/mmu.h |  198 
++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++

Signed-off-by: Jaemin Ryu <jm77.ryu@xxxxxxxxxxx>

diff -r e6ac8b686aa6 xen/arch/arm/xen/Makefile
--- a/xen/arch/arm/xen/Makefile Fri Feb 03 16:07:33 2012 +0900
+++ b/xen/arch/arm/xen/Makefile Fri Feb 03 16:26:34 2012 +0900
@@ -1,3 +1,4 @@
+obj-y += start.o
 obj-y += setup.o
 obj-y += mm.o
 obj-y += irq.o
diff -r e6ac8b686aa6 xen/arch/arm/xen/start.S
--- /dev/null   Thu Jan 01 00:00:00 1970 +0000
+++ b/xen/arch/arm/xen/start.S  Fri Feb 03 16:26:34 2012 +0900
@@ -0,0 +1,273 @@
+/*
+ * start.S 
+ *
+ * Copyright (C) 2008-2011 Samsung Electronics 
+ *          Sang-bum Suh <sbuk.suh@xxxxxxxxxxx>
+ *          Jaemin Ryu   <jm77.ryu@xxxxxxxxxxx>
+ *
+ * Secure Xen on ARM architecture designed by Sang-bum Suh consists of
+ * Xen on ARM and the associated access control.
+ * 
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public version 2 of License as
+ * published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+
+#include <xen/config.h>
+#include <asm/cpu-domain.h>
+#include <asm/processor.h>
+#include <asm/page.h>
+#include <asm/system.h>
+#include <asm/mmu.h>
+#include <asm/asm-macros.h>
+
+/*
+ * Initial stack for core 0
+ */
+#define SVC_STACK_SIZE STACK_SIZE
+
+.macro pa rd, rs
+1:
+       adr     \rs, 1b
+       lsr     \rs, \rs, #20
+       sub     \rd, \rd, #XEN_VIRT_START
+       add     \rd, \rd, \rs, lsl #20
+.endm
+       
+       .section .head
+ENTRY(start)
+       msr     cpsr_c, #(PSR_F_BIT | PSR_I_BIT | PSR_MODE_SVC)
+
+#ifdef SMP
+       mrc     ACTLR(r2)
+       orr     r2, r2, #(ACTLR_SMP) | (ACTLR_FW)
+       mcr     ACTLR(r2)
+#endif
+       
+       adr     r0, start
+       mov     r1, r0
+       sub     r0, r0, #0x4000 
+       mov     r2, #0
+1:     str     r2, [r1, #-4]!
+       str     r2, [r1, #-4]!
+       str     r2, [r1, #-4]!
+       str     r2, [r1, #-4]!
+       cmp     r0, r1
+       bne     1b
+
+       ldr     r2, =(XEN_VIRT_START >> 20)
+       ldr     r7, =(L1E_TYPE_HYPERVISOR)
+
+       @ Start section no.
+       mov     r3, pc
+       lsr     r3, r3, #20
+
+       @ Initial VMM mapping
+       orr     r4, r7, r3, lsl #20
+       str     r4, [r0, r2, lsl #2]
+       @add    r4, r4, #0x100000
+       @add    r2, r2, #1
+       @str    r4, [r0, r2, lsl #2]
+
+        ldr     r5, =_smemtable
+       pa      r5, r6
+       ldr     r6, =_ememtable
+       pa      r6, r7
+
+1:
+       cmp     r5, r6
+       beq     3f
+
+       @ r1 : base
+       @ r2 : size
+       @ r3 : type
+       @ r4 : mmu_flags
+
+        ldmia   r5!, {r1, r2, r3, r4}
+       lsr     r1, r1, #20
+       orr     r4, r4, r1, lsl #20
+
+       @ Round up
+       add     r2, r2, #0xFF00
+       add     r2, r2, #0x00FF
+       lsr     r2, r2, #20
+2:
+        str     r4, [r0, r1, lsl #2]
+        add     r1, r1, #1
+        add     r4, r4, #0x100000
+        adds    r2, r2, #-1
+        bhi     2b
+       b       1b
+3:
+
+       @ Load Translation Table Base
+       orr     r0, r0, #(TTB_FLAGS)
+       mcr     TTBR0(r0)
+       mcr     TTBR1(r0)
+
+       @ TTBCR Setting
+        mrc     p15, 0, r5, c1, c0, 2
+        orr     r5,r5, #((3 << (10 * 2)) |(3 << (11 * 2)))
+        mcr     p15, 0, r5, c1, c0, 2
+
+       @ Load DAC
+       ldr     r5, =0x55555555
+       mcr     DACR(r5)
+
+       ldr     r5, =0xFF0A89A8
+       ldr     r6, =0x40E040E0
+       mcr     p15, 0, r5, c10, c2, 0
+       mcr     p15, 0, r6, c10, c2, 1
+
+       @ Turn on MMU
+       ldr     r0, =(SCTLR_TRE | SCTLR_SW | SCTLR_Z | SCTLR_I | SCTLR_C | 
SCTLR_A | SCTLR_M)
+       mcr     SCTLR(r0)
+       mov     r0, r0
+       mov     r0, r0
+       mov     r0, r0
+
+       @ Invalidate I/D TLBs
+       mov     ip, #0
+       mcr     p15, 0, ip, c8, c7, 0
+       dsb
+       isb
+
+       @ Clear BSS section
+       adr     r0, 2f
+       ldmia   r0, {r1, r2}
+       mov     r0, #0
+1:
+       str     r0, [r1], #4 
+       cmp     r1, r2
+       blo     1b
+
+        /* Stack Setup */
+       @ Get processor ID
+        mrc     MPIDR(r4)
+        and     r4, r4, #15
+
+       @ r0 = r0 * STACK_SIZE
+        mov     r1, #STACK_SIZE
+        mul     r4, r4, r1
+
+       msr     cpsr_c, #PSR_MODE_IRQ | PSR_I_BIT | PSR_F_BIT
+       ldr     sp, =(irq_stacks + STACK_SIZE)
+       add     sp, sp, r4
+
+       msr     cpsr_c, #PSR_MODE_ABT | PSR_I_BIT | PSR_F_BIT
+       ldr     sp, =(abt_stacks + STACK_SIZE)
+       add     sp, sp, r4
+
+       msr     cpsr_c, #PSR_MODE_UND | PSR_I_BIT | PSR_F_BIT
+       ldr     sp, =(und_stacks + STACK_SIZE)
+       add     sp, sp, r4
+
+       msr     cpsr_c, #PSR_MODE_SVC | PSR_I_BIT | PSR_F_BIT
+       ldr     sp, =(svc_stacks + STACK_SIZE)
+       add     sp, sp, r4
+
+       adr     r12, 3f
+       ldr     pc, [r12]
+
+2:     .word   _sbss
+       .word   _ebss
+
+3:
+       .long   start_xen
+
+#ifdef SMP
+        /*
+         * Common entry point for secondary CPUs.
+         *
+         * Ensure that we're in SVC mode, and IRQs are disabled.
+         */
+       .section .head
+ENTRY(slave_cpu_start)
+       msr     cpsr_c, #PSR_F_BIT | PSR_I_BIT | PSR_MODE_SVC
+
+        mrc     ACTLR(r2)
+        orr     r2, r2, #(ACTLR_SMP) | (ACTLR_FW)
+        mcr     ACTLR(r2)
+
+       @ Load Translation Table Base
+       adr     r4, start
+       sub     r4, r4, #0x4000
+       orr     r4, r4, #(TTB_FLAGS)
+       mcr     TTBR0(r4)
+       mcr     TTBR1(r4)
+
+       @ TTBCR Setting
+        mrc     p15, 0, r5, c1, c0, 2
+        orr     r5,r5, #((3 << (10 * 2)) |(3 << (11 * 2)))
+        mcr     p15, 0, r5, c1, c0, 2
+
+       @ Load DAC
+       ldr     r5, =0x55555555
+       mcr     DACR(r5)
+       
+       ldr     r5, =0xFF0A89A8
+       ldr     r6, =0x40E040E0
+       mcr     p15, 0, r5, c10, c2, 0
+       mcr     p15, 0, r6, c10, c2, 1
+
+       @ Turn on MMU
+       ldr     r0, =(SCTLR_TRE | SCTLR_SW | SCTLR_Z | SCTLR_I | SCTLR_C | 
SCTLR_A | SCTLR_M)
+       mcr     SCTLR(r0)
+       mov     r0, r0
+       mov     r0, r0
+       mov     r0, r0
+
+        @ Invalidate I, D TLBs
+       mov     ip, #0
+       mcr     p15, 0, ip, c8, c7, 0
+       dsb
+       isb
+
+       /* Stack Setup */
+        @ get processor id
+       mrc     MPIDR(r4)
+       and     r4, r4, #15
+               
+       @ r0 = r0 * STACK_SIZE
+       mov     r1, #STACK_SIZE
+       mul     r4, r4, r1
+       
+       msr     cpsr_c, #PSR_MODE_IRQ | PSR_I_BIT | PSR_F_BIT
+       ldr     sp, =(irq_stacks + STACK_SIZE)
+       add     sp, sp, r4
+
+       msr     cpsr_c, #PSR_MODE_ABT | PSR_I_BIT | PSR_F_BIT
+       ldr     sp, =(abt_stacks + STACK_SIZE)
+       add     sp, sp, r4
+
+       msr     cpsr_c, #PSR_MODE_UND | PSR_I_BIT | PSR_F_BIT
+       ldr     sp, =(und_stacks + STACK_SIZE)
+       add     sp, sp, r4
+
+       msr     cpsr_c, #PSR_MODE_SVC | PSR_I_BIT | PSR_F_BIT
+       ldr     sp, =(svc_stacks + STACK_SIZE)
+       add     sp, sp, r4
+
+       adr     r12, 2f
+       ldmia   r12, {lr, pc}
+
+2:
+       .long   2b
+       .long   start_xen_on_slave_cpu
+#endif
+
+       .section .bss.stack_aligned,"w"
+svc_stacks: .fill SVC_STACK_SIZE, MAX_PHYS_CPUS, 0
+irq_stacks: .fill SVC_STACK_SIZE, MAX_PHYS_CPUS, 0
+und_stacks: .fill SVC_STACK_SIZE, MAX_PHYS_CPUS, 0
+abt_stacks: .fill SVC_STACK_SIZE, MAX_PHYS_CPUS, 0
+fiq_stacks: .fill SVC_STACK_SIZE, MAX_PHYS_CPUS, 0
diff -r e6ac8b686aa6 xen/include/asm-arm/mmu.h
--- a/xen/include/asm-arm/mmu.h Fri Feb 03 16:07:33 2012 +0900
+++ b/xen/include/asm-arm/mmu.h Fri Feb 03 16:26:34 2012 +0900
@@ -1,11 +1,209 @@
 #ifndef __ARM_MMU_H__
 #define __ARM_MMU_H__
 
+#include <asm/system.h>
+#include <asm/cpu-domain.h>
+
+#define L1E_FLAG_MASK           (0x3FF)
+
+#define L1E_TYPE_FAULT          (0x00)
+#define L1E_TYPE_TABLE          (0x01)
+#define L1E_TYPE_SECTION        (0x02)
+#define L1E_TYPE_MASK           (0x03)
+
+#define L1E_BIT4               (1 << 4)
+
+#define L1E_AP_SRW_UNO          (0x01 << 10)
+#define L1E_AP_SRW_URO          (0x02 << 10)
+#define L1E_AP_SRW_URW          (0x03 << 10)
+
+#define L1E_BUFFERABLE          (0x04)
+#define L1E_CACHEABLE           (0x08)
+
+#define L1E_TEX(x)              ((x) <<12)
+#define L1E_APX                 (1 << 15)
+#define L1E_S                   (1 << 16)
+#define L1E_nG                  (1 << 17)
+
+#define L1E_STRONGORDERED       (0)
+#define L1E_DEVICE              (L1E_TEX(1))
+#define L1E_WRITEBACK           (L1E_CACHEABLE | L1E_BUFFERABLE)
+#define L1E_WRITETHROUGH        (L1E_CACHEABLE)
+#define L1E_WRITEALLOC          (L1E_TEX(1) | L1E_CACHEABLE | L1E_BUFFERABLE)
+#define L1E_SHARED              (0)
+
+#define L1E_DOMAIN_HYP         (DOMAIN_HYP << 5)
+#define L1E_DOMAIN_SVC         (DOMAIN_SVC << 5)
+#define L1E_DOMAIN_USR         (DOMAIN_USR << 5)
+#define L1E_DOMAIN_IO           (DOMAIN_IO << 5)
+
+#define L1E_WBWA                (L1E_TEX(1) | L1E_WRITEBACK)
+
+#define SECTION_SHIFT           (20)
+#define SECTION_SIZE            (1 << SECTION_SHIFT)
+#define SECTION_MASK            (~(SECTION_SIZE - 1))
+
+#define L1E_TYPE_HYPERVISOR     (L1E_TYPE_SECTION | L1E_DOMAIN_HYP | L1E_S | 
L1E_AP_SRW_UNO | L1E_WRITEALLOC)
+#define L1E_TYPE_GUEST         (L1E_TYPE_SECTION | L1E_DOMAIN_SVC | L1E_S | 
L1E_AP_SRW_URW | L1E_WRITEALLOC)
+#define L1E_TYPE_DEVICE                (L1E_TYPE_SECTION | L1E_DOMAIN_IO  | 
L1E_S | L1E_AP_SRW_URW | L1E_DEVICE)
+
+/*
+ * Definition for Page Table Entries
+ */
+
+#define L2E_FLAG_MASK           (0xFFF)
+
+#define L2E_TYPE_FAULT          (0x00)
+#define L2E_TYPE_LARGE          (0x01)
+#define L2E_TYPE_SMALL          (0x02)
+#define L2E_TYPE_TINY           (0x03)
+#define L2E_TYPE_EXT            (0x02)
+
+#define L2E_TYPE_MASK           (0x03)
+
+#define L2E_BUFFERABLE          (0x04)
+#define L2E_CACHEABLE           (0x08)
+
+#define L1E_SHIFT               (20)
+#define L2E_SHIFT              (12)
+
+#define L2E_EXT_XN              (1 << 0)
+#define L2E_EXT_AP_MASK         (3 << 4)
+#define L2E_EXT_AP0             (1 << 4)
+#define L2E_EXT_AP1             (2 << 4)
+#define L2E_EXT_AP_UNO_SRO      (0 << 4)
+#define L2E_EXT_AP_UNO_SRW      (L2E_EXT_AP0)
+#define L2E_EXT_AP_URO_SRW      (L2E_EXT_AP1)
+#define L2E_EXT_AP_URW_SRW      (L2E_EXT_AP1|L2E_EXT_AP0)
+#define L2E_EXT_TEX(x)          ((x) << 6)
+#define L2E_EXT_APX             (1 << 9)
+#define L2E_EXT_COHERENT        (1 << 9)
+#define L2E_EXT_SHARED          (1 << 10)
+#define L2E_EXT_NG              (1 << 11)
+
+
+#define L1_TABLE_ENTRIES       (4096)
+#define L2_TABLE_ENTRIES       (256)
+
+#define L1_TABLE_SIZE          (0x4000)
+
+#define L2E_GUEST_AP_MASK       L2E_EXT_AP_MASK
+#define L2E_GUEST_AP_NO         L2E_EXT_AP_UNO_SRW
+#define L2E_GUEST_AP_RO         L2E_EXT_AP_URO_SRW
+#define L2E_GUEST_AP_RW         L2E_EXT_AP_URW_SRW
+
+#define L1E_GUEST_TABLE         (L1E_DOMAIN_SVC | L1E_TYPE_TABLE)
+#define L1E_VECTOR_TABLE        (L1E_DOMAIN_SVC | L1E_TYPE_TABLE)
+
+#define L2E_GUEST_PAGE          (L2E_EXT_SHARED | L2E_GUEST_AP_RW | 
L2E_EXT_TEX(1) | L2E_BUFFERABLE | L2E_CACHEABLE | L2E_TYPE_EXT)
+
+#define L2E_VECTOR_PAGE         (L2E_GUEST_AP_RO | L2E_EXT_TEX(1) | 
L2E_BUFFERABLE | L2E_CACHEABLE | L2E_TYPE_EXT)
+#define L2E_GRANT_PAGE         (L2E_TYPE_EXT | L2E_EXT_SHARED | L2E_EXT_TEX(1) 
| L2E_BUFFERABLE | L2E_CACHEABLE | L2E_GUEST_AP_RW)
+#define L2E_SHARED_INFO                (L2E_TYPE_EXT | L2E_EXT_TEX(1) | 
L2E_EXT_XN | L2E_EXT_SHARED | L2E_BUFFERABLE | L2E_CACHEABLE | L2E_GUEST_AP_RW)
+#define L2E_DEVICE             (L2E_TYPE_EXT | L2E_EXT_TEX(1) | L2E_EXT_XN | 
L2E_EXT_SHARED | L2E_GUEST_AP_RW)
+
 #define PADDR_BITS              32
 #define PADDR_MASK              ((1UL << PADDR_BITS) - 1)
 
 #define VADDR_BITS              32
 #define VADDR_MASK              ((1UL << VADDR_BITS) - 1)
 
+#define TTB_S           (1 << 1)
+#define TTB_RGN_NC      (0 << 3)
+#define TTB_RGN_OC_WBWA (1 << 3)
+#define TTB_RGN_OC_WT   (2 << 3)
+#define TTB_RGN_OC_WB   (3 << 3)
+#define TTB_NOS         (1 << 5)
+#define TTB_IRGN_NC     ((0 << 0) | (0 << 6))
+#define TTB_IRGN_WBWA   ((0 << 0) | (1 << 6))
+#define TTB_IRGN_WT     ((1 << 0) | (0 << 6))
+#define TTB_IRGN_WB     ((1 << 0) | (1 << 6))
+
+
+#define TTB_FLAGS               (TTB_IRGN_WBWA | TTB_S | TTB_NOS | 
TTB_RGN_OC_WBWA)
+
+#define TTB_MASK               (~0x3FFF)
+
+#ifndef __ASSEMBLY__
+
+#include <asm/types.h>
+
+#define l2e_val(x)              ((x).l2e)
+#define l1e_val(x)              ((x).l1e)
+
+#define MK_L2E(x, flags)       ((l2e_t) { ((unsigned long)(x) & 
(~L2E_FLAG_MASK)) | flags } )
+#define MK_L1E(x, flags)       ((l1e_t) { ((unsigned long)(x) & 
(~L1E_FLAG_MASK)) | flags } )
+
+#define l1t_index(x)           (((unsigned long)(x) >> L1E_SHIFT) & 
(L1_TABLE_ENTRIES - 1))
+#define l2t_index(x)           (((unsigned long)(x) >> L2E_SHIFT) & 
(L2_TABLE_ENTRIES - 1))
+
+#define l1_linear_offset_xen(va)       \
+       (l1_linear_offset((xen_translation_table), va))
+
+typedef struct { unsigned long l2e; } l2e_t;
+typedef struct { unsigned long l1e; } l1e_t;
+
+static inline l1e_t *l1_linear_offset(l1e_t *l1e, unsigned long virt)
+{
+       return l1e + l1t_index(virt);
+}
+
+static inline l2e_t *l2_linear_offset(l1e_t *l1e, unsigned long virt)
+{
+        l2e_t *l2e;
+
+        l2e = (l2e_t *) (l1e_val(*l1e) & ~L1E_FLAG_MASK);
+        l2e = l2e + l2t_index(virt);
+
+        return l2e;
+}
+
+static inline unsigned int get_dacr(void)
+{
+       unsigned int val;
+
+       asm("mrc p15, 0, %0, c3, c0, 0" : "=r" (val) : : "cc");
+
+       return val;
+}
+
+
+static inline void set_dacr(unsigned long val)
+{
+       asm("mrc p15, 0, %0, c3, c0, 0" : "=r" (val) : : "cc");
+}
+
+
+static inline unsigned int get_ttbr(void)
+{
+       unsigned int val;
+       
+       asm("mrc p15, 0, %0, c2, c0, 0" : "=r" (val) : : "cc");
+
+       return val;
+}
+
+static inline void set_ttbr(unsigned int ttb)
+{
+       asm volatile("mcr p15, 0, %0, c2, c0, 0" : : "r" (ttb) : "cc");
+
+       isb();
+}
+
+static inline void set_contextidr(unsigned long id)
+{
+       asm("mcr     p15, 0, %0, c13, c0, 1" : : "r" (id) : "cc");
+}
+
+static inline unsigned int get_contextidr(void)
+{
+       unsigned int val;
+       
+       asm("mrc p15, 0, %0, c13, c0, 1" : "=r" (val) : : "cc");
+
+       return val;
+}
+
+#endif
 #endif
 

Attachment: patch03.diff
Description: Binary data

_______________________________________________
Xen-devel mailing list
Xen-devel@xxxxxxxxxxxxxxxxxxx
http://lists.xensource.com/xen-devel

 


Rackspace

Lists.xenproject.org is hosted with RackSpace, monitoring our
servers 24x7x365 and backed by RackSpace's Fanatical Support®.