#include <sys/stat.h>
#include <sys/types.h>
#include <sys/time.h>
#include <sys/fm/protocol.h>
#include <sys/fm/smb/fmsmb.h>
#include <sys/devfm.h>
#include <sys/cpu_module.h>
#define ANY_ID (uint_t)-1
#define INIT_HDLS 16
typedef struct fm_cmi_walk_t
{
uint_t chipid;
uint_t coreid;
uint_t strandid;
int (*cbfunc)(cmi_hdl_t, void *, void *);
cmi_hdl_t *hdls;
uint_t nhdl_max;
uint_t nhdl;
} fm_cmi_walk_t;
extern int x86gentopo_legacy;
int
fm_get_paddr(nvlist_t *nvl, uint64_t *paddr)
{
uint8_t version;
uint64_t pa;
char *scheme;
int err;
if ((nvlist_lookup_string(nvl, FM_FMRI_SCHEME, &scheme) != 0) ||
(strcmp(scheme, FM_FMRI_SCHEME_HC) != 0) ||
(nvlist_lookup_uint8(nvl, FM_VERSION, &version) != 0) ||
version > FM_HC_SCHEME_VERSION) {
return (EINVAL);
}
if ((err = cmi_mc_unumtopa(NULL, nvl, &pa)) != CMI_SUCCESS &&
err != CMIERR_MC_PARTIALUNUMTOPA)
return (EINVAL);
*paddr = pa;
return (0);
}
static void
walk_init(fm_cmi_walk_t *wp, uint_t chipid, uint_t coreid, uint_t strandid,
int (*cbfunc)(cmi_hdl_t, void *, void *))
{
wp->chipid = chipid;
wp->coreid = coreid;
wp->strandid = strandid;
if ((wp->cbfunc = cbfunc) == NULL) {
wp->hdls = kmem_alloc(sizeof (cmi_hdl_t) * INIT_HDLS, KM_SLEEP);
wp->nhdl_max = INIT_HDLS;
wp->nhdl = 0;
}
}
static void
walk_fini(fm_cmi_walk_t *wp)
{
if (wp->cbfunc == NULL)
kmem_free(wp->hdls, sizeof (cmi_hdl_t) * wp->nhdl_max);
}
static int
select_cmi_hdl(cmi_hdl_t hdl, void *arg1, void *arg2, void *arg3)
{
fm_cmi_walk_t *wp = (fm_cmi_walk_t *)arg1;
if (wp->chipid != ANY_ID && wp->chipid != cmi_hdl_chipid(hdl))
return (CMI_HDL_WALK_NEXT);
if (wp->coreid != ANY_ID && wp->coreid != cmi_hdl_coreid(hdl))
return (CMI_HDL_WALK_NEXT);
if (wp->strandid != ANY_ID && wp->strandid != cmi_hdl_strandid(hdl))
return (CMI_HDL_WALK_NEXT);
if (wp->cbfunc != NULL)
return (wp->cbfunc(hdl, arg2, arg3));
if (wp->nhdl == wp->nhdl_max) {
size_t sz = sizeof (cmi_hdl_t) * wp->nhdl_max;
cmi_hdl_t *newarray = kmem_alloc(sz << 1, KM_SLEEP);
bcopy(wp->hdls, newarray, sz);
kmem_free(wp->hdls, sz);
wp->hdls = newarray;
wp->nhdl_max <<= 1;
}
cmi_hdl_hold(hdl);
wp->hdls[wp->nhdl++] = hdl;
return (CMI_HDL_WALK_NEXT);
}
static void
populate_cpu(nvlist_t **nvlp, cmi_hdl_t hdl)
{
uint_t fm_chipid;
uint16_t smbios_id;
const char *idstr;
(void) nvlist_alloc(nvlp, NV_UNIQUE_NAME, KM_SLEEP);
if (!x86gentopo_legacy) {
smbios_id = cmi_hdl_smbiosid(hdl);
fm_chipid = cmi_hdl_smb_chipid(hdl);
(void) nvlist_add_nvlist(*nvlp, FM_PHYSCPU_INFO_CHIP_ROOTS,
cmi_hdl_smb_bboard(hdl));
(void) nvlist_add_uint16(*nvlp, FM_PHYSCPU_INFO_SMBIOS_ID,
(uint16_t)smbios_id);
} else
fm_chipid = cmi_hdl_chipid(hdl);
fm_payload_set(*nvlp,
FM_PHYSCPU_INFO_VENDOR_ID, DATA_TYPE_STRING,
cmi_hdl_vendorstr(hdl),
FM_PHYSCPU_INFO_FAMILY, DATA_TYPE_INT32,
(int32_t)cmi_hdl_family(hdl),
FM_PHYSCPU_INFO_MODEL, DATA_TYPE_INT32,
(int32_t)cmi_hdl_model(hdl),
FM_PHYSCPU_INFO_STEPPING, DATA_TYPE_INT32,
(int32_t)cmi_hdl_stepping(hdl),
FM_PHYSCPU_INFO_CHIP_ID, DATA_TYPE_INT32,
(int32_t)fm_chipid,
FM_PHYSCPU_INFO_NPROCNODES, DATA_TYPE_INT32,
(int32_t)cmi_hdl_procnodes_per_pkg(hdl),
FM_PHYSCPU_INFO_PROCNODE_ID, DATA_TYPE_INT32,
(int32_t)cmi_hdl_procnodeid(hdl),
FM_PHYSCPU_INFO_CORE_ID, DATA_TYPE_INT32,
(int32_t)cmi_hdl_coreid(hdl),
FM_PHYSCPU_INFO_STRAND_ID, DATA_TYPE_INT32,
(int32_t)cmi_hdl_strandid(hdl),
FM_PHYSCPU_INFO_STRAND_APICID, DATA_TYPE_INT32,
(int32_t)cmi_hdl_strand_apicid(hdl),
FM_PHYSCPU_INFO_CHIP_REV, DATA_TYPE_STRING,
cmi_hdl_chiprevstr(hdl),
FM_PHYSCPU_INFO_SOCKET_TYPE, DATA_TYPE_UINT32,
(uint32_t)cmi_hdl_getsockettype(hdl),
FM_PHYSCPU_INFO_CPU_ID, DATA_TYPE_INT32,
(int32_t)cmi_hdl_logical_id(hdl),
NULL);
if ((idstr = cmi_hdl_chipident(hdl)) != NULL) {
fm_payload_set(*nvlp,
FM_PHYSCPU_INFO_CHIP_IDENTSTR, DATA_TYPE_STRING, idstr,
NULL);
}
}
int
fm_ioctl_physcpu_info(int cmd, nvlist_t *invl, nvlist_t **onvlp)
{
nvlist_t **cpus, *nvl;
int i, err;
fm_cmi_walk_t wk;
walk_init(&wk, ANY_ID, ANY_ID, ANY_ID, NULL);
cmi_hdl_walk(select_cmi_hdl, &wk, NULL, NULL);
if (wk.nhdl == 0) {
walk_fini(&wk);
return (ENOENT);
}
cpus = kmem_alloc(sizeof (nvlist_t *) * wk.nhdl, KM_SLEEP);
for (i = 0; i < wk.nhdl; i++) {
populate_cpu(cpus + i, wk.hdls[i]);
cmi_hdl_rele(wk.hdls[i]);
}
walk_fini(&wk);
(void) nvlist_alloc(&nvl, NV_UNIQUE_NAME, KM_SLEEP);
err = nvlist_add_nvlist_array(nvl, FM_PHYSCPU_INFO_CPUS,
cpus, wk.nhdl);
for (i = 0; i < wk.nhdl; i++)
nvlist_free(cpus[i]);
kmem_free(cpus, sizeof (nvlist_t *) * wk.nhdl);
if (err != 0) {
nvlist_free(nvl);
return (err);
}
*onvlp = nvl;
return (0);
}
int
fm_ioctl_cpu_retire(int cmd, nvlist_t *invl, nvlist_t **onvlp)
{
int32_t chipid, coreid, strandid;
int rc, new_status, old_status;
cmi_hdl_t hdl;
nvlist_t *nvl;
switch (cmd) {
case FM_IOC_CPU_RETIRE:
new_status = P_FAULTED;
break;
case FM_IOC_CPU_STATUS:
new_status = P_STATUS;
break;
case FM_IOC_CPU_UNRETIRE:
new_status = P_ONLINE;
break;
default:
return (ENOTTY);
}
if (nvlist_lookup_int32(invl, FM_CPU_RETIRE_CHIP_ID, &chipid) != 0 ||
nvlist_lookup_int32(invl, FM_CPU_RETIRE_CORE_ID, &coreid) != 0 ||
nvlist_lookup_int32(invl, FM_CPU_RETIRE_STRAND_ID, &strandid) != 0)
return (EINVAL);
hdl = cmi_hdl_lookup(CMI_HDL_NEUTRAL, chipid, coreid, strandid);
if (hdl == NULL)
return (EINVAL);
rc = cmi_hdl_online(hdl, new_status, &old_status);
cmi_hdl_rele(hdl);
if (rc == 0) {
(void) nvlist_alloc(&nvl, NV_UNIQUE_NAME, KM_SLEEP);
(void) nvlist_add_int32(nvl, FM_CPU_RETIRE_OLDSTATUS,
old_status);
*onvlp = nvl;
}
return (rc);
}
int
fm_ioctl_gentopo_legacy(int cmd, nvlist_t *invl, nvlist_t **onvlp)
{
nvlist_t *nvl;
if (cmd != FM_IOC_GENTOPO_LEGACY) {
return (ENOTTY);
}
(void) nvlist_alloc(&nvl, NV_UNIQUE_NAME, KM_SLEEP);
(void) nvlist_add_int32(nvl, FM_GENTOPO_LEGACY, x86gentopo_legacy);
*onvlp = nvl;
return (0);
}
#define FM_MAX_CACHES 0x10
static int
fm_cmi_cache_err_to_errno(cmi_errno_t cmi)
{
switch (cmi) {
case CMIERR_C_NODATA:
return (ENOTSUP);
case CMIERR_C_BADCACHENO:
default:
return (EIO);
}
}
static int
fm_populate_cache(cmi_hdl_t hdl, nvlist_t *nvl, uint_t cpuno)
{
int ret;
cmi_errno_t err;
uint32_t ncache;
nvlist_t *caches[FM_MAX_CACHES];
char buf[32];
err = cmi_cache_ncaches(hdl, &ncache);
if (err != CMI_SUCCESS) {
return (fm_cmi_cache_err_to_errno(err));
}
if (ncache == 0) {
return (0);
} else if (ncache > FM_MAX_CACHES) {
return (EOVERFLOW);
}
bzero(caches, sizeof (caches));
for (uint32_t i = 0; i < ncache; i++) {
x86_cache_t c;
fm_cache_info_type_t type = 0;
(void) nvlist_alloc(&caches[i], NV_UNIQUE_NAME, KM_SLEEP);
err = cmi_cache_info(hdl, i, &c);
if (err != CMI_SUCCESS) {
ret = fm_cmi_cache_err_to_errno(err);
goto cleanup;
}
fnvlist_add_uint32(caches[i], FM_CACHE_INFO_LEVEL, c.xc_level);
switch (c.xc_type) {
case X86_CACHE_TYPE_DATA:
type = FM_CACHE_INFO_T_DATA;
break;
case X86_CACHE_TYPE_INST:
type = FM_CACHE_INFO_T_INSTR;
break;
case X86_CACHE_TYPE_UNIFIED:
type = FM_CACHE_INFO_T_DATA | FM_CACHE_INFO_T_INSTR |
FM_CACHE_INFO_T_UNIFIED;
break;
default:
break;
}
fnvlist_add_uint32(caches[i], FM_CACHE_INFO_TYPE,
(uint32_t)type);
fnvlist_add_uint64(caches[i], FM_CACHE_INFO_NSETS, c.xc_nsets);
fnvlist_add_uint32(caches[i], FM_CACHE_INFO_NWAYS, c.xc_nways);
fnvlist_add_uint32(caches[i], FM_CACHE_INFO_LINE_SIZE,
c.xc_line_size);
fnvlist_add_uint64(caches[i], FM_CACHE_INFO_TOTAL_SIZE,
c.xc_size);
if ((c.xc_flags & X86_CACHE_F_FULL_ASSOC) != 0) {
fnvlist_add_boolean(caches[i],
FM_CACHE_INFO_FULLY_ASSOC);
}
fnvlist_add_uint64(caches[i], FM_CACHE_INFO_ID, c.xc_id);
fnvlist_add_uint32(caches[i], FM_CACHE_INFO_X86_APIC_SHIFT,
c.xc_apic_shift);
}
(void) snprintf(buf, sizeof (buf), "%u", cpuno);
fnvlist_add_nvlist_array(nvl, buf, caches, (uint_t)ncache);
ret = 0;
cleanup:
for (uint32_t i = 0; i < ncache; i++) {
nvlist_free(caches[i]);
}
return (ret);
}
int
fm_ioctl_cache_info(int cmd, nvlist_t *invl, nvlist_t **onvlp)
{
int ret = 0;
fm_cmi_walk_t walk;
nvlist_t *nvl;
if (cmd != FM_IOC_CACHE_INFO) {
return (ENOTTY);
}
walk_init(&walk, ANY_ID, ANY_ID, ANY_ID, NULL);
cmi_hdl_walk(select_cmi_hdl, &walk, NULL, NULL);
if (walk.nhdl == 0) {
walk_fini(&walk);
return (ENOENT);
}
(void) nvlist_alloc(&nvl, NV_UNIQUE_NAME, KM_SLEEP);
fnvlist_add_uint32(nvl, FM_CACHE_INFO_NCPUS, walk.nhdl);
for (uint_t i = 0; i < walk.nhdl; i++) {
if ((ret = fm_populate_cache(walk.hdls[i], nvl, i)) != 0) {
break;
}
cmi_hdl_rele(walk.hdls[i]);
}
walk_fini(&walk);
if (ret == 0) {
*onvlp = nvl;
} else {
nvlist_free(nvl);
}
return (ret);
}