1 files changed, 277 insertions, 0 deletions
diff --git a/usr/src/uts/sun4u/io/pci/pci_counters.c b/usr/src/uts/sun4u/io/pci/pci_counters.c
new file mode 100644
index 0000000000..f284d49d33
--- /dev/null
+++ b/usr/src/uts/sun4u/io/pci/pci_counters.c
@@ -0,0 +1,277 @@
+/*
+ * CDDL HEADER START
+ *
+ * The contents of this file are subject to the terms of the
+ * Common Development and Distribution License, Version 1.0 only
+ * (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) 2000 by Sun Microsystems, Inc.
+ * All rights reserved.
+ */
+
+#pragma ident	"%Z%%M%	%I%	%E% SMI"
+
+#include <sys/types.h>
+#include <sys/async.h>
+#include <sys/sunddi.h>
+#include <sys/sunndi.h>
+#include <sys/ddi_impldefs.h>
+#include <sys/pci/pci_obj.h>
+#include <sys/machsystm.h>	/* lddphys() */
+#include <sys/kstat.h>
+
+/*LINTLIBRARY*/
+
+static kstat_t *pci_create_picN_kstat(char *, int, int, int,
+	pci_kev_mask_t *);
+
+void
+pci_kstat_create(pci_t *pci_p)
+{
+	pci_common_t *cmn_p = pci_p->pci_common_p;
+
+	if (cmn_p->pci_common_attachcnt == 0)
+		pci_add_upstream_kstat(pci_p);
+
+	pci_add_pci_kstat(pci_p);
+}
+
+void
+pci_kstat_destroy(pci_t *pci_p)
+{
+	pci_common_t *cmn_p = pci_p->pci_common_p;
+
+	pci_rem_pci_kstat(pci_p);
+
+	if (cmn_p->pci_common_attachcnt == 0)
+		pci_rem_upstream_kstat(pci_p);
+}
+
+void
+pci_create_name_kstat(char *name, pci_ksinfo_t *pp, pci_kev_mask_t *ev)
+{
+	int	i;
+
+	for (i = 0; i < NUM_OF_PICS; i++) {
+		pp->pic_name_ksp[i] = pci_create_picN_kstat(name,
+			i, pp->pic_shift[i], pp->pic_no_evs, ev);
+
+		if (pp->pic_name_ksp[i] == NULL) {
+			cmn_err(CE_WARN, "pci: unable to create name kstat");
+		}
+	}
+}
+
+void
+pci_delete_name_kstat(pci_ksinfo_t *pp)
+{
+	int	i;
+
+	if (pp != NULL) {
+		for (i = 0; i < NUM_OF_PICS; i++) {
+			if (pp->pic_name_ksp[i] != NULL)
+				kstat_delete(pp->pic_name_ksp[i]);
+		}
+	}
+}
+
+/*
+ * Create the picN kstat. Returns a pointer to the
+ * kstat which the driver must store to allow it
+ * to be deleted when necessary.
+ */
+static kstat_t *
+pci_create_picN_kstat(char *mod_name, int pic, int pic_shift,
+	int num_ev, pci_kev_mask_t *ev_array)
+{
+	struct kstat_named *pic_named_data;
+	int	inst = 0;
+	int	event;
+	char	pic_name[30];
+	kstat_t	*picN_ksp = NULL;
+
+	(void) sprintf(pic_name, "pic%d", pic);
+	if ((picN_ksp = kstat_create(mod_name, inst, pic_name,
+		"bus", KSTAT_TYPE_NAMED, num_ev, NULL)) == NULL) {
+		cmn_err(CE_WARN, "%s %s : kstat create failed",
+			mod_name, pic_name);
+
+		/*
+		 * It is up to the calling function to delete any kstats
+		 * that may have been created already. We just
+		 * return NULL to indicate an error has occured.
+		 */
+		return (NULL);
+	}
+
+	pic_named_data = (struct kstat_named *)
+		picN_ksp->ks_data;
+
+	/*
+	 * Write event names and their associated pcr masks. The
+	 * last entry in the array (clear_pic) is added seperately
+	 * below as the pic value must be inverted.
+	 */
+	for (event = 0; event < num_ev - 1; event++) {
+		pic_named_data[event].value.ui64 =
+			(ev_array[event].pcr_mask << pic_shift);
+
+		kstat_named_init(&pic_named_data[event],
+			ev_array[event].event_name,
+			KSTAT_DATA_UINT64);
+	}
+
+	/*
+	 * add the clear_pic entry.
+	 */
+	pic_named_data[event].value.ui64 =
+		(uint64_t)~(ev_array[event].pcr_mask << pic_shift);
+
+	kstat_named_init(&pic_named_data[event],
+		ev_array[event].event_name,
+		KSTAT_DATA_UINT64);
+
+	kstat_install(picN_ksp);
+
+	return (picN_ksp);
+}
+
+/*
+ * Create the "counters" kstat.
+ */
+kstat_t *pci_create_cntr_kstat(pci_t *pci_p, char *name,
+	int num_pics, int (*update)(kstat_t *, int),
+	void *cntr_addr_p)
+{
+	struct kstat	*counters_ksp;
+	struct kstat_named	*counters_named_data;
+	dev_info_t	*dip = pci_p->pci_dip;
+	char		*drv_name = (char *)ddi_driver_name(dip);
+	int		drv_instance = ddi_get_instance(dip);
+	char		pic_str[10];
+	int		i;
+
+	/*
+	 * Size of kstat is num_pics + 1 as it
+	 * also contains the %pcr
+	 */
+	if ((counters_ksp = kstat_create(name, drv_instance,
+		"counters", "bus", KSTAT_TYPE_NAMED,
+		num_pics + 1,
+		KSTAT_FLAG_WRITABLE)) == NULL) {
+
+		cmn_err(CE_WARN, "%s%d counters kstat_create failed",
+			drv_name, drv_instance);
+		return (NULL);
+	}
+
+	counters_named_data =
+		(struct kstat_named *)(counters_ksp->ks_data);
+
+	/* initialize the named kstats */
+	kstat_named_init(&counters_named_data[0],
+		"pcr", KSTAT_DATA_UINT64);
+
+	for (i = 0; i < num_pics; i++) {
+		(void) sprintf(pic_str, "pic%d", i);
+
+		kstat_named_init(&counters_named_data[i+1],
+			pic_str, KSTAT_DATA_UINT64);
+	}
+
+	/*
+	 * Store the register offset's in the kstat's
+	 * private field so that they are available
+	 * to the update function.
+	 */
+	counters_ksp->ks_private = (void *)cntr_addr_p;
+	counters_ksp->ks_update = update;
+
+	kstat_install(counters_ksp);
+
+	return (counters_ksp);
+}
+
+/*
+ * kstat update function. Handles reads/writes
+ * from/to kstat.
+ */
+int
+pci_cntr_kstat_update(kstat_t *ksp, int rw)
+{
+	struct kstat_named	*data_p;
+	pci_cntr_addr_t	*cntr_addr_p = ksp->ks_private;
+	uint64_t	pic;
+
+	data_p = (struct kstat_named *)ksp->ks_data;
+
+	if (rw == KSTAT_WRITE) {
+		*cntr_addr_p->pcr_addr = data_p[0].value.ui64;
+		return (0);
+	} else {
+		pic = *cntr_addr_p->pic_addr;
+		data_p[0].value.ui64 = *cntr_addr_p->pcr_addr;
+
+		/* pic0 : lo 32 bits */
+		data_p[1].value.ui64 = (pic <<32) >> 32;
+		/* pic1 : hi 32 bits */
+		data_p[2].value.ui64 = pic >> 32;
+	}
+	return (0);
+}
+
+/*
+ * kstat update function using physical addresses.
+ */
+int
+pci_cntr_kstat_pa_update(kstat_t *ksp, int rw)
+{
+	struct kstat_named	*data_p;
+	pci_cntr_pa_t *cntr_pa_p = (pci_cntr_pa_t *)ksp->ks_private;
+	uint64_t	pic;
+
+	data_p = (struct kstat_named *)ksp->ks_data;
+
+	if (rw == KSTAT_WRITE) {
+		stdphysio(cntr_pa_p->pcr_pa, data_p[0].value.ui64);
+		return (0);
+	} else {
+		pic = lddphysio(cntr_pa_p->pic_pa);
+		data_p[0].value.ui64 = lddphysio(cntr_pa_p->pcr_pa);
+
+		/* pic0 : lo 32 bits */
+		data_p[1].value.ui64 = (pic << 32) >> 32;
+		/* pic1 : hi 32 bits */
+		data_p[2].value.ui64 = pic >> 32;
+	}
+	return (0);
+}
+
+
+/*
+ * Matched with pci_add_upstream_kstat()
+ */
+void
+pci_rem_upstream_kstat(pci_t *pci_p)
+{
+	pci_common_t *cmn_p = pci_p->pci_common_p;
+
+	if (cmn_p->pci_common_uksp != NULL)
+		kstat_delete(cmn_p->pci_common_uksp);
+	cmn_p->pci_common_uksp = NULL;
+}