03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel#include <sys/types.h>

03831d35f7499c87d51205817c93e9a8d42c4baestevel#include <sys/conf.h>

03831d35f7499c87d51205817c93e9a8d42c4baestevel#include <sys/file.h>

03831d35f7499c87d51205817c93e9a8d42c4baestevel#include <sys/ddi.h>

03831d35f7499c87d51205817c93e9a8d42c4baestevel#include <sys/sunddi.h>

03831d35f7499c87d51205817c93e9a8d42c4baestevel#include <sys/modctl.h>

03831d35f7499c87d51205817c93e9a8d42c4baestevel#include <sys/sunndi.h>

03831d35f7499c87d51205817c93e9a8d42c4baestevel#include <sys/ddi_impldefs.h>

03831d35f7499c87d51205817c93e9a8d42c4baestevel#include <sys/obpdefs.h>

03831d35f7499c87d51205817c93e9a8d42c4baestevel#include <sys/cmn_err.h>

03831d35f7499c87d51205817c93e9a8d42c4baestevel#include <sys/errno.h>

03831d35f7499c87d51205817c93e9a8d42c4baestevel#include <sys/debug.h>

03831d35f7499c87d51205817c93e9a8d42c4baestevel#include <sys/sysmacros.h>

03831d35f7499c87d51205817c93e9a8d42c4baestevel#include <sys/autoconf.h>

03831d35f7499c87d51205817c93e9a8d42c4baestevel#include <sys/stat.h>

03831d35f7499c87d51205817c93e9a8d42c4baestevel#include <sys/kmem.h>

03831d35f7499c87d51205817c93e9a8d42c4baestevel#include <sys/sgsbbc_mailbox.h>

03831d35f7499c87d51205817c93e9a8d42c4baestevel#include <sys/sgfrutree.h>

03831d35f7499c87d51205817c93e9a8d42c4baestevel#include <sys/sgfru_priv.h>

03831d35f7499c87d51205817c93e9a8d42c4baestevel#include <sys/sgfru_mbox.h>

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel#ifdef DEBUG

03831d35f7499c87d51205817c93e9a8d42c4baesteveluint_t sgfru_debug = 0;

03831d35f7499c87d51205817c93e9a8d42c4baestevel#endif /* DEBUG */

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic void *sgfru_statep; /* sgfru soft state hook */

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelint sgfru_mbox_wait = SGFRU_DEFAULT_MAX_MBOX_WAIT_TIME;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic struct cb_ops sgfru_cb_ops = {

03831d35f7499c87d51205817c93e9a8d42c4baestevel sgfru_open, /* open */

03831d35f7499c87d51205817c93e9a8d42c4baestevel sgfru_close, /* close */

03831d35f7499c87d51205817c93e9a8d42c4baestevel nulldev, /* strategy */

03831d35f7499c87d51205817c93e9a8d42c4baestevel nulldev, /* print */

03831d35f7499c87d51205817c93e9a8d42c4baestevel nulldev, /* dump */

03831d35f7499c87d51205817c93e9a8d42c4baestevel nulldev, /* read */

03831d35f7499c87d51205817c93e9a8d42c4baestevel nulldev, /* write */

03831d35f7499c87d51205817c93e9a8d42c4baestevel sgfru_ioctl, /* ioctl */

03831d35f7499c87d51205817c93e9a8d42c4baestevel nulldev, /* devmap */

03831d35f7499c87d51205817c93e9a8d42c4baestevel nulldev, /* mmap */

03831d35f7499c87d51205817c93e9a8d42c4baestevel nulldev, /* segmap */

03831d35f7499c87d51205817c93e9a8d42c4baestevel nochpoll, /* poll */

03831d35f7499c87d51205817c93e9a8d42c4baestevel ddi_prop_op, /* cb_prop_op */

03831d35f7499c87d51205817c93e9a8d42c4baestevel NULL, /* streamtab */

03831d35f7499c87d51205817c93e9a8d42c4baestevel D_NEW | D_MP /* Driver compatibility flag */

03831d35f7499c87d51205817c93e9a8d42c4baestevel};

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic struct dev_ops sgfru_ops = {

03831d35f7499c87d51205817c93e9a8d42c4baestevel DEVO_REV, /* devo_rev, */

03831d35f7499c87d51205817c93e9a8d42c4baestevel 0, /* refcnt */

03831d35f7499c87d51205817c93e9a8d42c4baestevel ddi_getinfo_1to1, /* info */

03831d35f7499c87d51205817c93e9a8d42c4baestevel nulldev, /* identify */

03831d35f7499c87d51205817c93e9a8d42c4baestevel nulldev, /* probe */

03831d35f7499c87d51205817c93e9a8d42c4baestevel sgfru_attach, /* attach */

03831d35f7499c87d51205817c93e9a8d42c4baestevel sgfru_detach, /* detach */

03831d35f7499c87d51205817c93e9a8d42c4baestevel nodev, /* reset */

03831d35f7499c87d51205817c93e9a8d42c4baestevel &sgfru_cb_ops, /* driver operations */

03831d35f7499c87d51205817c93e9a8d42c4baestevel (struct bus_ops *)0, /* bus operations */

193974072f41a843678abf5f61979c748687e66bSherry Moore nulldev, /* power */

193974072f41a843678abf5f61979c748687e66bSherry Moore ddi_quiesce_not_needed, /* quiesce */

03831d35f7499c87d51205817c93e9a8d42c4baestevel};

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelextern struct mod_ops mod_driverops;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic struct modldrv modldrv = {

03831d35f7499c87d51205817c93e9a8d42c4baestevel &mod_driverops, /* Type of module. This one is a pseudo driver */

193974072f41a843678abf5f61979c748687e66bSherry Moore "FRU Driver",

03831d35f7499c87d51205817c93e9a8d42c4baestevel &sgfru_ops, /* driver ops */

03831d35f7499c87d51205817c93e9a8d42c4baestevel};

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic struct modlinkage modlinkage = {

03831d35f7499c87d51205817c93e9a8d42c4baestevel MODREV_1,

03831d35f7499c87d51205817c93e9a8d42c4baestevel (void *)&modldrv,

03831d35f7499c87d51205817c93e9a8d42c4baestevel NULL

03831d35f7499c87d51205817c93e9a8d42c4baestevel};

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel_init(void)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel int error = 0;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* Allocate the soft state info and add the module. */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((error = ddi_soft_state_init(&sgfru_statep,

03831d35f7499c87d51205817c93e9a8d42c4baestevel sizeof (sgfru_soft_state_t), 1)) == 0 &&

03831d35f7499c87d51205817c93e9a8d42c4baestevel (error = mod_install(&modlinkage)) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel ddi_soft_state_fini(&sgfru_statep);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (error);

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel_fini(void)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel int error = 0;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* Remove the module and free the soft state info. */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((error = mod_remove(&modlinkage)) == 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel ddi_soft_state_fini(&sgfru_statep);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (error);

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel_info(struct modinfo *modinfop)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (mod_info(&modlinkage, modinfop));

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic int

03831d35f7499c87d51205817c93e9a8d42c4baestevelsgfru_attach(dev_info_t *dip, ddi_attach_cmd_t cmd)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel sgfru_soft_state_t *softsp;

03831d35f7499c87d51205817c93e9a8d42c4baestevel int instance;

03831d35f7499c87d51205817c93e9a8d42c4baestevel int error;

03831d35f7499c87d51205817c93e9a8d42c4baestevel static fn_t f = "sgfru_attach";

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel switch (cmd) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel case DDI_ATTACH:

03831d35f7499c87d51205817c93e9a8d42c4baestevel instance = ddi_get_instance(dip);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel error = ddi_soft_state_zalloc(sgfru_statep, instance);

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (error != DDI_SUCCESS) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel cmn_err(CE_WARN, "sgfru:%s: cannot allocate fru state "

03831d35f7499c87d51205817c93e9a8d42c4baestevel "for inst %d.", f, instance);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (DDI_FAILURE);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel softsp = ddi_get_soft_state(sgfru_statep, instance);

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (softsp == NULL) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel ddi_soft_state_free(sgfru_statep, instance);

03831d35f7499c87d51205817c93e9a8d42c4baestevel cmn_err(CE_WARN, "sgfru:%s: could not get state "

03831d35f7499c87d51205817c93e9a8d42c4baestevel "structure for inst %d.", f, instance);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (DDI_FAILURE);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel softsp->fru_dip = dip;

03831d35f7499c87d51205817c93e9a8d42c4baestevel softsp->fru_pdip = ddi_get_parent(softsp->fru_dip);

03831d35f7499c87d51205817c93e9a8d42c4baestevel softsp->instance = instance;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel error = ddi_create_minor_node(dip, SGFRU_DRV_NAME, S_IFCHR,

03831d35f7499c87d51205817c93e9a8d42c4baestevel instance, DDI_PSEUDO, NULL);

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (error == DDI_FAILURE) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel ddi_soft_state_free(sgfru_statep, instance);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (DDI_FAILURE);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel ddi_report_dev(dip);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (DDI_SUCCESS);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case DDI_RESUME:

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (DDI_SUCCESS);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel default:

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (DDI_FAILURE);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic int

03831d35f7499c87d51205817c93e9a8d42c4baestevelsgfru_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel int instance;

03831d35f7499c87d51205817c93e9a8d42c4baestevel sgfru_soft_state_t *softsp;

03831d35f7499c87d51205817c93e9a8d42c4baestevel static fn_t f = "sgfru_detach";

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel instance = ddi_get_instance(dip);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel softsp = ddi_get_soft_state(sgfru_statep, instance);

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (softsp == NULL) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel cmn_err(CE_WARN, "sgfru:%s: could not get state "

03831d35f7499c87d51205817c93e9a8d42c4baestevel "structure for inst %d.", f, instance);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (DDI_FAILURE);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel switch (cmd) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel case DDI_DETACH:

03831d35f7499c87d51205817c93e9a8d42c4baestevel ddi_soft_state_free(sgfru_statep, instance);

03831d35f7499c87d51205817c93e9a8d42c4baestevel ddi_remove_minor_node(dip, NULL);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (DDI_SUCCESS);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case DDI_SUSPEND:

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (DDI_SUCCESS);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel default:

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (DDI_FAILURE);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic int

03831d35f7499c87d51205817c93e9a8d42c4baestevelsgfru_open(dev_t *dev_p, int flag, int otyp, cred_t *cred_p)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel int error = 0;

03831d35f7499c87d51205817c93e9a8d42c4baestevel int instance = getminor(*dev_p);

03831d35f7499c87d51205817c93e9a8d42c4baestevel sgfru_soft_state_t *softsp;

03831d35f7499c87d51205817c93e9a8d42c4baestevel static fn_t f = "sgfru_open";

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((error = drv_priv(cred_p)) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel cmn_err(CE_WARN, "sgfru:%s: inst %d drv_priv failed",

03831d35f7499c87d51205817c93e9a8d42c4baestevel f, instance);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (error);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel softsp = (sgfru_soft_state_t *)ddi_get_soft_state(sgfru_statep,

03831d35f7499c87d51205817c93e9a8d42c4baestevel instance);

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (softsp == (sgfru_soft_state_t *)NULL) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel cmn_err(CE_WARN, "sgfru:%s: inst %d ddi_get_soft_state failed",

03831d35f7499c87d51205817c93e9a8d42c4baestevel f, instance);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ENXIO);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (error);

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic int

03831d35f7499c87d51205817c93e9a8d42c4baestevelsgfru_close(dev_t dev, int flag, int otyp, cred_t *cred_p)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel int instance = getminor(dev);

03831d35f7499c87d51205817c93e9a8d42c4baestevel sgfru_soft_state_t *softsp = (sgfru_soft_state_t *)

03831d35f7499c87d51205817c93e9a8d42c4baestevel ddi_get_soft_state(sgfru_statep, instance);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (softsp == (sgfru_soft_state_t *)NULL)

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ENXIO);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (DDI_SUCCESS);

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic int

03831d35f7499c87d51205817c93e9a8d42c4baestevelsgfru_ioctl(dev_t dev, int cmd, intptr_t arg, int mode, cred_t *cred_p,

03831d35f7499c87d51205817c93e9a8d42c4baestevel int *rval_p)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel sgfru_soft_state_t *softsp;

03831d35f7499c87d51205817c93e9a8d42c4baestevel int instance = getminor(dev);

03831d35f7499c87d51205817c93e9a8d42c4baestevel sgfru_init_arg_t init_arg;

03831d35f7499c87d51205817c93e9a8d42c4baestevel int32_t ret = 0;

03831d35f7499c87d51205817c93e9a8d42c4baestevel static fn_t f = "sgfru_ioctl";

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel softsp = ddi_get_soft_state(sgfru_statep, instance);

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (softsp == NULL) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ENXIO);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel PR_STATE("sgfru:%s: dev %lx cmd %d, instance %d\n",

03831d35f7499c87d51205817c93e9a8d42c4baestevel f, dev, cmd, instance);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel init_arg.dev = dev;

03831d35f7499c87d51205817c93e9a8d42c4baestevel init_arg.cmd = cmd;

03831d35f7499c87d51205817c93e9a8d42c4baestevel init_arg.mode = mode;

03831d35f7499c87d51205817c93e9a8d42c4baestevel init_arg.argp = arg;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel switch (cmd) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_GETSECTIONS:

03831d35f7499c87d51205817c93e9a8d42c4baestevel ret = sgfru_getsections(&init_arg);

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_GETSEGMENTS:

03831d35f7499c87d51205817c93e9a8d42c4baestevel ret = sgfru_getsegments(&init_arg);

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_ADDSEGMENT:

03831d35f7499c87d51205817c93e9a8d42c4baestevel ret = sgfru_addsegment(&init_arg);

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_READRAWSEGMENT:

03831d35f7499c87d51205817c93e9a8d42c4baestevel ret = sgfru_readsegment(&init_arg);

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_WRITERAWSEGMENT:

03831d35f7499c87d51205817c93e9a8d42c4baestevel ret = sgfru_writesegment(&init_arg);

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_GETPACKETS:

03831d35f7499c87d51205817c93e9a8d42c4baestevel ret = sgfru_getpackets(&init_arg);

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_APPENDPACKET:

03831d35f7499c87d51205817c93e9a8d42c4baestevel ret = sgfru_appendpacket(&init_arg);

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_GETPAYLOAD:

03831d35f7499c87d51205817c93e9a8d42c4baestevel ret = sgfru_getpayload(&init_arg);

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_UPDATEPAYLOAD:

03831d35f7499c87d51205817c93e9a8d42c4baestevel ret = sgfru_updatepayload(&init_arg);

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_GETNUMSECTIONS:

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_GETNUMSEGMENTS:

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_GETNUMPACKETS:

03831d35f7499c87d51205817c93e9a8d42c4baestevel ret = sgfru_getnum(&init_arg);

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_DELETESEGMENT:

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_DELETEPACKET:

03831d35f7499c87d51205817c93e9a8d42c4baestevel ret = sgfru_delete(&init_arg);

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_GETCHILDLIST:

03831d35f7499c87d51205817c93e9a8d42c4baestevel ret = sgfru_getchildlist(&init_arg);

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_GETCHILDHANDLES:

03831d35f7499c87d51205817c93e9a8d42c4baestevel ret = sgfru_getchildhandles(&init_arg);

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_GETNODEINFO:

03831d35f7499c87d51205817c93e9a8d42c4baestevel ret = sgfru_getnodeinfo(&init_arg);

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel default:

03831d35f7499c87d51205817c93e9a8d42c4baestevel ret = EINVAL;

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic int

03831d35f7499c87d51205817c93e9a8d42c4baestevelsgfru_getchildlist(const sgfru_init_arg_t *iargp)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel int32_t ret;

03831d35f7499c87d51205817c93e9a8d42c4baestevel caddr_t datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel size_t ssize, size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel frup_info_t clist;

03831d35f7499c87d51205817c93e9a8d42c4baestevel fru_cnt_t max_cnt;

03831d35f7499c87d51205817c93e9a8d42c4baestevel node_t *clistp;

03831d35f7499c87d51205817c93e9a8d42c4baestevel static fn_t f = "sgfru_getchildlist";

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyin child_info_t aka frup_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyin_frup(iargp, &clist) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* check on kmem_alloc space requirements */

03831d35f7499c87d51205817c93e9a8d42c4baestevel max_cnt = clist.fru_cnt;

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((max_cnt <= 0) || (max_cnt > MAX_HANDLES)) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EINVAL);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* allocate buffer for unpadded fru_info_t + node_t's */

03831d35f7499c87d51205817c93e9a8d42c4baestevel size = (size_t)(FRU_INFO_SIZE + (max_cnt * NODE_SIZE));

03831d35f7499c87d51205817c93e9a8d42c4baestevel datap = kmem_zalloc(size, KM_SLEEP);

03831d35f7499c87d51205817c93e9a8d42c4baestevel PR_NODE("sgfru:%s: FRU_INFO_SIZE %lu NODE_SIZE %lu size %lu\n",

03831d35f7499c87d51205817c93e9a8d42c4baestevel f, FRU_INFO_SIZE, NODE_SIZE, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel PR_NODE("sgfru:%s: handle %lx cnt %d buffer 0x%p\n", f,

03831d35f7499c87d51205817c93e9a8d42c4baestevel clist.fru_hdl, clist.fru_cnt, clist.frus);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* call mailbox */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((ret = sgfru_mbox(iargp->cmd, datap, size, &clist.fru_info))

03831d35f7499c87d51205817c93e9a8d42c4baestevel != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* allocate buffer for padded node_t's */

03831d35f7499c87d51205817c93e9a8d42c4baestevel ssize = (size_t)(max_cnt * sizeof (node_t));

03831d35f7499c87d51205817c93e9a8d42c4baestevel clistp = (node_t *)kmem_zalloc(ssize, KM_SLEEP);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* translate unpadded to padded fru_info_t + node_t's */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((ret = sgfru_node_pad(datap, max_cnt, &clist.fru_info, clistp))

03831d35f7499c87d51205817c93e9a8d42c4baestevel != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(clistp, ssize);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* free node_t buffer */

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copy out fru_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_fru(iargp, &clist.fru_info) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(clistp, ssize);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyout node_t's */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_nodes(iargp, &clist, clistp) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(clistp, ssize);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* free node_t buffer */

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(clistp, ssize);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic int

03831d35f7499c87d51205817c93e9a8d42c4baestevelsgfru_getchildhandles(const sgfru_init_arg_t *iargp)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel int32_t ret;

03831d35f7499c87d51205817c93e9a8d42c4baestevel size_t size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel caddr_t datap, tdatap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel frup_info_t hdls;

03831d35f7499c87d51205817c93e9a8d42c4baestevel fru_info_t hinfo;

03831d35f7499c87d51205817c93e9a8d42c4baestevel fru_cnt_t max_cnt;

03831d35f7499c87d51205817c93e9a8d42c4baestevel static fn_t f = "sgfru_getchildhandles";

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyin handles_t aka frup_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyin_frup(iargp, &hdls) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel PR_HANDLE("sgfru:%s: handle %lx\n", f, hdls.fru_hdl);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* check on kmem_alloc space requirements */

03831d35f7499c87d51205817c93e9a8d42c4baestevel max_cnt = hdls.fru_cnt;

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((max_cnt <= 0) || (max_cnt > MAX_HANDLES)) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EINVAL);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* allocate buffer for child fru_hdl_t's */

03831d35f7499c87d51205817c93e9a8d42c4baestevel size = (size_t)(FRU_INFO_SIZE + (max_cnt * FRU_HDL_SIZE));

03831d35f7499c87d51205817c93e9a8d42c4baestevel datap = kmem_zalloc(size, KM_SLEEP);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* call mailbox */

03831d35f7499c87d51205817c93e9a8d42c4baestevel ret = sgfru_mbox(iargp->cmd, datap, size, &hdls.fru_info);

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (ret != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* translate unpadded to fru_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel tdatap = sgfru_fru_pad(datap, &hinfo);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyout actual fru_cnt */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_fru(iargp, &hinfo) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel PR_HANDLE("sgfru:%s: count %x\n", f, hinfo.cnt);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyout fru_hdl_t's */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_handles(iargp, &hdls, (fru_hdl_t *)tdatap) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* free datap buffer */

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic int

03831d35f7499c87d51205817c93e9a8d42c4baestevelsgfru_getnodeinfo(const sgfru_init_arg_t *iargp)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel int32_t ret;

03831d35f7499c87d51205817c93e9a8d42c4baestevel caddr_t datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel size_t size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel frup_info_t nodeinfo;

03831d35f7499c87d51205817c93e9a8d42c4baestevel node_t node;

03831d35f7499c87d51205817c93e9a8d42c4baestevel static fn_t f = "sgfru_getnodeinfo";

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyin node_info_t aka frup_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyin_frup(iargp, &nodeinfo) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* allocate unpadded buffer for node_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel size = (size_t)(NODE_SIZE);

03831d35f7499c87d51205817c93e9a8d42c4baestevel datap = kmem_zalloc(size, KM_SLEEP);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel PR_NODE("sgfru:%s: handle %lx size 0x%lx\n", f, nodeinfo.fru_hdl, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* call mailbox */

03831d35f7499c87d51205817c93e9a8d42c4baestevel ret = sgfru_mbox(iargp->cmd, datap, size, &nodeinfo.fru_info);

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (ret != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* translate unpadded to padded node_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((ret = sgfru_node_pad(datap, 0, NULL, &node))

03831d35f7499c87d51205817c93e9a8d42c4baestevel != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* free node_t buffer */

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyout node_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_nodes(iargp, &nodeinfo, &node) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel PR_NODE("sgfru:%s: handle %lx nodename %s has_children %d class %d\n",

03831d35f7499c87d51205817c93e9a8d42c4baestevel f, node.handle, node.nodename, node.has_children, node.class);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic int

03831d35f7499c87d51205817c93e9a8d42c4baestevelsgfru_getsections(const sgfru_init_arg_t *iargp)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel int32_t ret;

03831d35f7499c87d51205817c93e9a8d42c4baestevel caddr_t datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel size_t ssize, size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel frup_info_t sects;

03831d35f7499c87d51205817c93e9a8d42c4baestevel fru_cnt_t max_cnt;

03831d35f7499c87d51205817c93e9a8d42c4baestevel section_t *sectp;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyin sections_t aka frup_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyin_frup(iargp, &sects) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* check on kmem_alloc space requirements */

03831d35f7499c87d51205817c93e9a8d42c4baestevel max_cnt = sects.fru_cnt;

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((max_cnt <= 0) || (max_cnt > MAX_SECTIONS)) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EINVAL);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* allocate buffer for unpadded fru_info_t + section_t's */

03831d35f7499c87d51205817c93e9a8d42c4baestevel size = (size_t)(FRU_INFO_SIZE + (max_cnt * SECTION_SIZE));

03831d35f7499c87d51205817c93e9a8d42c4baestevel datap = kmem_zalloc(size, KM_SLEEP);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* call mailbox */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((ret = sgfru_mbox(iargp->cmd, datap, size, &sects.fru_info))

03831d35f7499c87d51205817c93e9a8d42c4baestevel != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* allocate buffer for padded section_t's */

03831d35f7499c87d51205817c93e9a8d42c4baestevel ssize = (size_t)(max_cnt * sizeof (section_t));

03831d35f7499c87d51205817c93e9a8d42c4baestevel sectp = (section_t *)kmem_zalloc(ssize, KM_SLEEP);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* translate unpadded to padded fru_info_t + section_t's */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((ret = sgfru_section_pad(datap, max_cnt, &sects.fru_info, sectp))

03831d35f7499c87d51205817c93e9a8d42c4baestevel != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(sectp, ssize);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* free section_t buffer */

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copy out fru_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_fru(iargp, &sects.fru_info) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(sectp, ssize);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyout section_t's */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_sections(iargp, &sects, sectp) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(sectp, ssize);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* free section_t buffer */

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(sectp, ssize);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic int

03831d35f7499c87d51205817c93e9a8d42c4baestevelsgfru_getsegments(const sgfru_init_arg_t *iargp)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel int32_t ret;

03831d35f7499c87d51205817c93e9a8d42c4baestevel caddr_t datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel size_t ssize, size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel frup_info_t segs;

03831d35f7499c87d51205817c93e9a8d42c4baestevel fru_cnt_t max_cnt;

03831d35f7499c87d51205817c93e9a8d42c4baestevel segment_t *segp;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyin frup_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyin_frup(iargp, &segs) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* check on kmem_alloc space requirements */

03831d35f7499c87d51205817c93e9a8d42c4baestevel max_cnt = segs.fru_cnt;

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((max_cnt <= 0) || (max_cnt > MAX_SEGMENTS)) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EINVAL);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* allocate unpadded buffer for fru_info_t + segment_t's */

03831d35f7499c87d51205817c93e9a8d42c4baestevel size = (size_t)(FRU_INFO_SIZE + (max_cnt * SEGMENT_SIZE));

03831d35f7499c87d51205817c93e9a8d42c4baestevel datap = kmem_zalloc(size, KM_SLEEP);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* call mailbox */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((ret = sgfru_mbox(iargp->cmd, datap, size, &segs.fru_info)) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* allocate buffer for padded segment_t's */

03831d35f7499c87d51205817c93e9a8d42c4baestevel ssize = (size_t)(max_cnt * sizeof (segment_t));

03831d35f7499c87d51205817c93e9a8d42c4baestevel segp = (segment_t *)kmem_zalloc(ssize, KM_SLEEP);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* translate unpadded to padded fru_info_t + segment_t's */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((ret = sgfru_segment_pad(datap, max_cnt, &segs.fru_info, segp))

03831d35f7499c87d51205817c93e9a8d42c4baestevel != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(segp, ssize);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* free segment_t buffer */

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copy out fru_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_fru(iargp, &segs.fru_info) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(segp, ssize);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyout segment_t's */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_segments(iargp, &segs, segp) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(segp, ssize);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* free segment_t buffer */

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(segp, ssize);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic int

03831d35f7499c87d51205817c93e9a8d42c4baestevelsgfru_addsegment(const sgfru_init_arg_t *iargp)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel int32_t ret;

03831d35f7499c87d51205817c93e9a8d42c4baestevel caddr_t datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel size_t size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel frup_info_t seg;

03831d35f7499c87d51205817c93e9a8d42c4baestevel segment_t segment;

03831d35f7499c87d51205817c93e9a8d42c4baestevel fru_hdl_t *hdlp;

03831d35f7499c87d51205817c93e9a8d42c4baestevel static fn_t f = "sgfru_addsegment";

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyin frup_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyin_frup(iargp, &seg) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyin segment_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyin_segment(iargp, &seg, &segment) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel PR_SEGMENT("sgfru:%s: handle %lx, max cnt %d\n",

193974072f41a843678abf5f61979c748687e66bSherry Moore f, seg.fru_hdl, seg.fru_cnt);

03831d35f7499c87d51205817c93e9a8d42c4baestevel PR_SEGMENT("sgfru:%s: handle %lx, name %s, descriptor 0x%x, "

193974072f41a843678abf5f61979c748687e66bSherry Moore "offset 0x%x, length 0x%x\n", f, segment.handle, segment.name,

193974072f41a843678abf5f61979c748687e66bSherry Moore segment.descriptor, segment.offset, segment.length);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* allocate buffer for unpadded section_hdl_t + segment_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel size = (size_t)(SECTION_HDL_SIZE + SEGMENT_SIZE);

03831d35f7499c87d51205817c93e9a8d42c4baestevel datap = kmem_zalloc(size, KM_SLEEP);

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* translate padded to unpadded section_hdl_t + segment_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel sgfru_segment_unpad(&seg.fru_info, &segment, datap);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* call mailbox */

03831d35f7499c87d51205817c93e9a8d42c4baestevel ret = sgfru_mbox(iargp->cmd, datap, size, &seg.fru_info);

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (ret != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyout updated section_hdl_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel hdlp = (fru_hdl_t *)(datap + sizeof (fru_hdl_t));

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_handle(iargp, (void *)iargp->argp, hdlp) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyout new segment_hdl_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_handle(iargp, seg.frus, --hdlp) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* free segment_t buffer */

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic int

03831d35f7499c87d51205817c93e9a8d42c4baestevelsgfru_readsegment(const sgfru_init_arg_t *iargp)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel int32_t ret;

03831d35f7499c87d51205817c93e9a8d42c4baestevel caddr_t datap, tdatap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel size_t size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel frup_info_t segs;

03831d35f7499c87d51205817c93e9a8d42c4baestevel fru_info_t sinfo;

03831d35f7499c87d51205817c93e9a8d42c4baestevel fru_cnt_t max_cnt;

03831d35f7499c87d51205817c93e9a8d42c4baestevel static fn_t f = "sgfru_readsegment";

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyin one segments_t aka frup_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyin_frup(iargp, &segs) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* check on kmem_alloc space requirements */

03831d35f7499c87d51205817c93e9a8d42c4baestevel max_cnt = segs.fru_cnt;

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((max_cnt <= 0) || (max_cnt > MAX_SEGMENTSIZE)) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EINVAL);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel PR_SEGMENT("sgfru:%s: handle %lx, max cnt %d\n",

193974072f41a843678abf5f61979c748687e66bSherry Moore f, segs.fru_hdl, segs.fru_cnt);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* allocate unpadded buffer for raw data */

03831d35f7499c87d51205817c93e9a8d42c4baestevel size = (size_t)(FRU_INFO_SIZE + max_cnt);

03831d35f7499c87d51205817c93e9a8d42c4baestevel datap = kmem_zalloc(size, KM_SLEEP);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* call mailbox */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((ret = sgfru_mbox(iargp->cmd, datap, size, &segs.fru_info)) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* translate unpadded to padded fru_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel tdatap = sgfru_fru_pad(datap, &sinfo);

03831d35f7499c87d51205817c93e9a8d42c4baestevel PR_SEGMENT("sgfru:%s: handle %lx, actual cnt %d\n",

193974072f41a843678abf5f61979c748687e66bSherry Moore f, sinfo.hdl, sinfo.cnt);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyout actual fru_cnt */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_fru(iargp, &sinfo) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyout raw segment data */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_buffer(iargp, &segs, tdatap) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* free buffer */

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic int

03831d35f7499c87d51205817c93e9a8d42c4baestevelsgfru_writesegment(const sgfru_init_arg_t *iargp)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel int32_t ret;

03831d35f7499c87d51205817c93e9a8d42c4baestevel caddr_t datap, tdatap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel size_t size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel frup_info_t segs;

03831d35f7499c87d51205817c93e9a8d42c4baestevel fru_cnt_t max_cnt;

03831d35f7499c87d51205817c93e9a8d42c4baestevel static fn_t f = "sgfru_writesegment";

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyin frup_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyin_frup(iargp, &segs) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* check on kmem_alloc space requirements */

03831d35f7499c87d51205817c93e9a8d42c4baestevel max_cnt = segs.fru_cnt;

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((max_cnt <= 0) || (max_cnt > MAX_SEGMENTSIZE)) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EINVAL);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel PR_SEGMENT("sgfru:%s: handle %lx, max cnt %d\n",

193974072f41a843678abf5f61979c748687e66bSherry Moore f, segs.fru_hdl, segs.fru_cnt);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* allocate unpadded buffer for fru_info_t + raw data */

03831d35f7499c87d51205817c93e9a8d42c4baestevel size = (size_t)(FRU_INFO_SIZE + max_cnt);

03831d35f7499c87d51205817c93e9a8d42c4baestevel datap = kmem_zalloc(size, KM_SLEEP);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* translate padded to unpadded fru_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel tdatap = sgfru_fru_unpad(&segs.fru_info, datap);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyin raw segment data */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyin_buffer(iargp, segs.frus, max_cnt, tdatap) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* call mailbox */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((ret = sgfru_mbox(iargp->cmd, datap, size, &segs.fru_info)) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* free buffer */

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel PR_SEGMENT("sgfru:%s: handle %lx, actual cnt %d\n",

193974072f41a843678abf5f61979c748687e66bSherry Moore f, segs.fru_hdl, segs.fru_cnt);

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyout updated segment handle and actual fru_cnt */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_fru(iargp, &segs.fru_info) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic int

03831d35f7499c87d51205817c93e9a8d42c4baestevelsgfru_getpackets(const sgfru_init_arg_t *iargp)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel int32_t ret;

03831d35f7499c87d51205817c93e9a8d42c4baestevel caddr_t datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel size_t ssize, size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel frup_info_t packs;

03831d35f7499c87d51205817c93e9a8d42c4baestevel fru_cnt_t max_cnt;

03831d35f7499c87d51205817c93e9a8d42c4baestevel packet_t *packp;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyin packets_t aka frup_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyin_frup(iargp, &packs) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* check on kmem_alloc space requirements */

03831d35f7499c87d51205817c93e9a8d42c4baestevel max_cnt = packs.fru_cnt;

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((max_cnt <= 0) || (max_cnt > MAX_PACKETS)) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EINVAL);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* allocate buffer for unpadded fru_info_t + packet_t's */

03831d35f7499c87d51205817c93e9a8d42c4baestevel size = (size_t)(FRU_INFO_SIZE + (max_cnt * PACKET_SIZE));

03831d35f7499c87d51205817c93e9a8d42c4baestevel datap = kmem_zalloc(size, KM_SLEEP);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* call mailbox */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((ret = sgfru_mbox(iargp->cmd, datap, size, &packs.fru_info))

03831d35f7499c87d51205817c93e9a8d42c4baestevel != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* allocate buffer for padded packet_t's */

03831d35f7499c87d51205817c93e9a8d42c4baestevel ssize = (size_t)(max_cnt * sizeof (packet_t));

03831d35f7499c87d51205817c93e9a8d42c4baestevel packp = (packet_t *)kmem_zalloc(ssize, KM_SLEEP);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* translate unpadded to padded fru_info_t + packet_t's */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((ret = sgfru_packet_pad(datap, max_cnt, &packs.fru_info, packp))

03831d35f7499c87d51205817c93e9a8d42c4baestevel != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(packp, ssize);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* free packet_t buffer */

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copy out fru_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_fru(iargp, &packs.fru_info) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(packp, ssize);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyout packet_t's */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_packets(iargp, &packs, packp) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(packp, ssize);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* free packet_t buffer */

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(packp, ssize);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic int

03831d35f7499c87d51205817c93e9a8d42c4baestevelsgfru_appendpacket(const sgfru_init_arg_t *iargp)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel int32_t ret = 0;

03831d35f7499c87d51205817c93e9a8d42c4baestevel caddr_t datap, tdatap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel size_t size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel append_info_t append;

03831d35f7499c87d51205817c93e9a8d42c4baestevel fru_cnt_t max_cnt;

03831d35f7499c87d51205817c93e9a8d42c4baestevel fru_hdl_t *hdlp;

03831d35f7499c87d51205817c93e9a8d42c4baestevel caddr_t addr;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyin append_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyin_append(iargp, &append) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* check on kmem_alloc space requirements */

03831d35f7499c87d51205817c93e9a8d42c4baestevel max_cnt = append.payload_cnt;

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((max_cnt <= 0) || (max_cnt > MAX_PAYLOADSIZE)) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EINVAL);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* allocate buffer for unpadded fru_info_t + packet_t + payload */

03831d35f7499c87d51205817c93e9a8d42c4baestevel size = (size_t)(FRU_INFO_SIZE + PACKET_SIZE + max_cnt);

03831d35f7499c87d51205817c93e9a8d42c4baestevel datap = kmem_zalloc(size, KM_SLEEP);

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* translate padded to unpadded fru_info_t plus packet_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel tdatap = sgfru_packet_unpad(&append.payload.fru_info, &append.packet,

03831d35f7499c87d51205817c93e9a8d42c4baestevel datap);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyin payload to the end of the unpadded buffer */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyin_buffer(iargp, append.payload_data, append.payload_cnt,

03831d35f7499c87d51205817c93e9a8d42c4baestevel tdatap) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* call mailbox */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((ret = sgfru_mbox(iargp->cmd, datap, size,

03831d35f7499c87d51205817c93e9a8d42c4baestevel &append.payload.fru_info)) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyout new packet_hdl_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel hdlp = (fru_hdl_t *)datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_handle(iargp, (void *)iargp->argp, hdlp) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyout updated segment_hdl_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel addr = (caddr_t)(iargp->argp + sizeof (packet_t));

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_handle(iargp, addr, ++hdlp) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* free buffer */

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic int

03831d35f7499c87d51205817c93e9a8d42c4baestevelsgfru_getpayload(const sgfru_init_arg_t *iargp)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel int32_t ret;

03831d35f7499c87d51205817c93e9a8d42c4baestevel caddr_t datap, tdatap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel size_t size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel frup_info_t payld;

03831d35f7499c87d51205817c93e9a8d42c4baestevel fru_info_t pinfo;

03831d35f7499c87d51205817c93e9a8d42c4baestevel fru_cnt_t max_cnt;

03831d35f7499c87d51205817c93e9a8d42c4baestevel static fn_t f = "sgfru_getpayload";

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyin payload_t aka frup_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyin_frup(iargp, &payld) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel PR_PAYLOAD("sgfru:%s: handle %lx, max cnt %d\n",

193974072f41a843678abf5f61979c748687e66bSherry Moore f, payld.fru_hdl, payld.fru_cnt);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* check on kmem_alloc space requirements */

03831d35f7499c87d51205817c93e9a8d42c4baestevel max_cnt = payld.fru_cnt;

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((max_cnt <= 0) || (max_cnt > MAX_PAYLOADSIZE)) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EINVAL);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* allocate buffer for fru_info_t + payload */

03831d35f7499c87d51205817c93e9a8d42c4baestevel size = (size_t)(FRU_INFO_SIZE + max_cnt);

03831d35f7499c87d51205817c93e9a8d42c4baestevel datap = kmem_zalloc(size, KM_SLEEP);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* call mailbox */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((ret = sgfru_mbox(iargp->cmd, datap, size, &payld.fru_info))

03831d35f7499c87d51205817c93e9a8d42c4baestevel != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* translate unpadded to padded fru_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel tdatap = sgfru_fru_pad(datap, &pinfo);

03831d35f7499c87d51205817c93e9a8d42c4baestevel PR_PAYLOAD("sgfru:%s: handle %lx, max cnt %d\n",

193974072f41a843678abf5f61979c748687e66bSherry Moore f, pinfo.hdl, pinfo.cnt);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyout actual fru_cnt */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_fru(iargp, &pinfo) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyout raw packet data, aka the payload */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_buffer(iargp, &payld, tdatap) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* free buffer */

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic int

03831d35f7499c87d51205817c93e9a8d42c4baestevelsgfru_updatepayload(const sgfru_init_arg_t *iargp)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel int32_t ret;

03831d35f7499c87d51205817c93e9a8d42c4baestevel caddr_t datap, tdatap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel size_t size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel frup_info_t payld;

03831d35f7499c87d51205817c93e9a8d42c4baestevel fru_cnt_t max_cnt;

03831d35f7499c87d51205817c93e9a8d42c4baestevel static fn_t f = "sgfru_updatepayload";

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyin frup_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyin_frup(iargp, &payld) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* check on kmem_alloc space requirements */

03831d35f7499c87d51205817c93e9a8d42c4baestevel max_cnt = payld.fru_cnt;

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((max_cnt <= 0) || (max_cnt > MAX_PAYLOADSIZE)) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EINVAL);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* allocate buffer for fru_info_t + payload */

03831d35f7499c87d51205817c93e9a8d42c4baestevel size = (size_t)(FRU_INFO_SIZE + max_cnt);

03831d35f7499c87d51205817c93e9a8d42c4baestevel datap = kmem_zalloc(size, KM_SLEEP);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* translate padded to unpadded fru_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel tdatap = sgfru_fru_unpad(&payld.fru_info, datap);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyin payload */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyin_buffer(iargp, payld.frus, max_cnt, tdatap) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel PR_PAYLOAD("sgfru_updatepayload: handle %lx, actual cnt %d\n",

193974072f41a843678abf5f61979c748687e66bSherry Moore payld.fru_hdl, payld.fru_cnt);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* call mailbox */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((ret = sgfru_mbox(iargp->cmd, datap, size, &payld.fru_info))

03831d35f7499c87d51205817c93e9a8d42c4baestevel != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* free buffer */

03831d35f7499c87d51205817c93e9a8d42c4baestevel kmem_free(datap, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyout new packet_hdl_t and actual count */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_fru(iargp, &payld.fru_info) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel PR_PAYLOAD("sgfru:%s: new handle %lx, cnt %d\n",

193974072f41a843678abf5f61979c748687e66bSherry Moore f, payld.fru_hdl, payld.fru_cnt);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic int

03831d35f7499c87d51205817c93e9a8d42c4baestevelsgfru_getnum(const sgfru_init_arg_t *iargp)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel int32_t ret;

03831d35f7499c87d51205817c93e9a8d42c4baestevel caddr_t datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel size_t size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel fru_info_t fru_info;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyin fru_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyin_fru(iargp, &fru_info) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel size = sizeof (fru_cnt_t);

03831d35f7499c87d51205817c93e9a8d42c4baestevel datap = (caddr_t)&fru_info.cnt;

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((ret = sgfru_mbox(iargp->cmd, datap, size, &fru_info)) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyout fru_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_fru(iargp, &fru_info) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic int

03831d35f7499c87d51205817c93e9a8d42c4baestevelsgfru_delete(const sgfru_init_arg_t *iargp)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel int32_t ret;

03831d35f7499c87d51205817c93e9a8d42c4baestevel caddr_t datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel size_t size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel fru_info_t fru_info;

03831d35f7499c87d51205817c93e9a8d42c4baestevel static fn_t f = "sgfru_delete";

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyin fru_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyin_fru(iargp, &fru_info) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel PR_SEGMENT("sgfru:%s: delete handle %lx\n", f, fru_info.hdl);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel size = sizeof (fru_hdl_t);

03831d35f7499c87d51205817c93e9a8d42c4baestevel datap = (caddr_t)&fru_info.hdl;

03831d35f7499c87d51205817c93e9a8d42c4baestevel if ((ret = sgfru_mbox(iargp->cmd, datap, size, &fru_info)) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel PR_SEGMENT("sgfru:%s: new parent handle %lx\n", f, fru_info.hdl);

03831d35f7499c87d51205817c93e9a8d42c4baestevel /* copyout fru_info_t */

03831d35f7499c87d51205817c93e9a8d42c4baestevel if (sgfru_copyout_fru(iargp, &fru_info) != 0) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (EFAULT);

03831d35f7499c87d51205817c93e9a8d42c4baestevel }

03831d35f7499c87d51205817c93e9a8d42c4baestevel return (ret);

03831d35f7499c87d51205817c93e9a8d42c4baestevel}

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevelstatic int

03831d35f7499c87d51205817c93e9a8d42c4baestevelsgfru_mbox(const int cmd, char *datap, const size_t size, fru_info_t *fru)

03831d35f7499c87d51205817c93e9a8d42c4baestevel{

03831d35f7499c87d51205817c93e9a8d42c4baestevel sbbc_msg_t request, *reqp = &request;

03831d35f7499c87d51205817c93e9a8d42c4baestevel sbbc_msg_t response, *resp = &response;

03831d35f7499c87d51205817c93e9a8d42c4baestevel fru_hdl_t hdls[2] = {0, 0};

03831d35f7499c87d51205817c93e9a8d42c4baestevel fru_hdl_t hdl = fru->hdl;

03831d35f7499c87d51205817c93e9a8d42c4baestevel int rv = 0;

03831d35f7499c87d51205817c93e9a8d42c4baestevel static fn_t f = "sgfru_mbox";

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel bzero((caddr_t)&request, sizeof (sbbc_msg_t));

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_type.type = SGFRU_MBOX;

03831d35f7499c87d51205817c93e9a8d42c4baestevel bzero((caddr_t)&response, sizeof (sbbc_msg_t));

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_type.type = SGFRU_MBOX;

03831d35f7499c87d51205817c93e9a8d42c4baestevel PR_MBOX("sgfru:%s: cmd 0x%x, size %lu\n", f, cmd, size);

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel switch (cmd) {

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_GETCHILDLIST:

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_type.sub_type = SGFRU_MBOX_GETCHILDLIST;

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_len = sizeof (fru_info_t);

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_buf = (caddr_t)fru;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_type.sub_type = SGFRU_MBOX_GETCHILDLIST;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_len = size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_buf = datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_GETCHILDHANDLES:

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_type.sub_type = SGFRU_MBOX_GETCHILDHANDLES;

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_len = sizeof (fru_info_t);

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_buf = (caddr_t)fru;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_type.sub_type = SGFRU_MBOX_GETCHILDHANDLES;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_len = size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_buf = datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_GETNODEINFO:

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_type.sub_type = SGFRU_MBOX_GETNODEINFO;

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_len = sizeof (fru_hdl_t);

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_buf = (caddr_t)&hdl;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_type.sub_type = SGFRU_MBOX_GETNODEINFO;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_len = size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_buf = datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_GETNUMSECTIONS:

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_type.sub_type = SGFRU_MBOX_GETNUMSECTIONS;

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_len = sizeof (fru_hdl_t);

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_buf = (caddr_t)&hdl;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_type.sub_type = SGFRU_MBOX_GETNUMSECTIONS;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_len = size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_buf = datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_GETNUMSEGMENTS:

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_type.sub_type = SGFRU_MBOX_GETNUMSEGMENTS;

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_len = sizeof (fru_hdl_t);

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_buf = (caddr_t)&hdl;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_type.sub_type = SGFRU_MBOX_GETNUMSEGMENTS;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_len = size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_buf = datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_GETNUMPACKETS:

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_type.sub_type = SGFRU_MBOX_GETNUMPACKETS;

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_len = sizeof (fru_hdl_t);

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_buf = (caddr_t)&hdl;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_type.sub_type = SGFRU_MBOX_GETNUMPACKETS;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_len = size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_buf = datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_GETSECTIONS:

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_type.sub_type = SGFRU_MBOX_GETSECTIONS;

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_len = sizeof (fru_info_t);

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_buf = (caddr_t)fru;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_type.sub_type = SGFRU_MBOX_GETSECTIONS;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_len = size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_buf = datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_GETSEGMENTS:

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_type.sub_type = SGFRU_MBOX_GETSEGMENTS;

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_len = sizeof (fru_info_t);

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_buf = (caddr_t)fru;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_type.sub_type = SGFRU_MBOX_GETSEGMENTS;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_len = size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_buf = datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_GETPACKETS:

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_type.sub_type = SGFRU_MBOX_GETPACKETS;

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_len = sizeof (fru_info_t);

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_buf = (caddr_t)fru;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_type.sub_type = SGFRU_MBOX_GETPACKETS;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_len = size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_buf = datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_ADDSEGMENT:

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_type.sub_type = SGFRU_MBOX_ADDSEGMENT;

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_len = size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_buf = datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_type.sub_type = SGFRU_MBOX_ADDSEGMENT;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_len = sizeof (hdls);

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_buf = (caddr_t)&hdls;

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_APPENDPACKET:

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_type.sub_type = SGFRU_MBOX_APPENDPACKET;

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_len = size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_buf = (caddr_t)datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_type.sub_type = SGFRU_MBOX_APPENDPACKET;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_len = sizeof (hdls);

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_buf = (caddr_t)&hdls;

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_DELETESEGMENT:

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_type.sub_type = SGFRU_MBOX_DELETESEGMENT;

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_len = size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_buf = (caddr_t)datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_type.sub_type = SGFRU_MBOX_DELETESEGMENT;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_len = sizeof (fru_hdl_t);

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_buf = (caddr_t)&hdl;

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_READRAWSEGMENT:

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_type.sub_type = SGFRU_MBOX_READRAWSEGMENT;

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_len = sizeof (fru_info_t);

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_buf = (caddr_t)fru;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_type.sub_type = SGFRU_READRAWSEGMENT;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_len = size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_buf = datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_WRITERAWSEGMENT:

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_type.sub_type = SGFRU_MBOX_WRITERAWSEGMENT;

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_len = size;

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_buf = datap;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_type.sub_type = SGFRU_WRITERAWSEGMENT;

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_len = sizeof (fru_info_t);

03831d35f7499c87d51205817c93e9a8d42c4baestevel resp->msg_buf = (caddr_t)fru;

03831d35f7499c87d51205817c93e9a8d42c4baestevel break;

03831d35f7499c87d51205817c93e9a8d42c4baestevel

03831d35f7499c87d51205817c93e9a8d42c4baestevel case SGFRU_DELETEPACKET:

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_type.sub_type = SGFRU_MBOX_DELETEPACKET;

03831d35f7499c87d51205817c93e9a8d42c4baestevel reqp->msg_len = size;