1 /*-
2 * SPDX-License-Identifier: BSD-2-Clause
3 *
4 * Copyright (c) 2012 NetApp, Inc.
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY NETAPP, INC ``AS IS'' AND
17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED. IN NO EVENT SHALL NETAPP, INC OR CONTRIBUTORS BE LIABLE
20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * SUCH DAMAGE.
27 */
28 /*
29 * This file and its contents are supplied under the terms of the
30 * Common Development and Distribution License ("CDDL"), version 1.0.
31 * You may only use this file in accordance with the terms of version
32 * 1.0 of the CDDL.
33 *
34 * A full copy of the text of the CDDL should have accompanied this
35 * source. A copy of the CDDL is also available via the Internet at
36 * http://www.illumos.org/license/CDDL.
37 *
38 * Copyright 2020 Oxide Computer Company
39 */
40
41
42 #include <sys/param.h>
43 #include <sys/types.h>
44
45 #include <machine/vmm.h>
46 #include <vmmapi.h>
47
48 #include <stdio.h>
49 #include <stdlib.h>
50 #include <assert.h>
51
52 #include "bhyverun.h"
53 #include "spinup_ap.h"
54
55 #ifdef __FreeBSD__
56 static void
spinup_ap_realmode(struct vcpu * newcpu,uint64_t rip)57 spinup_ap_realmode(struct vcpu *newcpu, uint64_t rip)
58 {
59 int vector, error;
60 uint16_t cs;
61 uint64_t desc_base;
62 uint32_t desc_limit, desc_access;
63
64 vector = rip >> PAGE_SHIFT;
65
66 /*
67 * Update the %cs and %rip of the guest so that it starts
68 * executing real mode code at 'vector << 12'.
69 */
70 error = vm_set_register(newcpu, VM_REG_GUEST_RIP, 0);
71 assert(error == 0);
72
73 error = vm_get_desc(newcpu, VM_REG_GUEST_CS, &desc_base,
74 &desc_limit, &desc_access);
75 assert(error == 0);
76
77 desc_base = vector << PAGE_SHIFT;
78 error = vm_set_desc(newcpu, VM_REG_GUEST_CS,
79 desc_base, desc_limit, desc_access);
80 assert(error == 0);
81
82 cs = (vector << PAGE_SHIFT) >> 4;
83 error = vm_set_register(newcpu, VM_REG_GUEST_CS, cs);
84 assert(error == 0);
85 }
86 #endif /* __FreeBSD__ */
87
88 void
spinup_ap(struct vcpu * newcpu,uint64_t rip)89 spinup_ap(struct vcpu *newcpu, uint64_t rip)
90 {
91 int error;
92
93 error = vcpu_reset(newcpu);
94 assert(error == 0);
95
96 #ifdef __FreeBSD__
97 spinup_ap_realmode(newcpu, rip);
98
99 vm_resume_cpu(newcpu);
100 #endif
101 }
102