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