Thomas Gleixner | d2912cb | 2019-06-04 10:11:33 +0200 | [diff] [blame^] | 1 | /* SPDX-License-Identifier: GPL-2.0-only */ |
Vineet Gupta | c121c50 | 2013-01-18 15:12:20 +0530 | [diff] [blame] | 2 | /* |
| 3 | * ARC CPU startup Code |
| 4 | * |
| 5 | * Copyright (C) 2004, 2007-2010, 2011-2012 Synopsys, Inc. (www.synopsys.com) |
| 6 | * |
Vineet Gupta | c121c50 | 2013-01-18 15:12:20 +0530 | [diff] [blame] | 7 | * Vineetg: Dec 2007 |
| 8 | * -Check if we are running on Simulator or on real hardware |
| 9 | * to skip certain things during boot on simulator |
| 10 | */ |
| 11 | |
Vineet Gupta | ef680cd | 2014-03-07 18:08:11 +0530 | [diff] [blame] | 12 | #include <linux/linkage.h> |
Vineet Gupta | c121c50 | 2013-01-18 15:12:20 +0530 | [diff] [blame] | 13 | #include <asm/asm-offsets.h> |
| 14 | #include <asm/entry.h> |
Vineet Gupta | c121c50 | 2013-01-18 15:12:20 +0530 | [diff] [blame] | 15 | #include <asm/arcregs.h> |
Vineet Gupta | ef680cd | 2014-03-07 18:08:11 +0530 | [diff] [blame] | 16 | #include <asm/cache.h> |
Eugeniy Paltsev | 252f6e8 | 2019-01-16 14:29:50 +0300 | [diff] [blame] | 17 | #include <asm/irqflags.h> |
Vineet Gupta | ef680cd | 2014-03-07 18:08:11 +0530 | [diff] [blame] | 18 | |
| 19 | .macro CPU_EARLY_SETUP |
| 20 | |
| 21 | ; Setting up Vectror Table (in case exception happens in early boot |
| 22 | sr @_int_vec_base_lds, [AUX_INTR_VEC_BASE] |
| 23 | |
| 24 | ; Disable I-cache/D-cache if kernel so configured |
| 25 | lr r5, [ARC_REG_IC_BCR] |
| 26 | breq r5, 0, 1f ; I$ doesn't exist |
| 27 | lr r5, [ARC_REG_IC_CTRL] |
| 28 | #ifdef CONFIG_ARC_HAS_ICACHE |
| 29 | bclr r5, r5, 0 ; 0 - Enable, 1 is Disable |
| 30 | #else |
| 31 | bset r5, r5, 0 ; I$ exists, but is not used |
| 32 | #endif |
| 33 | sr r5, [ARC_REG_IC_CTRL] |
| 34 | |
| 35 | 1: |
| 36 | lr r5, [ARC_REG_DC_BCR] |
| 37 | breq r5, 0, 1f ; D$ doesn't exist |
| 38 | lr r5, [ARC_REG_DC_CTRL] |
| 39 | bclr r5, r5, 6 ; Invalidate (discard w/o wback) |
| 40 | #ifdef CONFIG_ARC_HAS_DCACHE |
| 41 | bclr r5, r5, 0 ; Enable (+Inv) |
| 42 | #else |
| 43 | bset r5, r5, 0 ; Disable (+Inv) |
| 44 | #endif |
| 45 | sr r5, [ARC_REG_DC_CTRL] |
| 46 | |
| 47 | 1: |
Eugeniy Paltsev | 252f6e8 | 2019-01-16 14:29:50 +0300 | [diff] [blame] | 48 | |
| 49 | #ifdef CONFIG_ISA_ARCV2 |
| 50 | ; Unaligned access is disabled at reset, so re-enable early as |
| 51 | ; gcc 7.3.1 (ARC GNU 2018.03) onwards generates unaligned access |
| 52 | ; by default |
| 53 | lr r5, [status32] |
Eugeniy Paltsev | 7655146 | 2019-01-30 19:32:41 +0300 | [diff] [blame] | 54 | #ifdef CONFIG_ARC_USE_UNALIGNED_MEM_ACCESS |
Eugeniy Paltsev | 252f6e8 | 2019-01-16 14:29:50 +0300 | [diff] [blame] | 55 | bset r5, r5, STATUS_AD_BIT |
Eugeniy Paltsev | 7655146 | 2019-01-30 19:32:41 +0300 | [diff] [blame] | 56 | #else |
| 57 | ; Although disabled at reset, bootloader might have enabled it |
| 58 | bclr r5, r5, STATUS_AD_BIT |
| 59 | #endif |
Eugeniy Paltsev | 252f6e8 | 2019-01-16 14:29:50 +0300 | [diff] [blame] | 60 | kflag r5 |
| 61 | #endif |
Vineet Gupta | ef680cd | 2014-03-07 18:08:11 +0530 | [diff] [blame] | 62 | .endm |
Vineet Gupta | c121c50 | 2013-01-18 15:12:20 +0530 | [diff] [blame] | 63 | |
Vineet Gupta | c121c50 | 2013-01-18 15:12:20 +0530 | [diff] [blame] | 64 | .section .init.text, "ax",@progbits |
Vineet Gupta | 3971cdc | 2015-10-09 11:26:12 +0530 | [diff] [blame] | 65 | |
| 66 | ;---------------------------------------------------------------- |
| 67 | ; Default Reset Handler (jumped into from Reset vector) |
| 68 | ; - Don't clobber r0,r1,r2 as they might have u-boot provided args |
| 69 | ; - Platforms can override this weak version if needed |
| 70 | ;---------------------------------------------------------------- |
| 71 | WEAK(res_service) |
| 72 | j stext |
| 73 | END(res_service) |
| 74 | |
| 75 | ;---------------------------------------------------------------- |
| 76 | ; Kernel Entry point |
| 77 | ;---------------------------------------------------------------- |
| 78 | ENTRY(stext) |
Vineet Gupta | c121c50 | 2013-01-18 15:12:20 +0530 | [diff] [blame] | 79 | |
Vineet Gupta | ef680cd | 2014-03-07 18:08:11 +0530 | [diff] [blame] | 80 | CPU_EARLY_SETUP |
Vineet Gupta | 05b016e | 2013-06-17 18:27:23 +0530 | [diff] [blame] | 81 | |
Vineet Gupta | 41195d2 | 2013-01-18 15:12:23 +0530 | [diff] [blame] | 82 | #ifdef CONFIG_SMP |
Vineet Gupta | 41195d2 | 2013-01-18 15:12:23 +0530 | [diff] [blame] | 83 | GET_CPU_ID r5 |
| 84 | cmp r5, 0 |
Vineet Gupta | 3971cdc | 2015-10-09 11:26:12 +0530 | [diff] [blame] | 85 | mov.nz r0, r5 |
Vineet Gupta | bf02454 | 2017-01-12 14:30:29 -0800 | [diff] [blame] | 86 | bz .Lmaster_proceed |
| 87 | |
Vineet Gupta | 3971cdc | 2015-10-09 11:26:12 +0530 | [diff] [blame] | 88 | ; Non-Masters wait for Master to boot enough and bring them up |
Vineet Gupta | bf02454 | 2017-01-12 14:30:29 -0800 | [diff] [blame] | 89 | ; when they resume, tail-call to entry point |
| 90 | mov blink, @first_lines_of_secondary |
| 91 | j arc_platform_smp_wait_to_boot |
| 92 | |
| 93 | .Lmaster_proceed: |
Vineet Gupta | 3971cdc | 2015-10-09 11:26:12 +0530 | [diff] [blame] | 94 | #endif |
| 95 | |
Vineet Gupta | c121c50 | 2013-01-18 15:12:20 +0530 | [diff] [blame] | 96 | ; Clear BSS before updating any globals |
| 97 | ; XXX: use ZOL here |
| 98 | mov r5, __bss_start |
Vineet Gupta | bef444a | 2014-04-17 17:13:26 +0530 | [diff] [blame] | 99 | sub r6, __bss_stop, r5 |
| 100 | lsr.f lp_count, r6, 2 |
| 101 | lpnz 1f |
| 102 | st.ab 0, [r5, 4] |
Vineet Gupta | c121c50 | 2013-01-18 15:12:20 +0530 | [diff] [blame] | 103 | 1: |
Vineet Gupta | c121c50 | 2013-01-18 15:12:20 +0530 | [diff] [blame] | 104 | |
Vineet Gupta | 59ed941 | 2014-01-16 15:01:24 +0530 | [diff] [blame] | 105 | ; Uboot - kernel ABI |
| 106 | ; r0 = [0] No uboot interaction, [1] cmdline in r2, [2] DTB in r2 |
Eugeniy Paltsev | a66f2e5 | 2019-02-14 18:07:44 +0300 | [diff] [blame] | 107 | ; r1 = magic number (always zero as of now) |
Vineet Gupta | 59ed941 | 2014-01-16 15:01:24 +0530 | [diff] [blame] | 108 | ; r2 = pointer to uboot provided cmdline or external DTB in mem |
Eugeniy Paltsev | a66f2e5 | 2019-02-14 18:07:44 +0300 | [diff] [blame] | 109 | ; These are handled later in handle_uboot_args() |
Vineet Gupta | 59ed941 | 2014-01-16 15:01:24 +0530 | [diff] [blame] | 110 | st r0, [@uboot_tag] |
Eugeniy Paltsev | edb64bc | 2019-02-25 20:16:01 +0300 | [diff] [blame] | 111 | st r1, [@uboot_magic] |
Vineet Gupta | 59ed941 | 2014-01-16 15:01:24 +0530 | [diff] [blame] | 112 | st r2, [@uboot_arg] |
Vineet Gupta | c121c50 | 2013-01-18 15:12:20 +0530 | [diff] [blame] | 113 | |
Vineet Gupta | c121c50 | 2013-01-18 15:12:20 +0530 | [diff] [blame] | 114 | ; setup "current" tsk and optionally cache it in dedicated r25 |
| 115 | mov r9, @init_task |
| 116 | SET_CURR_TASK_ON_CPU r9, r0 ; r9 = tsk, r0 = scratch |
| 117 | |
| 118 | ; setup stack (fp, sp) |
| 119 | mov fp, 0 |
| 120 | |
| 121 | ; tsk->thread_info is really a PAGE, whose bottom hoists stack |
| 122 | GET_TSK_STACK_BASE r9, sp ; r9 = tsk, sp = stack base(output) |
| 123 | |
| 124 | j start_kernel ; "C" entry point |
Vineet Gupta | 3971cdc | 2015-10-09 11:26:12 +0530 | [diff] [blame] | 125 | END(stext) |
Vineet Gupta | 41195d2 | 2013-01-18 15:12:23 +0530 | [diff] [blame] | 126 | |
| 127 | #ifdef CONFIG_SMP |
| 128 | ;---------------------------------------------------------------- |
| 129 | ; First lines of code run by secondary before jumping to 'C' |
| 130 | ;---------------------------------------------------------------- |
Chen Gang | 8f5d221 | 2013-10-23 10:16:38 +0800 | [diff] [blame] | 131 | .section .text, "ax",@progbits |
Vineet Gupta | 3971cdc | 2015-10-09 11:26:12 +0530 | [diff] [blame] | 132 | ENTRY(first_lines_of_secondary) |
Vineet Gupta | 41195d2 | 2013-01-18 15:12:23 +0530 | [diff] [blame] | 133 | |
| 134 | ; setup per-cpu idle task as "current" on this CPU |
| 135 | ld r0, [@secondary_idle_tsk] |
| 136 | SET_CURR_TASK_ON_CPU r0, r1 |
| 137 | |
| 138 | ; setup stack (fp, sp) |
| 139 | mov fp, 0 |
| 140 | |
| 141 | ; set it's stack base to tsk->thread_info bottom |
| 142 | GET_TSK_STACK_BASE r0, sp |
| 143 | |
| 144 | j start_kernel_secondary |
Vineet Gupta | 3971cdc | 2015-10-09 11:26:12 +0530 | [diff] [blame] | 145 | END(first_lines_of_secondary) |
Vineet Gupta | 41195d2 | 2013-01-18 15:12:23 +0530 | [diff] [blame] | 146 | #endif |