| /* |
| * arch/aarch64/utils.S - basic utilities |
| * |
| * Copyright (C) 2015 ARM Limited. All rights reserved. |
| * |
| * Use of this source code is governed by a BSD-style license that can be |
| * found in the LICENSE.txt file. |
| */ |
| #include <cpu.h> |
| #include <linkage.h> |
| |
| .text |
| |
| /* |
| * Takes masked MPIDR in x0, returns logical id in x0 |
| * Returns -1 for unknown MPIDRs |
| * Sets the Z flag when CPU is primary |
| * Clobbers x1, x2, x3 |
| */ |
| ASM_FUNC(find_logical_id) |
| ldr x2, =id_table |
| mov x1, xzr |
| 1: mov x3, #NR_CPUS // check we haven't walked off the end of the array |
| cmp x1, x3 |
| b.gt 3f |
| ldr x3, [x2, x1, lsl #3] |
| cmp x3, x0 |
| b.eq 2f |
| add x1, x1, #1 |
| b 1b |
| 2: subs x0, x1, #0 |
| ret |
| 3: mov x0, #MPIDR_INVALID |
| ret |
| |
| /* |
| * Setup EL3 vectors |
| * x0: vector address |
| */ |
| ASM_FUNC(setup_vector) |
| msr VBAR_EL3, x0 |
| isb |
| ret |
