#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>
#include <sys/kstat.h>
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]);
}
}
}
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, 0)) == NULL) {
cmn_err(CE_WARN, "%s %s : kstat create failed",
mod_name, pic_name);
return (NULL);
}
pic_named_data = (struct kstat_named *)picN_ksp->ks_data;
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);
}
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);
}
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;
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);
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);
}
counters_ksp->ks_private = (void *)cntr_addr_p;
counters_ksp->ks_update = update;
kstat_install(counters_ksp);
return (counters_ksp);
}
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;
data_p[1].value.ui64 = (pic <<32) >> 32;
data_p[2].value.ui64 = pic >> 32;
}
return (0);
}
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);
data_p[1].value.ui64 = (pic << 32) >> 32;
data_p[2].value.ui64 = pic >> 32;
}
return (0);
}
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;
}