8322 nl: misleading-indentation

[unleashed/tickless.git] / usr / src / uts / i86pc / os / mlsetup.c

/*
 * CDDL HEADER START
 *
 * The contents of this file are subject to the terms of the
 * Common Development and Distribution License (the "License").
 * You may not use this file except in compliance with the License.
 *
 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
 * or http://www.opensolaris.org/os/licensing.
 * See the License for the specific language governing permissions
 * and limitations under the License.
 *
 * When distributing Covered Code, include this CDDL HEADER in each
 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
 * If applicable, add the following below this CDDL HEADER, with the
 * fields enclosed by brackets "[]" replaced with your own identifying
 * information: Portions Copyright [yyyy] [name of copyright owner]
 *
 * CDDL HEADER END
 */
/*
 * Copyright (c) 2012 Gary Mills
 *
 * Copyright (c) 1993, 2010, Oracle and/or its affiliates. All rights reserved.
 * Copyright (c) 2011 by Delphix. All rights reserved.
 * Copyright 2016 Joyent, Inc.
 */
/*
 * Copyright (c) 2010, Intel Corporation.
 * All rights reserved.
 */

#include <sys/types.h>
#include <sys/sysmacros.h>
#include <sys/disp.h>
#include <sys/promif.h>
#include <sys/clock.h>
#include <sys/cpuvar.h>
#include <sys/stack.h>
#include <vm/as.h>
#include <vm/hat.h>
#include <sys/reboot.h>
#include <sys/avintr.h>
#include <sys/vtrace.h>
#include <sys/proc.h>
#include <sys/thread.h>
#include <sys/cpupart.h>
#include <sys/pset.h>
#include <sys/copyops.h>
#include <sys/pg.h>
#include <sys/disp.h>
#include <sys/debug.h>
#include <sys/sunddi.h>
#include <sys/x86_archext.h>
#include <sys/privregs.h>
#include <sys/machsystm.h>
#include <sys/ontrap.h>
#include <sys/bootconf.h>
#include <sys/boot_console.h>
#include <sys/kdi_machimpl.h>
#include <sys/archsystm.h>
#include <sys/promif.h>
#include <sys/pci_cfgspace.h>
#include <sys/bootvfs.h>
#include <sys/tsc.h>
#ifdef __xpv
#include <sys/hypervisor.h>
#else
#include <sys/xpv_support.h>
#endif

/*
 * some globals for patching the result of cpuid
 * to solve problems w/ creative cpu vendors
 */

extern uint32_t cpuid_feature_ecx_include;
extern uint32_t cpuid_feature_ecx_exclude;
extern uint32_t cpuid_feature_edx_include;
extern uint32_t cpuid_feature_edx_exclude;

/*
 * Set console mode
 */
static void
set_console_mode(uint8_t val)
{
        struct bop_regs rp = {0};

        rp.eax.byte.ah = 0x0;
        rp.eax.byte.al = val;
        rp.ebx.word.bx = 0x0;

        BOP_DOINT(bootops, 0x10, &rp);
}


/*
 * Setup routine called right before main(). Interposing this function
 * before main() allows us to call it in a machine-independent fashion.
 */
void
mlsetup(struct regs *rp)
{
        u_longlong_t prop_value;
        extern struct classfuncs sys_classfuncs;
        extern disp_t cpu0_disp;
        extern char t0stack[];
        extern int post_fastreboot;
        extern uint64_t plat_dr_options;

        ASSERT_STACK_ALIGNED();

        /*
         * initialize cpu_self
         */
        cpu[0]->cpu_self = cpu[0];

#if defined(__xpv)
        /*
         * Point at the hypervisor's virtual cpu structure
         */
        cpu[0]->cpu_m.mcpu_vcpu_info = &HYPERVISOR_shared_info->vcpu_info[0];
#endif

        /*
         * check if we've got special bits to clear or set
         * when checking cpu features
         */

        if (bootprop_getval("cpuid_feature_ecx_include", &prop_value) != 0)
                cpuid_feature_ecx_include = 0;
        else
                cpuid_feature_ecx_include = (uint32_t)prop_value;

        if (bootprop_getval("cpuid_feature_ecx_exclude", &prop_value) != 0)
                cpuid_feature_ecx_exclude = 0;
        else
                cpuid_feature_ecx_exclude = (uint32_t)prop_value;

        if (bootprop_getval("cpuid_feature_edx_include", &prop_value) != 0)
                cpuid_feature_edx_include = 0;
        else
                cpuid_feature_edx_include = (uint32_t)prop_value;

        if (bootprop_getval("cpuid_feature_edx_exclude", &prop_value) != 0)
                cpuid_feature_edx_exclude = 0;
        else
                cpuid_feature_edx_exclude = (uint32_t)prop_value;

        /*
         * Initialize idt0, gdt0, ldt0_default, ktss0 and dftss.
         */
        init_desctbls();

        /*
         * lgrp_init() and possibly cpuid_pass1() need PCI config
         * space access
         */
#if defined(__xpv)
        if (DOMAIN_IS_INITDOMAIN(xen_info))
                pci_cfgspace_init();
#else
        pci_cfgspace_init();
        /*
         * Initialize the platform type from CPU 0 to ensure that
         * determine_platform() is only ever called once.
         */
        determine_platform();
#endif

        /*
         * The first lightweight pass (pass0) through the cpuid data
         * was done in locore before mlsetup was called.  Do the next
         * pass in C code.
         *
         * The x86_featureset is initialized here based on the capabilities
         * of the boot CPU.  Note that if we choose to support CPUs that have
         * different feature sets (at which point we would almost certainly
         * want to set the feature bits to correspond to the feature
         * minimum) this value may be altered.
         */
        cpuid_pass1(cpu[0], x86_featureset);

#if !defined(__xpv)
        if ((get_hwenv() & HW_XEN_HVM) != 0)
                xen_hvm_init();

        /*
         * Before we do anything with the TSCs, we need to work around
         * Intel erratum BT81.  On some CPUs, warm reset does not
         * clear the TSC.  If we are on such a CPU, we will clear TSC ourselves
         * here.  Other CPUs will clear it when we boot them later, and the
         * resulting skew will be handled by tsc_sync_master()/_slave();
         * note that such skew already exists and has to be handled anyway.
         *
         * We do this only on metal.  This same problem can occur with a
         * hypervisor that does not happen to virtualise a TSC that starts from
         * zero, regardless of CPU type; however, we do not expect hypervisors
         * that do not virtualise TSC that way to handle writes to TSC
         * correctly, either.
         */
        if (get_hwenv() == HW_NATIVE &&
            cpuid_getvendor(CPU) == X86_VENDOR_Intel &&
            cpuid_getfamily(CPU) == 6 &&
            (cpuid_getmodel(CPU) == 0x2d || cpuid_getmodel(CPU) == 0x3e) &&
            is_x86_feature(x86_featureset, X86FSET_TSC)) {
                (void) wrmsr(REG_TSC, 0UL);
        }

        /*
         * Patch the tsc_read routine with appropriate set of instructions,
         * depending on the processor family and architecure, to read the
         * time-stamp counter while ensuring no out-of-order execution.
         * Patch it while the kernel text is still writable.
         *
         * Note: tsc_read is not patched for intel processors whose family
         * is >6 and for amd whose family >f (in case they don't support rdtscp
         * instruction, unlikely). By default tsc_read will use cpuid for
         * serialization in such cases. The following code needs to be
         * revisited if intel processors of family >= f retains the
         * instruction serialization nature of mfence instruction.
         * Note: tsc_read is not patched for x86 processors which do
         * not support "mfence". By default tsc_read will use cpuid for
         * serialization in such cases.
         *
         * The Xen hypervisor does not correctly report whether rdtscp is
         * supported or not, so we must assume that it is not.
         */
        if ((get_hwenv() & HW_XEN_HVM) == 0 &&
            is_x86_feature(x86_featureset, X86FSET_TSCP))
                patch_tsc_read(TSC_TSCP);
        else if (cpuid_getvendor(CPU) == X86_VENDOR_AMD &&
            cpuid_getfamily(CPU) <= 0xf &&
            is_x86_feature(x86_featureset, X86FSET_SSE2))
                patch_tsc_read(TSC_RDTSC_MFENCE);
        else if (cpuid_getvendor(CPU) == X86_VENDOR_Intel &&
            cpuid_getfamily(CPU) <= 6 &&
            is_x86_feature(x86_featureset, X86FSET_SSE2))
                patch_tsc_read(TSC_RDTSC_LFENCE);

#endif  /* !__xpv */

#if defined(__i386) && !defined(__xpv)
        /*
         * Some i386 processors do not implement the rdtsc instruction,
         * or at least they do not implement it correctly. Patch them to
         * return 0.
         */
        if (!is_x86_feature(x86_featureset, X86FSET_TSC))
                patch_tsc_read(TSC_NONE);
#endif  /* __i386 && !__xpv */

#if defined(__amd64) && !defined(__xpv)
        patch_memops(cpuid_getvendor(CPU));
#endif  /* __amd64 && !__xpv */

#if !defined(__xpv)
        /* XXPV what, if anything, should be dorked with here under xen? */

        /*
         * While we're thinking about the TSC, let's set up %cr4 so that
         * userland can issue rdtsc, and initialize the TSC_AUX value
         * (the cpuid) for the rdtscp instruction on appropriately
         * capable hardware.
         */
        if (is_x86_feature(x86_featureset, X86FSET_TSC))
                setcr4(getcr4() & ~CR4_TSD);

        if (is_x86_feature(x86_featureset, X86FSET_TSCP))
                (void) wrmsr(MSR_AMD_TSCAUX, 0);

        /*
         * Let's get the other %cr4 stuff while we're here. Note, we defer
         * enabling CR4_SMAP until startup_end(); however, that's importantly
         * before we start other CPUs. That ensures that it will be synced out
         * to other CPUs.
         */
        if (is_x86_feature(x86_featureset, X86FSET_DE))
                setcr4(getcr4() | CR4_DE);

        if (is_x86_feature(x86_featureset, X86FSET_SMEP))
                setcr4(getcr4() | CR4_SMEP);
#endif /* __xpv */

        /*
         * initialize t0
         */
        t0.t_stk = (caddr_t)rp - MINFRAME;
        t0.t_stkbase = t0stack;
        t0.t_pri = maxclsyspri - 3;
        t0.t_schedflag = TS_LOAD | TS_DONT_SWAP;
        t0.t_procp = &p0;
        t0.t_plockp = &p0lock.pl_lock;
        t0.t_lwp = &lwp0;
        t0.t_forw = &t0;
        t0.t_back = &t0;
        t0.t_next = &t0;
        t0.t_prev = &t0;
        t0.t_cpu = cpu[0];
        t0.t_disp_queue = &cpu0_disp;
        t0.t_bind_cpu = PBIND_NONE;
        t0.t_bind_pset = PS_NONE;
        t0.t_bindflag = (uchar_t)default_binding_mode;
        t0.t_cpupart = &cp_default;
        t0.t_clfuncs = &sys_classfuncs.thread;
        t0.t_copyops = NULL;
        THREAD_ONPROC(&t0, CPU);

        lwp0.lwp_thread = &t0;
        lwp0.lwp_regs = (void *)rp;
        lwp0.lwp_procp = &p0;
        t0.t_tid = p0.p_lwpcnt = p0.p_lwprcnt = p0.p_lwpid = 1;

        p0.p_exec = NULL;
        p0.p_stat = SRUN;
        p0.p_flag = SSYS;
        p0.p_tlist = &t0;
        p0.p_stksize = 2*PAGESIZE;
        p0.p_stkpageszc = 0;
        p0.p_as = &kas;
        p0.p_lockp = &p0lock;
        p0.p_brkpageszc = 0;
        p0.p_t1_lgrpid = LGRP_NONE;
        p0.p_tr_lgrpid = LGRP_NONE;
        psecflags_default(&p0.p_secflags);

        sigorset(&p0.p_ignore, &ignoredefault);

        CPU->cpu_thread = &t0;
        bzero(&cpu0_disp, sizeof (disp_t));
        CPU->cpu_disp = &cpu0_disp;
        CPU->cpu_disp->disp_cpu = CPU;
        CPU->cpu_dispthread = &t0;
        CPU->cpu_idle_thread = &t0;
        CPU->cpu_flags = CPU_READY | CPU_RUNNING | CPU_EXISTS | CPU_ENABLE;
        CPU->cpu_dispatch_pri = t0.t_pri;

        CPU->cpu_id = 0;

        CPU->cpu_pri = 12;              /* initial PIL for the boot CPU */

        /*
         * The kernel doesn't use LDTs unless a process explicitly requests one.
         */
        p0.p_ldt_desc = null_sdesc;

        /*
         * Initialize thread/cpu microstate accounting
         */
        init_mstate(&t0, LMS_SYSTEM);
        init_cpu_mstate(CPU, CMS_SYSTEM);

        /*
         * Initialize lists of available and active CPUs.
         */
        cpu_list_init(CPU);

        pg_cpu_bootstrap(CPU);

        /*
         * Now that we have taken over the GDT, IDT and have initialized
         * active CPU list it's time to inform kmdb if present.
         */
        if (boothowto & RB_DEBUG)
                kdi_idt_sync();

        /*
         * Explicitly set console to text mode (0x3) if this is a boot
         * post Fast Reboot, and the console is set to CONS_SCREEN_TEXT.
         */
        if (post_fastreboot && boot_console_type(NULL) == CONS_SCREEN_TEXT)
                set_console_mode(0x3);

        /*
         * If requested (boot -d) drop into kmdb.
         *
         * This must be done after cpu_list_init() on the 64-bit kernel
         * since taking a trap requires that we re-compute gsbase based
         * on the cpu list.
         */
        if (boothowto & RB_DEBUGENTER)
                kmdb_enter();

        cpu_vm_data_init(CPU);

        rp->r_fp = 0;   /* terminate kernel stack traces! */

        prom_init("kernel", (void *)NULL);

        /* User-set option overrides firmware value. */
        if (bootprop_getval(PLAT_DR_OPTIONS_NAME, &prop_value) == 0) {
                plat_dr_options = (uint64_t)prop_value;
        }
#if defined(__xpv)
        /* No support of DR operations on xpv */
        plat_dr_options = 0;
#else   /* __xpv */
        /* Flag PLAT_DR_FEATURE_ENABLED should only be set by DR driver. */
        plat_dr_options &= ~PLAT_DR_FEATURE_ENABLED;
#ifndef __amd64
        /* Only enable CPU/memory DR on 64 bits kernel. */
        plat_dr_options &= ~PLAT_DR_FEATURE_MEMORY;
        plat_dr_options &= ~PLAT_DR_FEATURE_CPU;
#endif  /* __amd64 */
#endif  /* __xpv */

        /*
         * Get value of "plat_dr_physmax" boot option.
         * It overrides values calculated from MSCT or SRAT table.
         */
        if (bootprop_getval(PLAT_DR_PHYSMAX_NAME, &prop_value) == 0) {
                plat_dr_physmax = ((uint64_t)prop_value) >> PAGESHIFT;
        }

        /* Get value of boot_ncpus. */
        if (bootprop_getval(BOOT_NCPUS_NAME, &prop_value) != 0) {
                boot_ncpus = NCPU;
        } else {
                boot_ncpus = (int)prop_value;
                if (boot_ncpus <= 0 || boot_ncpus > NCPU)
                        boot_ncpus = NCPU;
        }

        /*
         * Set max_ncpus and boot_max_ncpus to boot_ncpus if platform doesn't
         * support CPU DR operations.
         */
        if (plat_dr_support_cpu() == 0) {
                max_ncpus = boot_max_ncpus = boot_ncpus;
        } else {
                if (bootprop_getval(PLAT_MAX_NCPUS_NAME, &prop_value) != 0) {
                        max_ncpus = NCPU;
                } else {
                        max_ncpus = (int)prop_value;
                        if (max_ncpus <= 0 || max_ncpus > NCPU) {
                                max_ncpus = NCPU;
                        }
                        if (boot_ncpus > max_ncpus) {
                                boot_ncpus = max_ncpus;
                        }
                }

                if (bootprop_getval(BOOT_MAX_NCPUS_NAME, &prop_value) != 0) {
                        boot_max_ncpus = boot_ncpus;
                } else {
                        boot_max_ncpus = (int)prop_value;
                        if (boot_max_ncpus <= 0 || boot_max_ncpus > NCPU) {
                                boot_max_ncpus = boot_ncpus;
                        } else if (boot_max_ncpus > max_ncpus) {
                                boot_max_ncpus = max_ncpus;
                        }
                }
        }

        /*
         * Initialize the lgrp framework
         */
        lgrp_init(LGRP_INIT_STAGE1);

        if (boothowto & RB_HALT) {
                prom_printf("unix: kernel halted by -h flag\n");
                prom_enter_mon();
        }

        ASSERT_STACK_ALIGNED();

        /*
         * Fill out cpu_ucode_info.  Update microcode if necessary.
         */
        ucode_check(CPU);

        if (workaround_errata(CPU) != 0)
                panic("critical workaround(s) missing for boot cpu");
}


void
mach_modpath(char *path, const char *filename)
{
        /*
         * Construct the directory path from the filename.
         */

        int len;
        char *p;
        const char isastr[] = "/amd64";
        size_t isalen = strlen(isastr);

        len = strlen(SYSTEM_BOOT_PATH "/kernel");
        (void) strcpy(path, SYSTEM_BOOT_PATH "/kernel ");
        path += len + 1;

        if ((p = strrchr(filename, '/')) == NULL)
                return;

        while (p > filename && *(p - 1) == '/')
                p--;    /* remove trailing '/' characters */
        if (p == filename)
                p++;    /* so "/" -is- the modpath in this case */

        /*
         * Remove optional isa-dependent directory name - the module
         * subsystem will put this back again (!)
         */
        len = p - filename;
        if (len > isalen &&
            strncmp(&filename[len - isalen], isastr, isalen) == 0)
                p -= isalen;

        /*
         * "/platform/mumblefrotz" + " " + MOD_DEFPATH
         */
        len += (p - filename) + 1 + strlen(MOD_DEFPATH) + 1;
        (void) strncpy(path, filename, p - filename);
}