#pragma ident "%Z%%M% %I% %E% SMI"
#include <sys/file.h>
#include <sys/hypervisor_api.h>
#include <sys/hsvc.h>
#include <sys/sunndi.h>
#include <fpc.h>
#include <fpc-impl.h>
#include <fpc-impl-4v.h>
#define PCIE_ROOTNEX_COMPATIBLE_NAME "SUNW,sun4v-pci"
#define FPC_MODULE_NAME "fpc"
#define FPC_REQ_MAJOR_VER 1
#define FPC_REQ_MINOR_VER 0
static hsvc_info_t fpc_hsvc = {
HSVC_REV_1,
NULL,
HSVC_GROUP_FIRE_PERF,
FPC_REQ_MAJOR_VER,
FPC_REQ_MINOR_VER,
FPC_MODULE_NAME
};
static int hyp_regd_users = 0;
static uint64_t fpc_sup_minor;
typedef struct nexus_regspec {
uint64_t phys_addr;
uint64_t size;
} nexus_regspec_t;
static uint64_t counter_select_index[] = {
HVIO_FIRE_PERFREG_JBC_SEL,
HVIO_FIRE_PERFREG_PCIE_IMU_SEL,
HVIO_FIRE_PERFREG_PCIE_MMU_SEL,
HVIO_FIRE_PERFREG_PCIE_TLU_SEL,
HVIO_FIRE_PERFREG_PCIE_LNK_SEL
};
static uint64_t counter_reg_index[] = {
HVIO_FIRE_PERFREG_JBC_CNT0,
HVIO_FIRE_PERFREG_JBC_CNT1,
HVIO_FIRE_PERFREG_PCIE_IMU_CNT0,
HVIO_FIRE_PERFREG_PCIE_IMU_CNT1,
HVIO_FIRE_PERFREG_PCIE_MMU_CNT0,
HVIO_FIRE_PERFREG_PCIE_MMU_CNT1,
HVIO_FIRE_PERFREG_PCIE_TLU_CNT0,
HVIO_FIRE_PERFREG_PCIE_TLU_CNT1,
HVIO_FIRE_PERFREG_PCIE_TLU_CNT2,
HVIO_FIRE_PERFREG_PCIE_LNK_CNT1,
HVIO_FIRE_PERFREG_PCIE_LNK_CNT2
};
int
fpc_platform_check()
{
int regstat;
if ((regstat = hsvc_register(&fpc_hsvc, &fpc_sup_minor)) == SUCCESS) {
(void) hsvc_unregister(&fpc_hsvc);
}
fpc_sup_minor = 0;
return (regstat);
}
int
fpc_platform_module_init(dev_info_t *dip)
{
return (DDI_SUCCESS);
}
int
fpc_platform_node_init(dev_info_t *dip, int *avail)
{
nexus_regspec_t *rp;
uint_t reglen;
devhandle_t dev_hdl;
int regstat;
int index;
boolean_t is_root_pcie_nexus;
uint64_t dummy_data;
char *name = NULL;
boolean_t jbus_regs_avail;
boolean_t pcie_regs_avail;
if (ddi_prop_lookup_string(DDI_DEV_T_ANY, dip,
DDI_PROP_DONTPASS, "compatible", &name) != DDI_PROP_SUCCESS)
return (DDI_SUCCESS);
is_root_pcie_nexus = (strcmp(name, PCIE_ROOTNEX_COMPATIBLE_NAME) == 0);
ddi_prop_free(name);
if (!is_root_pcie_nexus)
return (DDI_SUCCESS);
if (ddi_prop_lookup_byte_array(DDI_DEV_T_ANY, dip,
DDI_PROP_DONTPASS, "reg", (uchar_t **)&rp, ®len) !=
DDI_PROP_SUCCESS)
return (DDI_FAILURE);
dev_hdl = (devhandle_t)((rp->phys_addr >> 32) & DEVHDLE_MASK);
ddi_prop_free(rp);
if (hyp_regd_users == 0) {
regstat = hsvc_register(&fpc_hsvc, &fpc_sup_minor);
if (regstat != SUCCESS) {
return (DDI_FAILURE);
}
}
hyp_regd_users++;
jbus_regs_avail = (fpc_event_io(
(fire_perfreg_handle_t)dev_hdl, jbc, &dummy_data, IS_READ) ==
SUCCESS);
pcie_regs_avail = (fpc_event_io(
(fire_perfreg_handle_t)dev_hdl, imu, &dummy_data, IS_READ) ==
SUCCESS);
if ((!jbus_regs_avail) && (!pcie_regs_avail))
return (DDI_SUCCESS);
fpc_common_node_setup(dip, &index);
if (pcie_regs_avail)
*avail |=
((index == 0) ? PCIE_A_REGS_AVAIL : PCIE_B_REGS_AVAIL);
if (jbus_regs_avail) {
*avail |= JBUS_REGS_AVAIL;
if (index != 0)
cmn_err(CE_WARN,
"fpc: JBUS regs available on device idx %d!\n",
index);
}
(void) fpc_set_platform_data_by_number(index, (void *)dev_hdl);
return (DDI_SUCCESS);
}
void
fpc_platform_node_fini(void *arg)
{
if (--hyp_regd_users == 0)
(void) hsvc_unregister(&fpc_hsvc);
}
void
fpc_platform_module_fini(dev_info_t *dip)
{
}
fire_perfreg_handle_t
fpc_get_perfreg_handle(int devnum)
{
void *platform_specific_data;
if ((platform_specific_data =
fpc_get_platform_data_by_number(devnum)) == NULL)
return ((fire_perfreg_handle_t)-1);
else
return ((fire_perfreg_handle_t)platform_specific_data);
}
int
fpc_free_counter_handle(fire_perfreg_handle_t handle)
{
return (SUCCESS);
}
static int
fpc_hv_perfreg_io(fire_perfreg_handle_t handle, uint64_t hv_if_index,
uint64_t *reg_data, boolean_t is_write)
{
int rval;
devhandle_t dev_hdl = (devhandle_t)handle;
if (is_write)
rval = fpc_set_fire_perfreg(dev_hdl, hv_if_index, *reg_data);
else
rval = fpc_get_fire_perfreg(dev_hdl, hv_if_index, reg_data);
return ((rval == H_EOK) ? SUCCESS : EIO);
}
int
fpc_event_io(fire_perfreg_handle_t handle, fire_perfcnt_t group,
uint64_t *reg_data, boolean_t is_write)
{
uint64_t hv_if_index = counter_select_index[group];
return (fpc_hv_perfreg_io(handle, hv_if_index, reg_data, is_write));
}
int
fpc_counter_io(fire_perfreg_handle_t handle, fire_perfcnt_t group,
int counter_index, uint64_t *reg_data, boolean_t is_write)
{
uint64_t hv_if_index = counter_reg_index[counter_index];
return (fpc_hv_perfreg_io(handle, hv_if_index, reg_data, is_write));
}