#include <stdio.h>
#include <stdlib.h>
#include <stdarg.h>
#include <string.h>
#include <strings.h>
#include <libnvpair.h>
#include <kstat.h>
#include <unistd.h>
#include <sys/types.h>
#include <fm/topo_mod.h>
#include <sys/devfm.h>
#include <fm/fmd_agent.h>
#define BUFSZ 128
char *
get_fmtstr(topo_mod_t *mod, nvlist_t *in)
{
char *fmtstr;
nvlist_t *args;
int ret;
topo_mod_dprintf(mod, "get_fmtstr() called\n");
if ((ret = nvlist_lookup_nvlist(in, TOPO_PROP_ARGS, &args)) != 0) {
topo_mod_dprintf(mod, "Failed to lookup 'args' list (%s)\n",
strerror(ret));
(void) topo_mod_seterrno(mod, EMOD_NVL_INVAL);
return (NULL);
}
if ((ret = nvlist_lookup_string(args, "format", &fmtstr)) != 0) {
topo_mod_dprintf(mod, "Failed to lookup 'format' arg (%s)\n",
strerror(ret));
(void) topo_mod_seterrno(mod, EMOD_NVL_INVAL);
return (NULL);
}
return (fmtstr);
}
int
store_prop_val(topo_mod_t *mod, char *buf, char *propname, nvlist_t **out)
{
if (topo_mod_nvalloc(mod, out, NV_UNIQUE_NAME) != 0) {
topo_mod_dprintf(mod, "Failed to allocate 'out' nvlist\n");
return (topo_mod_seterrno(mod, EMOD_NOMEM));
}
if (nvlist_add_string(*out, TOPO_PROP_VAL_NAME, propname) != 0) {
topo_mod_dprintf(mod, "Failed to set '%s'\n",
TOPO_PROP_VAL_NAME);
nvlist_free(*out);
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if (nvlist_add_uint32(*out, TOPO_PROP_VAL_TYPE, TOPO_TYPE_STRING)
!= 0) {
topo_mod_dprintf(mod, "Failed to set '%s'\n",
TOPO_PROP_VAL_TYPE);
nvlist_free(*out);
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if (nvlist_add_string(*out, TOPO_PROP_VAL_VAL, buf) != 0) {
topo_mod_dprintf(mod, "Failed to set '%s'\n",
TOPO_PROP_VAL_VAL);
nvlist_free(*out);
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
return (0);
}
int
simple_dimm_label(topo_mod_t *mod, tnode_t *node, topo_version_t vers,
nvlist_t *in, nvlist_t **out)
{
char *fmtstr, buf[BUFSZ];
int ret;
uint32_t offset;
nvlist_t *args;
topo_mod_dprintf(mod, "simple_dimm_label() called\n");
if ((ret = nvlist_lookup_nvlist(in, TOPO_PROP_ARGS, &args)) != 0) {
topo_mod_dprintf(mod, "Failed to lookup 'args' list (%s)\n",
strerror(ret));
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if ((ret = nvlist_lookup_uint32(args, "offset", &offset)) != 0) {
topo_mod_dprintf(mod, "Failed to lookup 'offset' arg (%s)\n",
strerror(ret));
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if ((fmtstr = get_fmtstr(mod, in)) == NULL) {
topo_mod_dprintf(mod, "Failed to retrieve 'format' arg\n");
return (-1);
}
(void) snprintf(buf, BUFSZ, fmtstr,
(topo_node_instance(node) + offset));
if (store_prop_val(mod, buf, "label", out) != 0) {
topo_mod_dprintf(mod, "Failed to set label\n");
return (-1);
}
return (0);
}
int
simple_dimm_label_mp(topo_mod_t *mod, tnode_t *node, topo_version_t vers,
nvlist_t *in, nvlist_t **out)
{
char *fmtstr, *order, buf[BUFSZ];
tnode_t *chip;
int ret;
uint32_t offset, dimms_per_chip;
nvlist_t *args;
topo_mod_dprintf(mod, "simple_dimm_label_mp() called\n");
if ((ret = nvlist_lookup_nvlist(in, TOPO_PROP_ARGS, &args)) != 0) {
topo_mod_dprintf(mod, "Failed to lookup 'args' list (%s)\n",
strerror(ret));
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if ((ret = nvlist_lookup_uint32(args, "offset", &offset)) != 0) {
topo_mod_dprintf(mod, "Failed to lookup 'offset' arg (%s)\n",
strerror(ret));
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if ((ret = nvlist_lookup_uint32(args, "dimms_per_chip",
&dimms_per_chip)) != 0) {
topo_mod_dprintf(mod, "Failed to lookup 'dimms_per_chip' arg "
"(%s)\n", strerror(ret));
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if ((ret = nvlist_lookup_string(args, "order", &order)) != 0) {
topo_mod_dprintf(mod, "Failed to lookup 'order' arg (%s)\n",
strerror(ret));
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if ((fmtstr = get_fmtstr(mod, in)) == NULL) {
topo_mod_dprintf(mod, "Failed to retrieve 'format' arg\n");
topo_mod_free(mod, order, BUFSZ);
return (-1);
}
chip = topo_node_parent(topo_node_parent(node));
if (strcasecmp(order, "forward") == 0)
(void) snprintf(buf, BUFSZ, fmtstr, topo_node_instance(chip),
(topo_node_instance(node) + offset));
else if (strcasecmp(order, "reverse") == 0)
(void) snprintf(buf, BUFSZ, fmtstr, topo_node_instance(chip),
(((topo_node_instance(chip) + 1) * dimms_per_chip)
- (topo_node_instance(node)) - 1 + offset));
else {
topo_mod_dprintf(mod, "Invalid value for order arg\n");
topo_mod_free(mod, order, BUFSZ);
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if (store_prop_val(mod, buf, "label", out) != 0) {
topo_mod_dprintf(mod, "Failed to set label\n");
topo_mod_free(mod, order, BUFSZ);
return (-1);
}
return (0);
}
int
seq_dimm_label(topo_mod_t *mod, tnode_t *node, topo_version_t vers,
nvlist_t *in, nvlist_t **out)
{
char *fmtstr, *order, buf[BUFSZ];
int ret;
uint32_t offset;
nvlist_t *args;
tnode_t *chip;
topo_mod_dprintf(mod, "seq_dimm_label() called\n");
if ((ret = nvlist_lookup_nvlist(in, TOPO_PROP_ARGS, &args)) != 0) {
topo_mod_dprintf(mod, "Failed to lookup 'args' list (%s)\n",
strerror(ret));
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if ((ret = nvlist_lookup_uint32(args, "offset", &offset)) != 0) {
topo_mod_dprintf(mod, "Failed to lookup 'offset' arg (%s)\n",
strerror(ret));
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if ((ret = nvlist_lookup_string(args, "order", &order)) != 0) {
topo_mod_dprintf(mod, "Failed to lookup 'order' arg (%s)\n",
strerror(ret));
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if ((fmtstr = get_fmtstr(mod, in)) == NULL) {
topo_mod_dprintf(mod, "Failed to retrieve 'format' arg\n");
topo_mod_free(mod, order, BUFSZ);
return (-1);
}
chip = topo_node_parent(topo_node_parent(node));
if (strcasecmp(order, "forward") == 0)
(void) snprintf(buf, BUFSZ, fmtstr, ((topo_node_instance(node))
+ (topo_node_instance(chip) * 4) + offset));
else if (strcasecmp(order, "reverse") == 0)
(void) snprintf(buf, BUFSZ, fmtstr,
(((topo_node_instance(chip) + 1) * 4)
- (topo_node_instance(node)) - 1 + offset));
else {
topo_mod_dprintf(mod, "Invalid value for order arg\n");
topo_mod_free(mod, order, BUFSZ);
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if (store_prop_val(mod, buf, "label", out) != 0) {
topo_mod_dprintf(mod, "Failed to set label\n");
topo_mod_free(mod, order, BUFSZ);
return (-1);
}
return (0);
}
int
simple_chip_label(topo_mod_t *mod, tnode_t *node, topo_version_t vers,
nvlist_t *in, nvlist_t **out)
{
char *fmtstr, buf[BUFSZ];
int ret;
uint32_t offset;
nvlist_t *args;
topo_mod_dprintf(mod, "simple_chip_label() called\n");
if ((ret = nvlist_lookup_nvlist(in, TOPO_PROP_ARGS, &args)) != 0) {
topo_mod_dprintf(mod, "Failed to lookup 'args' list (%s)\n",
strerror(ret));
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if ((ret = nvlist_lookup_uint32(args, "offset", &offset)) != 0) {
topo_mod_dprintf(mod, "Failed to lookup 'offset' arg (%s)\n",
strerror(ret));
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if ((fmtstr = get_fmtstr(mod, in)) == NULL) {
topo_mod_dprintf(mod, "Failed to retrieve 'format' arg\n");
return (-1);
}
(void) snprintf(buf, BUFSZ, fmtstr,
(topo_node_instance(node) + offset));
if (store_prop_val(mod, buf, "label", out) != 0) {
topo_mod_dprintf(mod, "Failed to set label\n");
return (-1);
}
return (0);
}
int
fsb2_chip_label(topo_mod_t *mod, tnode_t *node, topo_version_t vers,
nvlist_t *in, nvlist_t **out)
{
char *fmtstr, buf[BUFSZ];
int ret;
uint32_t offset;
nvlist_t *args;
topo_mod_dprintf(mod, "fsb2_chip_label() called\n");
if ((ret = nvlist_lookup_nvlist(in, TOPO_PROP_ARGS, &args)) != 0) {
topo_mod_dprintf(mod, "Failed to lookup 'args' list (%s)\n",
strerror(ret));
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if ((ret = nvlist_lookup_uint32(args, "offset", &offset)) != 0) {
topo_mod_dprintf(mod, "Failed to lookup 'offset' arg (%s)\n",
strerror(ret));
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if ((fmtstr = get_fmtstr(mod, in)) == NULL) {
topo_mod_dprintf(mod, "Failed to retrieve 'format' arg\n");
return (-1);
}
(void) snprintf(buf, BUFSZ, fmtstr,
((topo_node_instance(node) / 2) + offset));
if (store_prop_val(mod, buf, "label", out) != 0) {
topo_mod_dprintf(mod, "Failed to set label\n");
return (-1);
}
return (0);
}
int
g4_chip_label(topo_mod_t *mod, tnode_t *node, topo_version_t vers,
nvlist_t *in, nvlist_t **out)
{
char *fmtstr, buf[BUFSZ], slot_id;
int err, htid, mapidx;
uint32_t num_nodes;
const char *g4map[] = {
"AB",
"ADEH",
"ABDEFH",
"ACBDEFGH"
};
topo_mod_dprintf(mod, "g4_chip_label() called\n");
if ((fmtstr = get_fmtstr(mod, in)) == NULL) {
topo_mod_dprintf(mod, "Failed to retrieve 'format' arg\n");
return (-1);
}
if (topo_prop_get_uint32(node, "chip-properties", "CoherentNodes",
&num_nodes, &err) != 0) {
if (err == ETOPO_PROP_NOENT) {
if (store_prop_val(mod, "", "label", out) != 0) {
topo_mod_dprintf(mod, "Failed to set label\n");
return (-1);
}
return (0);
} else {
topo_mod_dprintf(mod, "Failed to lookup 'CoherentNodes'"
"property\n");
return (topo_mod_seterrno(mod, err));
}
}
mapidx = num_nodes / 2 - 1;
htid = topo_node_instance(node);
if (htid >= num_nodes) {
topo_mod_dprintf(mod, "chip node instance range check failed:"
"num_nodes=%d, instance=%d\n", num_nodes, htid);
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
switch (num_nodes) {
case (2):
case (4):
case (6):
case (8):
mapidx = num_nodes / 2 - 1;
slot_id = g4map[mapidx][htid];
break;
default:
topo_mod_dprintf(mod, "Invalid number of CoherentNodes:"
" %d\n", num_nodes);
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
(void) snprintf(buf, BUFSZ, fmtstr, slot_id);
if (store_prop_val(mod, buf, "label", out) != 0) {
topo_mod_dprintf(mod, "Failed to set label\n");
return (-1);
}
return (0);
}
static int
get_num_chips(topo_mod_t *mod)
{
fmd_agent_hdl_t *hdl;
nvlist_t **cpus;
uint_t ncpu;
int i, nchip = 0;
int32_t chipid;
uint64_t bitmap = 0;
if ((hdl = fmd_agent_open(FMD_AGENT_VERSION)) == NULL)
return (-1);
if (fmd_agent_physcpu_info(hdl, &cpus, &ncpu) == -1) {
topo_mod_dprintf(mod, "get physcpu info failed:%s\n",
fmd_agent_errmsg(hdl));
fmd_agent_close(hdl);
return (-1);
}
fmd_agent_close(hdl);
for (i = 0; i < ncpu; i++) {
if (nvlist_lookup_int32(cpus[i], FM_PHYSCPU_INFO_CHIP_ID,
&chipid) != 0 || chipid >= 64) {
topo_mod_dprintf(mod, "lookup chipid failed\n");
nchip = -1;
break;
}
if ((bitmap & (1ULL << chipid)) != 0) {
bitmap |= (1ULL << chipid);
nchip++;
}
}
for (i = 0; i < ncpu; i++)
nvlist_free(cpus[i]);
umem_free(cpus, sizeof (nvlist_t *) * ncpu);
return (nchip);
}
int
a4fplus_chip_label(topo_mod_t *mod, tnode_t *node, topo_version_t vers,
nvlist_t *in, nvlist_t **out)
{
char *fmtstr, buf[BUFSZ];
int num_nodes;
topo_mod_dprintf(mod, "a4fplus_chip_label() called\n");
if ((fmtstr = get_fmtstr(mod, in)) == NULL) {
topo_mod_dprintf(mod, "Failed to retrieve 'format' arg\n");
return (-1);
}
if ((num_nodes = get_num_chips(mod)) < 0) {
topo_mod_dprintf(mod, "Failed to determine number of chip "
"nodes\n");
return (topo_mod_seterrno(mod, EMOD_UNKNOWN));
}
switch (num_nodes) {
case (2):
(void) snprintf(buf, BUFSZ, fmtstr,
topo_node_instance(node) + 2);
break;
case (4):
(void) snprintf(buf, BUFSZ, fmtstr,
topo_node_instance(node));
break;
default:
topo_mod_dprintf(mod, "Invalid number of chip nodes:"
" %d\n", num_nodes);
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if (store_prop_val(mod, buf, "label", out) != 0) {
topo_mod_dprintf(mod, "Failed to set label\n");
return (-1);
}
return (0);
}
int
simple_cs_label_mp(topo_mod_t *mod, tnode_t *node, topo_version_t vers,
nvlist_t *in, nvlist_t **out)
{
char *fmtstr, buf[BUFSZ];
tnode_t *chip, *chan;
int dimm_num, ret;
uint32_t offset;
nvlist_t *args;
topo_mod_dprintf(mod, "simple_cs_label_mp() called\n");
if ((ret = nvlist_lookup_nvlist(in, TOPO_PROP_ARGS, &args)) != 0) {
topo_mod_dprintf(mod, "Failed to lookup 'args' list (%s)\n",
strerror(ret));
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if ((ret = nvlist_lookup_uint32(args, "offset", &offset)) != 0) {
topo_mod_dprintf(mod, "Failed to lookup 'offset' arg (%s)\n",
strerror(ret));
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if ((fmtstr = get_fmtstr(mod, in)) == NULL) {
topo_mod_dprintf(mod, "Failed to retrieve 'format' arg\n");
return (-1);
}
chip = topo_node_parent(topo_node_parent(topo_node_parent(node)));
chan = topo_node_parent(node);
dimm_num = topo_node_instance(node) - (topo_node_instance(node) % 2)
+ topo_node_instance(chan) + offset;
(void) snprintf(buf, BUFSZ, fmtstr, topo_node_instance(chip),
dimm_num);
if (store_prop_val(mod, buf, "label", out) != 0) {
topo_mod_dprintf(mod, "Failed to set label\n");
return (-1);
}
return (0);
}
int
g4_dimm_label(topo_mod_t *mod, tnode_t *node, topo_version_t vers,
nvlist_t *in, nvlist_t **out)
{
char *fmtstr, *chip_lbl, buf[BUFSZ];
tnode_t *chip;
int ret, err = 0;
uint32_t offset;
nvlist_t *args;
topo_mod_dprintf(mod, "g4_dimm_label() called\n");
if ((ret = nvlist_lookup_nvlist(in, TOPO_PROP_ARGS, &args)) != 0) {
topo_mod_dprintf(mod, "Failed to lookup 'args' list (%s)\n",
strerror(ret));
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if ((ret = nvlist_lookup_uint32(args, "offset", &offset)) != 0) {
topo_mod_dprintf(mod, "Failed to lookup 'offset' arg (%s)\n",
strerror(ret));
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if ((fmtstr = get_fmtstr(mod, in)) == NULL) {
topo_mod_dprintf(mod, "Failed to retrieve 'format' arg\n");
return (-1);
}
chip = topo_node_parent(topo_node_parent(node));
if (topo_prop_get_string(chip, TOPO_PGROUP_PROTOCOL, "label", &chip_lbl,
&err) != 0) {
topo_mod_dprintf(mod, "Failed to lookup label prop on %s=%"
PRIu64 ": %s\n", topo_node_name(chip),
topo_node_instance(chip), topo_strerror(err));
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
(void) snprintf(buf, BUFSZ, fmtstr, chip_lbl,
(topo_node_instance(node) + offset));
topo_mod_strfree(mod, chip_lbl);
if (store_prop_val(mod, buf, "label", out) != 0) {
topo_mod_dprintf(mod, "Failed to set label\n");
return (-1);
}
return (0);
}
int
g12f_dimm_label(topo_mod_t *mod, tnode_t *node, topo_version_t vers,
nvlist_t *in, nvlist_t **out)
{
char *fmtstr, buf[BUFSZ], chan;
tnode_t *chip;
int ret, dimm_inst, slot_num;
nvlist_t *args;
topo_mod_dprintf(mod, "g12f_dimm_label() called\n");
if ((ret = nvlist_lookup_nvlist(in, TOPO_PROP_ARGS, &args)) != 0) {
topo_mod_dprintf(mod, "Failed to lookup 'args' list (%s)\n",
strerror(ret));
return (topo_mod_seterrno(mod, EMOD_NVL_INVAL));
}
if ((fmtstr = get_fmtstr(mod, in)) == NULL) {
topo_mod_dprintf(mod, "Failed to retrieve 'format' arg\n");
return (-1);
}
chip = topo_node_parent(topo_node_parent(node));
dimm_inst = topo_node_instance(node);
chan = dimm_inst == 0 || dimm_inst == 2 ? 'A': 'B';
slot_num = (dimm_inst <= 1 ? 0 : 1);
(void) snprintf(buf, BUFSZ, fmtstr, topo_node_instance(chip) + 1, chan,
slot_num);
if (store_prop_val(mod, buf, "label", out) != 0) {
topo_mod_dprintf(mod, "Failed to set label\n");
return (-1);
}
return (0);
}