1/*- 2 * Copyright (c) 2016 Ruslan Bukin <br@bsdpad.com> 3 * All rights reserved. 4 * 5 * Portions of this software were developed by SRI International and the 6 * University of Cambridge Computer Laboratory under DARPA/AFRL contract 7 * FA8750-10-C-0237 ("CTSRD"), as part of the DARPA CRASH research programme. 8 * 9 * Portions of this software were developed by the University of Cambridge 10 * Computer Laboratory as part of the CTSRD Project, with support from the 11 * UK Higher Education Innovation Fund (HEIF). 12 * 13 * Redistribution and use in source and binary forms, with or without 14 * modification, are permitted provided that the following conditions 15 * are met: 16 * 1. Redistributions of source code must retain the above copyright 17 * notice, this list of conditions and the following disclaimer. 18 * 2. Redistributions in binary form must reproduce the above copyright 19 * notice, this list of conditions and the following disclaimer in the 20 * documentation and/or other materials provided with the distribution. 21 * 22 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 23 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 24 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 25 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 26 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 27 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 28 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 29 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 30 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 31 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 32 * SUCH DAMAGE. 33 * 34 * $FreeBSD$ 35 */ 36 37#include <machine/asm.h> 38 39#define VPECONF0_MVP (1 << 1) 40#define VPECONF0_VPA (1 << 0) 41 42 .set noreorder 43 44#ifdef SMP 45/* 46 * This function must be implemented in assembly because it is called early 47 * in AP boot without a valid stack. 48 */ 49LEAF(platform_processor_id) 50 .set push 51 .set mips32r2 52 mfc0 v0, $15, 1 53 jr ra 54 andi v0, 0x1f 55 .set pop 56END(platform_processor_id) 57 58LEAF(malta_cpu_configure) 59 .set push 60 .set mips32r2 61 .set noat 62 li t2, (VPECONF0_MVP | VPECONF0_VPA) 63 move $1, t2 64 jr ra 65 .word 0x41810000 | (1 << 11) | 2 # mttc0 t2, $1, 2 66 .set pop 67END(malta_cpu_configure) 68 69/* 70 * Called on APs to wait until they are told to launch. 71 */ 72LEAF(malta_ap_wait) 73 jal platform_processor_id 74 nop 75 76 PTR_LA t1, malta_ap_boot 77 781: 79 ll t0, 0(t1) 80 bne v0, t0, 1b 81 nop 82 83 move t0, zero 84 sc t0, 0(t1) 85 86 beqz t0, 1b 87 nop 88 89 j mpentry 90 nop 91END(malta_ap_wait) 92#endif 93