/* * 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 2007 Sun Microsystems, Inc. All rights reserved. * Use is subject to license terms. */ #pragma ident "%Z%%M% %I% %E% SMI" #define PSMI_1_5 #include #include #include #include #include #include #include #include #include #include #include #include #define NSEC_IN_SEC 1000000000 /* * Local Function Prototypes */ static void uppc_softinit(void); static void uppc_picinit(); static int uppc_clkinit(int); static int uppc_addspl(int irqno, int ipl, int min_ipl, int max_ipl); static int uppc_delspl(int irqno, int ipl, int min_ipl, int max_ipl); static processorid_t uppc_get_next_processorid(processorid_t cpu_id); static int uppc_get_clockirq(int ipl); static int uppc_probe(void); static int uppc_translate_irq(dev_info_t *dip, int irqno); static void uppc_shutdown(int cmd, int fcn); static void uppc_preshutdown(int cmd, int fcn); static int uppc_init_acpi(void); static void uppc_setspl(int); static int uppc_intr_enter(int, int *); static void uppc_intr_exit(int, int); static hrtime_t uppc_gethrtime(); static int uppc_acpi_irq_configure(acpi_psm_lnk_t *acpipsmlnkp, dev_info_t *dip, int *pci_irqp, iflag_t *intr_flagp); /* * Global Data */ static struct standard_pic pics0; int uppc_use_acpi = 1; /* Use ACPI by default */ int uppc_enable_acpi = 0; /* * For interrupt link devices, if uppc_unconditional_srs is set, an irq resource * will be assigned (via _SRS). If it is not set, use the current * irq setting (via _CRS), but only if that irq is in the set of possible * irqs (returned by _PRS) for the device. */ int uppc_unconditional_srs = 1; /* * For interrupt link devices, if uppc_prefer_crs is set when we are * assigning an IRQ resource to a device, prefer the current IRQ setting * over other possible irq settings under same conditions. */ int uppc_prefer_crs = 1; int uppc_verbose = 0; /* flag definitions for uppc_verbose */ #define UPPC_VERBOSE_IRQ_FLAG 0x00000001 #define UPPC_VERBOSE_POWEROFF_FLAG 0x00000002 #define UPPC_VERBOSE_POWEROFF_PAUSE_FLAG 0x00000004 #define UPPC_VERBOSE_IRQ(fmt) \ if (uppc_verbose & UPPC_VERBOSE_IRQ_FLAG) \ cmn_err fmt; #define UPPC_VERBOSE_POWEROFF(fmt) \ if (uppc_verbose & UPPC_VERBOSE_POWEROFF_FLAG) \ prom_printf fmt; uchar_t uppc_reserved_irqlist[MAX_ISA_IRQ + 1]; static uint16_t uppc_irq_shared_table[MAX_ISA_IRQ + 1]; /* * Contains SCI irqno from FADT after initialization */ static int uppc_sci = -1; /* * Local Static Data */ static lock_t uppc_gethrtime_lock; static hrtime_t uppc_lasthrtime; #ifdef UPPC_DEBUG #define DENT 0x0001 static int uppc_debug = 0; #endif static struct psm_ops uppc_ops = { uppc_probe, /* psm_probe */ uppc_softinit, /* psm_init */ uppc_picinit, /* psm_picinit */ uppc_intr_enter, /* psm_intr_enter */ uppc_intr_exit, /* psm_intr_exit */ uppc_setspl, /* psm_setspl */ uppc_addspl, /* psm_addspl */ uppc_delspl, /* psm_delspl */ (int (*)(processorid_t))NULL, /* psm_disable_intr */ (void (*)(processorid_t))NULL, /* psm_enable_intr */ (int (*)(int))NULL, /* psm_softlvl_to_irq */ (void (*)(int))NULL, /* psm_set_softintr */ (void (*)(processorid_t))NULL, /* psm_set_idlecpu */ (void (*)(processorid_t))NULL, /* psm_unset_idlecpu */ uppc_clkinit, /* psm_clkinit */ uppc_get_clockirq, /* psm_get_clockirq */ (void (*)(void))NULL, /* psm_hrtimeinit */ uppc_gethrtime, /* psm_gethrtime */ uppc_get_next_processorid, /* psm_get_next_processorid */ (int (*)(processorid_t, caddr_t))NULL, /* psm_cpu_start */ (int (*)(void))NULL, /* psm_post_cpu_start */ uppc_shutdown, /* psm_shutdown */ (int (*)(int, int))NULL, /* psm_get_ipivect */ (void (*)(processorid_t, int))NULL, /* psm_send_ipi */ uppc_translate_irq, /* psm_translate_irq */ (void (*)(int, char *))NULL, /* psm_notify_error */ (void (*)(int msg))NULL, /* psm_notify_func */ (void (*)(hrtime_t time))NULL, /* psm_timer_reprogram */ (void (*)(void))NULL, /* psm_timer_enable */ (void (*)(void))NULL, /* psm_timer_disable */ (void (*)(void *arg))NULL, /* psm_post_cyclic_setup */ uppc_preshutdown, /* psm_preshutdown */ (int (*)(dev_info_t *, ddi_intr_handle_impl_t *, psm_intr_op_t, int *))NULL /* psm_intr_ops */ }; static struct psm_info uppc_info = { PSM_INFO_VER01_5, /* version */ PSM_OWN_SYS_DEFAULT, /* ownership */ (struct psm_ops *)&uppc_ops, /* operation */ "uppc", /* machine name */ "UniProcessor PC", /* machine descriptions */ }; /* * Configuration Data */ /* * This is the loadable module wrapper. */ #include static void *uppc_hdlp; int _init(void) { return (psm_mod_init(&uppc_hdlp, &uppc_info)); } int _fini(void) { return (psm_mod_fini(&uppc_hdlp, &uppc_info)); } int _info(struct modinfo *modinfop) { return (psm_mod_info(&uppc_hdlp, &uppc_info, modinfop)); } /* * Autoconfiguration Routines */ static int uppc_probe(void) { return (PSM_SUCCESS); } static void uppc_softinit(void) { struct standard_pic *pp; int i; pp = &pics0; if (uppc_use_acpi && uppc_init_acpi()) { build_reserved_irqlist((uchar_t *)uppc_reserved_irqlist); for (i = 0; i <= MAX_ISA_IRQ; i++) uppc_irq_shared_table[i] = 0; uppc_enable_acpi = 1; } /* * initialize the ipl mask */ for (i = 0; i < (MAXIPL << 1); i += 2) { /* enable slave lines on master */ pp->c_iplmask[i] = 0xff; pp->c_iplmask[i+1] = (0xff & ~(1 << MASTERLINE)); } } /*ARGSUSED*/ static int uppc_clkinit(int hertz) { ulong_t clkticks = PIT_HZ / hz; if (hertz == 0) return (0); /* One shot mode not supported */ /* * program timer 0 */ outb(PITCTL_PORT, (PIT_C0|PIT_NDIVMODE|PIT_READMODE)); outb(PITCTR0_PORT, (uchar_t)clkticks); outb(PITCTR0_PORT, (uchar_t)(clkticks>>8)); return (NSEC_IN_SEC / hertz); } static void uppc_picinit() { picsetup(); /* * If a valid SCI is present, manually addspl() * since we're not set-up early enough in boot * to do it "conventionally" (via add_avintr) */ if (uppc_sci >= 0) (void) uppc_addspl(uppc_sci, SCI_IPL, SCI_IPL, SCI_IPL); } /*ARGSUSED3*/ static int uppc_addspl(int irqno, int ipl, int min_ipl, int max_ipl) { struct standard_pic *pp; int i; int startidx; uchar_t vectmask; if (irqno <= MAX_ISA_IRQ) atomic_add_16(&uppc_irq_shared_table[irqno], 1); if (ipl != min_ipl) return (0); if (irqno > 7) { vectmask = 1 << (irqno - 8); startidx = (ipl << 1); } else { vectmask = 1 << irqno; startidx = (ipl << 1) + 1; } /* * mask intr same or above ipl * level MAXIPL has all intr off as init. default */ pp = &pics0; for (i = startidx; i < (MAXIPL << 1); i += 2) { if (pp->c_iplmask[i] & vectmask) break; pp->c_iplmask[i] |= vectmask; } /* * unmask intr below ipl */ for (i = startidx-2; i >= 0; i -= 2) { if (!(pp->c_iplmask[i] & vectmask)) break; pp->c_iplmask[i] &= ~vectmask; } return (0); } static int uppc_delspl(int irqno, int ipl, int min_ipl, int max_ipl) { struct standard_pic *pp; int i; uchar_t vectmask; if (irqno <= MAX_ISA_IRQ) atomic_add_16(&uppc_irq_shared_table[irqno], -1); /* * skip if we are not deleting the last handler * and the ipl is higher than minimum */ if ((max_ipl != PSM_INVALID_IPL) && (ipl >= min_ipl)) return (0); if (irqno > 7) { vectmask = 1 << (irqno - 8); i = 0; } else { vectmask = 1 << irqno; i = 1; } pp = &pics0; /* * check any handlers left for this irqno */ if (max_ipl != PSM_INVALID_IPL) { /* * unmasks all levels below the lowest priority */ i += ((min_ipl - 1) << 1); for (; i >= 0; i -= 2) { if (!(pp->c_iplmask[i] & vectmask)) break; pp->c_iplmask[i] &= ~vectmask; } } else { /* * set mask to all levels */ for (; i < (MAXIPL << 1); i += 2) { if (pp->c_iplmask[i] & vectmask) break; pp->c_iplmask[i] |= vectmask; } } return (0); } static processorid_t uppc_get_next_processorid(processorid_t cpu_id) { if (cpu_id == -1) return (0); return (-1); } /*ARGSUSED*/ static int uppc_get_clockirq(int ipl) { return (CLOCK_VECTOR); } static int uppc_init_acpi(void) { int verboseflags = 0; int sci; iflag_t sci_flags; /* * Process SCI configuration here; this may return * an error if acpi-user-options has specified * legacy mode (use ACPI without ACPI mode or SCI) */ if (acpica_get_sci(&sci, &sci_flags) != AE_OK) sci = -1; /* * Initialize sub-system - if error is returns, ACPI is not * used. */ if (acpica_init() != AE_OK) return (0); /* * uppc implies system is in PIC mode; set edge/level * via ELCR based on return value from get_sci; this * will default to level/low if no override present, * as recommended by Intel ACPI CA team. */ if (sci >= 0) { ASSERT((sci_flags.intr_el == INTR_EL_LEVEL) || (sci_flags.intr_el == INTR_EL_EDGE)); psm_set_elcr(sci, sci_flags.intr_el == INTR_EL_LEVEL); } /* * Remember SCI for later use */ uppc_sci = sci; if (uppc_verbose & UPPC_VERBOSE_IRQ_FLAG) verboseflags |= PSM_VERBOSE_IRQ_FLAG; if (uppc_verbose & UPPC_VERBOSE_POWEROFF_FLAG) verboseflags |= PSM_VERBOSE_POWEROFF_FLAG; if (uppc_verbose & UPPC_VERBOSE_POWEROFF_PAUSE_FLAG) verboseflags |= PSM_VERBOSE_POWEROFF_PAUSE_FLAG; if (acpi_psm_init(uppc_info.p_mach_idstring, verboseflags) == ACPI_PSM_FAILURE) { return (0); } return (1); } static void uppc_preshutdown(int cmd, int fcn) { UPPC_VERBOSE_POWEROFF(("uppc_preshutdown(%d,%d);\n", cmd, fcn)); if ((cmd != A_SHUTDOWN) || (fcn != AD_POWEROFF)) { return; } if (uppc_enable_acpi) { UPPC_VERBOSE_POWEROFF(("uppc_preshutdown: ACPI enabled\n")); } else { UPPC_VERBOSE_POWEROFF(("uppc_preshutdown: ACPI not enabled\n")); } } static void uppc_shutdown(int cmd, int fcn) { UPPC_VERBOSE_POWEROFF(("uppc_shutdown(%d,%d);\n", cmd, fcn)); if ((cmd != A_SHUTDOWN) || (fcn != AD_POWEROFF)) { return; } if (uppc_enable_acpi) (void) acpi_poweroff(); } static int uppc_acpi_translate_pci_irq(dev_info_t *dip, int busid, int devid, int ipin, int *pci_irqp, iflag_t *intr_flagp) { int status; acpi_psm_lnk_t acpipsmlnk; if ((status = acpi_get_irq_cache_ent(busid, devid, ipin, pci_irqp, intr_flagp)) == ACPI_PSM_SUCCESS) { UPPC_VERBOSE_IRQ((CE_CONT, "!uppc: Found irqno %d " "from cache for device %s, instance #%d\n", *pci_irqp, ddi_get_name(dip), ddi_get_instance(dip))); return (status); } bzero(&acpipsmlnk, sizeof (acpi_psm_lnk_t)); if ((status = acpi_translate_pci_irq(dip, ipin, pci_irqp, intr_flagp, &acpipsmlnk)) == ACPI_PSM_FAILURE) { UPPC_VERBOSE_IRQ((CE_CONT, "!uppc: " " acpi_translate_pci_irq failed for device %s, instance" " #%d\n", ddi_get_name(dip), ddi_get_instance(dip))); return (status); } if (status == ACPI_PSM_PARTIAL && acpipsmlnk.lnkobj != NULL) { status = uppc_acpi_irq_configure(&acpipsmlnk, dip, pci_irqp, intr_flagp); if (status != ACPI_PSM_SUCCESS) { status = acpi_get_current_irq_resource(&acpipsmlnk, pci_irqp, intr_flagp); } } if (status == ACPI_PSM_SUCCESS) { acpi_new_irq_cache_ent(busid, devid, ipin, *pci_irqp, intr_flagp, &acpipsmlnk); psm_set_elcr(*pci_irqp, 1); /* set IRQ to PCI mode */ UPPC_VERBOSE_IRQ((CE_CONT, "!uppc: [ACPI] " "new irq %d for device %s, instance #%d\n", *pci_irqp, ddi_get_name(dip), ddi_get_instance(dip))); } return (status); } /* * Configures the irq for the interrupt link device identified by * acpipsmlnkp. * * Gets the current and the list of possible irq settings for the * device. If uppc_unconditional_srs is not set, and the current * resource setting is in the list of possible irq settings, * current irq resource setting is passed to the caller. * * Otherwise, picks an irq number from the list of possible irq * settings, and sets the irq of the device to this value. * If prefer_crs is set, among a set of irq numbers in the list that have * the least number of devices sharing the interrupt, we pick current irq * resource setting if it is a member of this set. * * Passes the irq number in the value pointed to by pci_irqp, and * polarity and sensitivity in the structure pointed to by dipintrflagp * to the caller. * * Note that if setting the irq resource failed, but successfuly obtained * the current irq resource settings, passes the current irq resources * and considers it a success. * * Returns: * ACPI_PSM_SUCCESS on success. * * ACPI_PSM_FAILURE if an error occured during the configuration or * if a suitable irq was not found for this device, or if setting the * irq resource and obtaining the current resource fails. * */ static int uppc_acpi_irq_configure(acpi_psm_lnk_t *acpipsmlnkp, dev_info_t *dip, int *pci_irqp, iflag_t *dipintr_flagp) { int i, min_share, foundnow, done = 0; int32_t irq; int32_t share_irq = -1; int32_t chosen_irq = -1; int cur_irq = -1; acpi_irqlist_t *irqlistp; acpi_irqlist_t *irqlistent; if ((acpi_get_possible_irq_resources(acpipsmlnkp, &irqlistp)) == ACPI_PSM_FAILURE) { UPPC_VERBOSE_IRQ((CE_WARN, "!uppc: Unable to determine " "or assign IRQ for device %s, instance #%d: The system was " "unable to get the list of potential IRQs from ACPI.", ddi_get_name(dip), ddi_get_instance(dip))); return (ACPI_PSM_FAILURE); } if ((acpi_get_current_irq_resource(acpipsmlnkp, &cur_irq, dipintr_flagp) == ACPI_PSM_SUCCESS) && (!uppc_unconditional_srs) && (cur_irq > 0)) { if (acpi_irqlist_find_irq(irqlistp, cur_irq, NULL) == ACPI_PSM_SUCCESS) { acpi_free_irqlist(irqlistp); ASSERT(pci_irqp != NULL); *pci_irqp = cur_irq; return (ACPI_PSM_SUCCESS); } UPPC_VERBOSE_IRQ((CE_WARN, "!uppc: Could not find the " "current irq %d for device %s, instance #%d in ACPI's " "list of possible irqs for this device. Picking one from " " the latter list.", cur_irq, ddi_get_name(dip), ddi_get_instance(dip))); } irqlistent = irqlistp; min_share = 255; while (irqlistent != NULL) { for (foundnow = 0, i = 0; i < irqlistent->num_irqs; i++) { irq = irqlistp->irqs[i]; if ((irq > MAX_ISA_IRQ) || (irqlistent->intr_flags.intr_el == INTR_EL_EDGE) || (irq == 0)) continue; if (uppc_reserved_irqlist[irq]) continue; if (uppc_irq_shared_table[irq] == 0) { chosen_irq = irq; foundnow = 1; if (!(uppc_prefer_crs) || (irq == cur_irq)) { done = 1; break; } } if ((uppc_irq_shared_table[irq] < min_share) || ((uppc_irq_shared_table[irq] == min_share) && (cur_irq == irq) && (uppc_prefer_crs))) { min_share = uppc_irq_shared_table[irq]; share_irq = irq; foundnow = 1; } } /* If we found an IRQ in the inner loop, save the details */ if (foundnow && ((chosen_irq != -1) || (share_irq != -1))) { /* * Copy the acpi_prs_private_t and flags from this * irq list entry, since we found an irq from this * entry. */ acpipsmlnkp->acpi_prs_prv = irqlistent->acpi_prs_prv; *dipintr_flagp = irqlistent->intr_flags; } if (done) break; /* Load the next entry in the irqlist */ irqlistent = irqlistent->next; } acpi_free_irqlist(irqlistp); if (chosen_irq != -1) irq = chosen_irq; else if (share_irq != -1) irq = share_irq; else { UPPC_VERBOSE_IRQ((CE_CONT, "!uppc: Could not find a " "suitable irq from the list of possible irqs for device " "%s, instance #%d in ACPI's list of possible\n", ddi_get_name(dip), ddi_get_instance(dip))); return (ACPI_PSM_FAILURE); } UPPC_VERBOSE_IRQ((CE_CONT, "!uppc: Setting irq %d for device %s " "instance #%d\n", irq, ddi_get_name(dip), ddi_get_instance(dip))); if ((acpi_set_irq_resource(acpipsmlnkp, irq)) == ACPI_PSM_SUCCESS) { /* * setting irq was successful, check to make sure CRS * reflects that. If CRS does not agree with what we * set, return the irq that was set. */ if (acpi_get_current_irq_resource(acpipsmlnkp, &cur_irq, dipintr_flagp) == ACPI_PSM_SUCCESS) { if (cur_irq != irq) UPPC_VERBOSE_IRQ((CE_WARN, "!uppc: " "IRQ resource set (irqno %d) for device %s " "instance #%d, differs from current " "setting irqno %d", irq, ddi_get_name(dip), ddi_get_instance(dip), cur_irq)); } /* * return the irq that was set, and not what CRS reports, * since CRS has been seen to be bogus on some systems */ cur_irq = irq; } else { UPPC_VERBOSE_IRQ((CE_WARN, "!uppc: set resource irq %d " "failed for device %s instance #%d", irq, ddi_get_name(dip), ddi_get_instance(dip))); if (cur_irq == -1) return (ACPI_PSM_FAILURE); } ASSERT(pci_irqp != NULL); *pci_irqp = cur_irq; return (ACPI_PSM_SUCCESS); } /*ARGSUSED*/ static int uppc_translate_irq(dev_info_t *dip, int irqno) { char dev_type[16]; int dev_len, pci_irq, devid, busid; ddi_acc_handle_t cfg_handle; uchar_t ipin, iline; iflag_t intr_flag; if (dip == NULL) { UPPC_VERBOSE_IRQ((CE_CONT, "!uppc: irqno = %d" " dip = NULL\n", irqno)); return (irqno); } if (!uppc_enable_acpi) { return (irqno); } dev_len = sizeof (dev_type); if (ddi_getlongprop_buf(DDI_DEV_T_ANY, ddi_get_parent(dip), DDI_PROP_DONTPASS, "device_type", (caddr_t)dev_type, &dev_len) != DDI_PROP_SUCCESS) { UPPC_VERBOSE_IRQ((CE_CONT, "!uppc: irqno %d" "device %s instance %d no device_type\n", irqno, ddi_get_name(dip), ddi_get_instance(dip))); return (irqno); } if ((strcmp(dev_type, "pci") == 0) || (strcmp(dev_type, "pciex") == 0)) { /* pci device */ if (acpica_get_bdf(dip, &busid, &devid, NULL) != 0) return (irqno); if (pci_config_setup(dip, &cfg_handle) != DDI_SUCCESS) return (irqno); ipin = pci_config_get8(cfg_handle, PCI_CONF_IPIN) - PCI_INTA; iline = pci_config_get8(cfg_handle, PCI_CONF_ILINE); if (uppc_acpi_translate_pci_irq(dip, busid, devid, ipin, &pci_irq, &intr_flag) == ACPI_PSM_SUCCESS) { UPPC_VERBOSE_IRQ((CE_CONT, "!uppc: [ACPI] new irq " "%d old irq %d device %s, instance %d\n", pci_irq, irqno, ddi_get_name(dip), ddi_get_instance(dip))); /* * Make sure pci_irq is within range. * Otherwise, fall through and return irqno. */ if (pci_irq <= MAX_ISA_IRQ) { if (iline != pci_irq) { /* * Update the device's ILINE byte, * in case uppc_acpi_translate_pci_irq * has choosen a different pci_irq * than the BIOS has configured. * Some chipsets use the value in * ILINE to control interrupt routing, * in conflict with the PCI spec. */ pci_config_put8(cfg_handle, PCI_CONF_ILINE, pci_irq); } pci_config_teardown(&cfg_handle); return (pci_irq); } } pci_config_teardown(&cfg_handle); /* FALLTHRU to common case - returning irqno */ } else { /* non-PCI; assumes ISA-style edge-triggered */ psm_set_elcr(irqno, 0); /* set IRQ to ISA mode */ UPPC_VERBOSE_IRQ((CE_CONT, "!uppc: non-pci," "irqno %d device %s instance %d\n", irqno, ddi_get_name(dip), ddi_get_instance(dip))); } return (irqno); } /* * uppc_intr_enter() raises the ipl to the level of the current interrupt, * and sends EOI to the pics. * If interrupt is 7 or 15 and not spurious interrupt, send specific EOI * else send non-specific EOI * uppc_intr_enter() returns the new priority level, * or -1 for spurious interrupt */ static int uppc_intr_enter(int ipl, int *vector) { int newipl; int intno; intno = (*vector); ASSERT(intno < 256); newipl = autovect[intno].avh_hi_pri; /* * During wait_till_seen() periods when interrupt vector is being * removed in remove_av(), the removed hardware interrupt could * trigger and got here with newipl 0. It has to send EOI * as usual but no need to call setspl and returns -1 like spurious. */ if ((intno & 7) != 7) { if (newipl) uppc_setspl(newipl); outb(MCMD_PORT, PIC_NSEOI); if (intno >= 8) { outb(SCMD_PORT, PIC_NSEOI); } } else { /* int was 7 or 15 */ if (newipl && newipl <= ipl) { /* Check for spurious int */ if (intno != 7) outb(MCMD_PORT, PIC_NSEOI); return (-1); /* Spurious int */ } else { if (newipl) uppc_setspl(newipl); if (intno != 7) { outb(MCMD_PORT, PIC_NSEOI); outb(SCMD_PORT, PIC_SEOI_LVL7); } else { outb(MCMD_PORT, PIC_SEOI_LVL7); } } } if (newipl) return (newipl); else return (-1); /* not real spurious int */ } /* * uppc_intr_exit() restores the old interrupt * priority level after processing an interrupt. * It is called with interrupts disabled, and does not enable interrupts. */ /* ARGSUSED */ static void uppc_intr_exit(int ipl, int vector) { uppc_setspl(ipl); } /* * uppc_setspl() loads new interrupt masks into the pics * based on input ipl. */ /* ARGSUSED */ static void uppc_setspl(int ipl) { struct standard_pic *pp; uint8_t smask, mmask; uint8_t cursmask, curmmask; pp = &pics0; smask = pp->c_iplmask[ipl * 2]; mmask = pp->c_iplmask[ipl * 2 + 1]; cursmask = pp->c_curmask[0]; curmmask = pp->c_curmask[1]; if (cursmask == smask && curmmask == mmask) return; pp->c_curmask[0] = smask; pp->c_curmask[1] = mmask; if (cursmask != smask) { /* * program new slave pic mask */ outb(SIMR_PORT, smask); } if (curmmask != mmask) { /* * program new master pic mask */ outb(MIMR_PORT, mmask); } /* * read master to allow pics to settle */ (void) inb(MIMR_PORT); } /* * uppc_gethrtime() returns high resolution timer value */ static hrtime_t uppc_gethrtime() { hrtime_t timeval, temp; unsigned int ctr0; ulong_t oflags; oflags = intr_clear(); /* disable ints */ lock_set(&uppc_gethrtime_lock); retry: temp = hrtime_base; outb(PITCTL_PORT, 0); /* latch counter 0 */ /* * read counter 0 */ ctr0 = inb(PITCTR0_PORT); ctr0 |= inb(PITCTR0_PORT) << 8; timeval = (hrtime_t)ctr0 * (NANOSEC / PIT_HZ); if (temp != hrtime_base) goto retry; timeval -= temp; if (timeval < uppc_lasthrtime) timeval = uppc_lasthrtime; uppc_lasthrtime = timeval; lock_clear(&uppc_gethrtime_lock); intr_restore(oflags); return (timeval); }