sun4/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 2009 Sun Microsystems, Inc.  All rights reserved.
 * Use is subject to license terms.
 */

#include <sys/types.h>
#include <sys/systm.h>
#include <sys/archsystm.h>
#include <sys/machsystm.h>
#include <sys/disp.h>
#include <sys/autoconf.h>
#include <sys/promif.h>
#include <sys/prom_plat.h>
#include <sys/promimpl.h>
#include <sys/platform_module.h>
#include <sys/clock.h>
#include <sys/pte.h>
#include <sys/scb.h>
#include <sys/cpu.h>
#include <sys/stack.h>
#include <sys/intreg.h>
#include <sys/ivintr.h>
#include <vm/as.h>
#include <vm/hat_sfmmu.h>
#include <sys/reboot.h>
#include <sys/sysmacros.h>
#include <sys/vtrace.h>
#include <sys/trap.h>
#include <sys/machtrap.h>
#include <sys/privregs.h>
#include <sys/machpcb.h>
#include <sys/proc.h>
#include <sys/cpupart.h>
#include <sys/pset.h>
#include <sys/cpu_module.h>
#include <sys/copyops.h>
#include <sys/panic.h>
#include <sys/bootconf.h>   /* for bootops */
#include <sys/pg.h>
#include <sys/kdi.h>
#include <sys/fpras.h>

#include <sys/prom_debug.h>
#include <sys/debug.h>

#include <sys/sunddi.h>
#include <sys/lgrp.h>
#include <sys/traptrace.h>

#include <sys/kobj_impl.h>
#include <sys/kdi_machimpl.h>

/*
 * External Routines:
 */
extern void map_wellknown_devices(void);
extern void hsvc_setup(void);
extern void mach_descrip_startup_init(void);
extern void mach_soft_state_init(void);

int dcache_size;
int dcache_linesize;
int icache_size;
int icache_linesize;
int ecache_size;
int ecache_alignsize;
int ecache_associativity;
int ecache_setsize;         /* max possible e$ setsize */
int cpu_setsize;            /* max e$ setsize of configured cpus */
int dcache_line_mask;       /* spitfire only */
int vac_size;           /* cache size in bytes */
uint_t  vac_mask;           /* VAC alignment consistency mask */
int vac_shift;          /* log2(vac_size) for ppmapout() */
int vac = 0;    /* virtual address cache type (none == 0) */

/*
 * fpRAS.  An individual sun4* machine class (or perhaps subclass,
 * eg sun4u/cheetah) must set fpras_implemented to indicate that it implements
 * the fpRAS feature.  The feature can be suppressed by setting fpras_disable
 * or the mechanism can be disabled for individual copy operations with
 * fpras_disableids.  All these are checked in post_startup() code so
 * fpras_disable and fpras_disableids can be set in /etc/system.
 * If/when fpRAS is implemented on non-sun4 architectures these
 * definitions will need to move up to the common level.
 */
int fpras_implemented;
int fpras_disable;
int fpras_disableids;

/*
 * Static Routines:
 */
static void kern_splr_preprom(void);
static void kern_splx_postprom(void);

/*
 * 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, kfpu_t *fp)
{
    struct machpcb *mpcb;

    extern char t0stack[];
    extern struct classfuncs sys_classfuncs;
    extern disp_t cpu0_disp;
    unsigned long long pa;

#ifdef TRAPTRACE
    TRAP_TRACE_CTL *ctlp;
#endif /* TRAPTRACE */

    /* drop into kmdb on boot -d */
    if (boothowto & RB_DEBUGENTER)
        kmdb_enter();

    /*
     * initialize cpu_self
     */
    cpu0.cpu_self = &cpu0;

    /*
     * initialize t0
     */
    t0.t_stk = (caddr_t)rp - REGOFF;
    /* Can't use va_to_pa here - wait until prom_ initialized */
    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 = &cpu0;           /* loaded by _start */
    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_procp = &p0;
    lwp0.lwp_regs = (void *)rp;
    t0.t_tid = p0.p_lwpcnt = p0.p_lwprcnt = p0.p_lwpid = 1;

    mpcb = lwptompcb(&lwp0);
    mpcb->mpcb_fpu = fp;
    mpcb->mpcb_fpu->fpu_q = mpcb->mpcb_fpu_q;
    mpcb->mpcb_thread = &t0;
    lwp0.lwp_fpu = (void *)mpcb->mpcb_fpu;

    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_utraps = NULL;
    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;
    CPU->cpu_dispthread = &t0;
    bzero(&cpu0_disp, sizeof (disp_t));
    CPU->cpu_disp = &cpu0_disp;
    CPU->cpu_disp->disp_cpu = CPU;
    CPU->cpu_idle_thread = &t0;
    CPU->cpu_flags = CPU_RUNNING;
    CPU->cpu_id = getprocessorid();
    CPU->cpu_dispatch_pri = t0.t_pri;

    /*
     * 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);

    cpu_vm_data_init(CPU);

    pg_cpu_bootstrap(CPU);

    (void) prom_set_preprom(kern_splr_preprom);
    (void) prom_set_postprom(kern_splx_postprom);
    PRM_INFO("mlsetup: now ok to call prom_printf");

    mpcb->mpcb_pa = va_to_pa(t0.t_stk);

    /*
     * Claim the physical and virtual resources used by panicbuf,
     * then map panicbuf.  This operation removes the phys and
     * virtual addresses from the free lists.
     */
    if (prom_claim_virt(PANICBUFSIZE, panicbuf) != panicbuf)
        prom_panic("Can't claim panicbuf virtual address");

    if (prom_retain("panicbuf", PANICBUFSIZE, MMU_PAGESIZE, &pa) != 0)
        prom_panic("Can't allocate retained panicbuf physical address");

    if (prom_map_phys(-1, PANICBUFSIZE, panicbuf, pa) != 0)
        prom_panic("Can't map panicbuf");

    PRM_DEBUG(panicbuf);
    PRM_DEBUG(pa);

    /*
     * Negotiate hypervisor services, if any
     */
    hsvc_setup();
    mach_soft_state_init();

#ifdef TRAPTRACE
    /*
     * initialize the trap trace buffer for the boot cpu
     * XXX todo, dynamically allocate this buffer too
     */
    ctlp = &trap_trace_ctl[CPU->cpu_id];
    ctlp->d.vaddr_base = trap_tr0;
    ctlp->d.offset = ctlp->d.last_offset = 0;
    ctlp->d.limit = TRAP_TSIZE;     /* XXX dynamic someday */
    ctlp->d.paddr_base = va_to_pa(trap_tr0);
#endif /* TRAPTRACE */

    /*
     * Initialize the Machine Description kernel framework
     */

    mach_descrip_startup_init();

    /*
     * initialize HV trap trace buffer for the boot cpu
     */
    mach_htraptrace_setup(CPU->cpu_id);
    mach_htraptrace_configure(CPU->cpu_id);

    /*
     * lgroup framework initialization. This must be done prior
     * to devices being mapped.
     */
    lgrp_init(LGRP_INIT_STAGE1);

    cpu_setup();

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

    setcputype();
    map_wellknown_devices();
    setcpudelay();
}

/*
 * These routines are called immediately before and
 * immediately after calling into the firmware.  The
 * firmware is significantly confused by preemption -
 * particularly on MP machines - but also on UP's too.
 */

static int saved_spl;

static void
kern_splr_preprom(void)
{
    saved_spl = spl7();
}

static void
kern_splx_postprom(void)
{
    splx(saved_spl);
}


/*
 * WARNING
 * The code fom here to the end of mlsetup.c runs before krtld has
 * knitted unix and genunix together.  It can call routines in unix,
 * but calls into genunix will fail spectacularly.  More specifically,
 * calls to prom_*, bop_* and str* will work, everything else is
 * caveat emptor.
 *
 * Also note that while #ifdef sun4u is generally a bad idea, they
 * exist here to concentrate the dangerous code into a single file.
 */

static char *
getcpulist(void)
{
    pnode_t node;
    /* big enough for OBP_NAME and for a reasonably sized OBP_COMPATIBLE. */
    static char cpubuf[5 * OBP_MAXDRVNAME];
    int nlen, clen, i;
#ifdef  sun4u
    char dname[OBP_MAXDRVNAME];
#endif

    node = prom_findnode_bydevtype(prom_rootnode(), OBP_CPU);
    if (node != OBP_NONODE && node != OBP_BADNODE) {
        if ((nlen = prom_getproplen(node, OBP_NAME)) <= 0 ||
            nlen > sizeof (cpubuf) ||
            prom_getprop(node, OBP_NAME, cpubuf) <= 0)
            prom_panic("no name in cpu node");

        /* nlen includes the terminating null character */
#ifdef  sun4v
        if ((clen = prom_getproplen(node, OBP_COMPATIBLE)) > 0) {
#else   /* sun4u */
        /*
         * For the CMT case, need check the parent "core"
         * node for the compatible property.
         */
        if ((clen = prom_getproplen(node, OBP_COMPATIBLE)) > 0 ||
            ((node = prom_parentnode(node)) != OBP_NONODE &&
            node != OBP_BADNODE &&
            (clen = prom_getproplen(node, OBP_COMPATIBLE)) > 0 &&
            prom_getprop(node, OBP_DEVICETYPE, dname) > 0 &&
            strcmp(dname, "core") == 0)) {
#endif
            if ((clen + nlen) > sizeof (cpubuf))
                prom_panic("cpu node \"compatible\" too long");
            /* read in compatible, leaving space for ':' */
            if (prom_getprop(node, OBP_COMPATIBLE,
                &cpubuf[nlen]) != clen)
                prom_panic("cpu node \"compatible\" error");
            clen += nlen;   /* total length */
            /* convert all null characters to ':' */
            clen--; /* except the final one... */
            for (i = 0; i < clen; i++)
                if (cpubuf[i] == '\0')
                    cpubuf[i] = ':';
        }
#ifdef  sun4u
        /*
         * Some PROMs return SUNW,UltraSPARC when they actually have
         * SUNW,UltraSPARC-II cpus. SInce we're now filtering out all
         * SUNW,UltraSPARC systems during the boot phase, we can safely
         * point the auxv CPU value at SUNW,UltraSPARC-II.
         */
        if (strcmp("SUNW,UltraSPARC", cpubuf) == 0)
            (void) strcpy(cpubuf, "SUNW,UltraSPARC-II");
#endif
        return (cpubuf);
    } else
        return (NULL);
}

/*
 * called immediately from _start to stich the
 * primary modules together
 */
void
kobj_start(void *cif)
{
    Ehdr *ehdr;
    Phdr *phdr;
    uint32_t eadr, padr;
    val_t bootaux[BA_NUM];
    int i;

    prom_init("kernel", cif);
    bop_init();
#ifdef  DEBUG
    if (bop_getproplen("stop-me") != -1)
        prom_enter_mon();
#endif

    if (bop_getprop("elfheader-address", (caddr_t)&eadr) == -1)
        prom_panic("no ELF image");
    ehdr = (Ehdr *)(uintptr_t)eadr;
    for (i = 0; i < BA_NUM; i++)
        bootaux[i].ba_val = NULL;
    bootaux[BA_PHNUM].ba_val = ehdr->e_phnum;
    bootaux[BA_PHENT].ba_val = ehdr->e_phentsize;
    bootaux[BA_LDNAME].ba_ptr = NULL;

    padr = eadr + ehdr->e_phoff;
    bootaux[BA_PHDR].ba_ptr = (void *)(uintptr_t)padr;
    for (i = 0; i < ehdr->e_phnum; i++) {
        phdr = (Phdr *)((uintptr_t)padr + i * ehdr->e_phentsize);
        if (phdr->p_type == PT_DYNAMIC) {
            bootaux[BA_DYNAMIC].ba_ptr = (void *)phdr->p_vaddr;
            break;
        }
    }

    bootaux[BA_LPAGESZ].ba_val = MMU_PAGESIZE4M;
    bootaux[BA_PAGESZ].ba_val = MMU_PAGESIZE;
    bootaux[BA_IFLUSH].ba_val = 1;
    bootaux[BA_CPU].ba_ptr = getcpulist();
    bootaux[BA_MMU].ba_ptr = NULL;

    kobj_init(cif, NULL, bootops, bootaux);

    /* kernel stitched together; we can now test #pragma's */
    if (&plat_setprop_enter != NULL) {
        prom_setprop_enter = &plat_setprop_enter;
        prom_setprop_exit = &plat_setprop_exit;
        ASSERT(prom_setprop_exit != NULL);
    }

}

/*
 * Create modpath from kernel name.
 * If we booted:
 *  /platform/`uname -i`/kernel/sparcv9/unix
 *   or
 *  /platform/`uname -m`/kernel/sparcv9/unix
 *
 * then make the modpath:
 *  /platform/`uname -i`/kernel /platform/`uname -m`/kernel
 *
 * otherwise, make the modpath the dir the kernel was
 * loaded from, minus any sparcv9 extension
 *
 * note the sparcv9 dir is optional since a unix -> sparcv9/unix
 * symlink is available as a shortcut.
 */
void
mach_modpath(char *path, const char *fname)
{
    char *p;
    int len, compat;
    const char prefix[] = "/platform/";
    char platname[MAXPATHLEN];
#ifdef  sun4u
    char defname[] = "sun4u";
#else
    char defname[] = "sun4v";
#endif
    const char suffix[] = "/kernel";
    const char isastr[] = "/sparcv9";

    /*
     * check for /platform
     */
    p = (char *)fname;
    if (strncmp(p, prefix, sizeof (prefix) - 1) != 0)
        goto nopath;
    p += sizeof (prefix) - 1;

    /*
     * check for the default name or the platform name.
     * also see if we used the 'compatible' name
     * (platname == default)
     */
    (void) bop_getprop("impl-arch-name", platname);
    compat = strcmp(platname, defname) == 0;
    len = strlen(platname);
    if (strncmp(p, platname, len) == 0)
        p += len;
    else if (strncmp(p, defname, sizeof (defname) - 1) == 0)
        p += sizeof (defname) - 1;
    else
        goto nopath;

    /*
     * check for /kernel/sparcv9 or just /kernel
     */
    if (strncmp(p, suffix, sizeof (suffix) - 1) != 0)
        goto nopath;
    p += sizeof (suffix) - 1;
    if (strncmp(p, isastr, sizeof (isastr) - 1) == 0)
        p += sizeof (isastr) - 1;

    /*
     * check we're at the last component
     */
    if (p != strrchr(fname, '/'))
        goto nopath;

    /*
     * everything is kosher; setup modpath
     */
    (void) strcpy(path, "/platform/");
    (void) strcat(path, platname);
    (void) strcat(path, "/kernel");
    if (!compat) {
        (void) strcat(path, " /platform/");
        (void) strcat(path, defname);
        (void) strcat(path, "/kernel");
    }
    return;

nopath:
    /*
     * Construct the directory path from the filename.
     */
    if ((p = strrchr(fname, '/')) == NULL)
        return;

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

    /*
     * Remove optional isa-dependent directory name - the module
     * subsystem will put this back again (!)
     */
    len = p - fname;
    if (len > sizeof (isastr) - 1 &&
        strncmp(&fname[len - (sizeof (isastr) - 1)], isastr,
        sizeof (isastr) - 1) == 0)
        p -= sizeof (isastr) - 1;
    (void) strncpy(path, fname, p - fname);
}