2554 lines
61 KiB
C
2554 lines
61 KiB
C
/* $FreeBSD$ */
|
|
/*
|
|
* Copyright (c) 2000 Matthew Jacob
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions, and the following disclaimer,
|
|
* without modification, immediately at the beginning of the file.
|
|
* 2. The name of the author may not be used to endorse or promote products
|
|
* derived from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
|
|
* ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
|
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
|
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
|
* SUCH DAMAGE.
|
|
*
|
|
*/
|
|
#include <sys/param.h>
|
|
#include <sys/queue.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/types.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/fcntl.h>
|
|
#include <sys/stat.h>
|
|
#include <sys/conf.h>
|
|
#include <sys/errno.h>
|
|
#include <sys/devicestat.h>
|
|
#include <machine/stdarg.h>
|
|
|
|
#include <cam/cam.h>
|
|
#include <cam/cam_ccb.h>
|
|
#include <cam/cam_extend.h>
|
|
#include <cam/cam_periph.h>
|
|
#include <cam/cam_xpt_periph.h>
|
|
#include <cam/cam_queue.h>
|
|
#include <cam/cam_debug.h>
|
|
|
|
#include <cam/scsi/scsi_all.h>
|
|
#include <cam/scsi/scsi_message.h>
|
|
#include <sys/ioccom.h>
|
|
#include <cam/scsi/scsi_ses.h>
|
|
|
|
#include <opt_ses.h>
|
|
|
|
/*
|
|
* Platform Independent Driver Internal Definitions for SES devices.
|
|
*/
|
|
typedef enum {
|
|
SES_NONE,
|
|
SES_SES_SCSI2,
|
|
SES_SES,
|
|
SES_SES_PASSTHROUGH,
|
|
SES_SEN,
|
|
SES_SAFT
|
|
} enctyp;
|
|
|
|
struct ses_softc;
|
|
typedef struct ses_softc ses_softc_t;
|
|
typedef struct {
|
|
int (*softc_init)(ses_softc_t *, int);
|
|
int (*init_enc)(ses_softc_t *);
|
|
int (*get_encstat)(ses_softc_t *, int);
|
|
int (*set_encstat)(ses_softc_t *, ses_encstat, int);
|
|
int (*get_objstat)(ses_softc_t *, ses_objstat *, int);
|
|
int (*set_objstat)(ses_softc_t *, ses_objstat *, int);
|
|
} encvec;
|
|
|
|
#define ENCI_SVALID 0x80
|
|
|
|
typedef struct {
|
|
uint32_t
|
|
enctype : 8, /* enclosure type */
|
|
subenclosure : 8, /* subenclosure id */
|
|
svalid : 1, /* enclosure information valid */
|
|
priv : 15; /* private data, per object */
|
|
uint8_t encstat[4]; /* state && stats */
|
|
} encobj;
|
|
|
|
#define SEN_ID "UNISYS SUN_SEN"
|
|
#define SEN_ID_LEN 24
|
|
|
|
|
|
static enctyp ses_type(void *, int);
|
|
|
|
|
|
/* Forward reference to Enclosure Functions */
|
|
static int ses_softc_init(ses_softc_t *, int);
|
|
static int ses_init_enc(ses_softc_t *);
|
|
static int ses_get_encstat(ses_softc_t *, int);
|
|
static int ses_set_encstat(ses_softc_t *, uint8_t, int);
|
|
static int ses_get_objstat(ses_softc_t *, ses_objstat *, int);
|
|
static int ses_set_objstat(ses_softc_t *, ses_objstat *, int);
|
|
|
|
static int safte_softc_init(ses_softc_t *, int);
|
|
static int safte_init_enc(ses_softc_t *);
|
|
static int safte_get_encstat(ses_softc_t *, int);
|
|
static int safte_set_encstat(ses_softc_t *, uint8_t, int);
|
|
static int safte_get_objstat(ses_softc_t *, ses_objstat *, int);
|
|
static int safte_set_objstat(ses_softc_t *, ses_objstat *, int);
|
|
|
|
/*
|
|
* Platform implementation defines/functions for SES internal kernel stuff
|
|
*/
|
|
|
|
#define STRNCMP strncmp
|
|
#define PRINTF printf
|
|
#define SES_LOG ses_log
|
|
#ifdef DEBUG
|
|
#define SES_DLOG ses_log
|
|
#else
|
|
#define SES_DLOG if (0) ses_log
|
|
#endif
|
|
#define SES_VLOG if (bootverbose) ses_log
|
|
#define SES_MALLOC(amt) malloc(amt, M_DEVBUF, M_NOWAIT)
|
|
#define SES_FREE(ptr, amt) free(ptr, M_DEVBUF)
|
|
#define MEMZERO bzero
|
|
#define MEMCPY(dest, src, amt) bcopy(src, dest, amt)
|
|
|
|
static int ses_runcmd(struct ses_softc *, char *, int, char *, int *);
|
|
static void ses_log(struct ses_softc *, const char *, ...);
|
|
|
|
/*
|
|
* Gerenal FreeBSD kernel stuff.
|
|
*/
|
|
|
|
|
|
#define ccb_state ppriv_field0
|
|
#define ccb_bp ppriv_ptr1
|
|
|
|
struct ses_softc {
|
|
enctyp ses_type; /* type of enclosure */
|
|
encvec ses_vec; /* vector to handlers */
|
|
void * ses_private; /* per-type private data */
|
|
encobj * ses_objmap; /* objects */
|
|
u_int32_t ses_nobjects; /* number of objects */
|
|
ses_encstat ses_encstat; /* overall status */
|
|
u_int8_t ses_flags;
|
|
union ccb ses_saved_ccb;
|
|
dev_t ses_dev;
|
|
struct cam_periph *periph;
|
|
};
|
|
#define SES_FLAG_INVALID 0x01
|
|
#define SES_FLAG_OPEN 0x02
|
|
#define SES_FLAG_INITIALIZED 0x04
|
|
|
|
#define SESUNIT(x) (minor((x)))
|
|
#define SES_CDEV_MAJOR 110
|
|
|
|
static d_open_t sesopen;
|
|
static d_close_t sesclose;
|
|
static d_ioctl_t sesioctl;
|
|
static periph_init_t sesinit;
|
|
static periph_ctor_t sesregister;
|
|
static periph_oninv_t sesoninvalidate;
|
|
static periph_dtor_t sescleanup;
|
|
static periph_start_t sesstart;
|
|
|
|
static void sesasync(void *, u_int32_t, struct cam_path *, void *);
|
|
static void sesdone(struct cam_periph *, union ccb *);
|
|
static int seserror(union ccb *, u_int32_t, u_int32_t);
|
|
|
|
static struct periph_driver sesdriver = {
|
|
sesinit, "ses",
|
|
TAILQ_HEAD_INITIALIZER(sesdriver.units), /* generation */ 0
|
|
};
|
|
|
|
DATA_SET(periphdriver_set, sesdriver);
|
|
|
|
static struct cdevsw ses_cdevsw =
|
|
{
|
|
/* open */ sesopen,
|
|
/* close */ sesclose,
|
|
/* read */ noread,
|
|
/* write */ nowrite,
|
|
/* ioctl */ sesioctl,
|
|
/* poll */ nopoll,
|
|
/* mmap */ nommap,
|
|
/* strategy */ nostrategy,
|
|
/* name */ "ses",
|
|
/* maj */ SES_CDEV_MAJOR,
|
|
/* dump */ nodump,
|
|
/* psize */ nopsize,
|
|
/* flags */ 0,
|
|
/* bmaj */ -1
|
|
};
|
|
static struct extend_array *sesperiphs;
|
|
|
|
void
|
|
sesinit(void)
|
|
{
|
|
cam_status status;
|
|
struct cam_path *path;
|
|
|
|
/*
|
|
* Create our extend array for storing the devices we attach to.
|
|
*/
|
|
sesperiphs = cam_extend_new();
|
|
if (sesperiphs == NULL) {
|
|
printf("ses: Failed to alloc extend array!\n");
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* Install a global async callback. This callback will
|
|
* receive async callbacks like "new device found".
|
|
*/
|
|
status = xpt_create_path(&path, NULL, CAM_XPT_PATH_ID,
|
|
CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD);
|
|
|
|
if (status == CAM_REQ_CMP) {
|
|
struct ccb_setasync csa;
|
|
|
|
xpt_setup_ccb(&csa.ccb_h, path, 5);
|
|
csa.ccb_h.func_code = XPT_SASYNC_CB;
|
|
csa.event_enable = AC_FOUND_DEVICE;
|
|
csa.callback = sesasync;
|
|
csa.callback_arg = NULL;
|
|
xpt_action((union ccb *)&csa);
|
|
status = csa.ccb_h.status;
|
|
xpt_free_path(path);
|
|
}
|
|
|
|
if (status != CAM_REQ_CMP) {
|
|
printf("ses: Failed to attach master async callback "
|
|
"due to status 0x%x!\n", status);
|
|
}
|
|
}
|
|
|
|
static void
|
|
sesoninvalidate(struct cam_periph *periph)
|
|
{
|
|
struct ses_softc *softc;
|
|
struct ccb_setasync csa;
|
|
|
|
softc = (struct ses_softc *)periph->softc;
|
|
|
|
/*
|
|
* Unregister any async callbacks.
|
|
*/
|
|
xpt_setup_ccb(&csa.ccb_h, periph->path, 5);
|
|
csa.ccb_h.func_code = XPT_SASYNC_CB;
|
|
csa.event_enable = 0;
|
|
csa.callback = sesasync;
|
|
csa.callback_arg = periph;
|
|
xpt_action((union ccb *)&csa);
|
|
|
|
softc->ses_flags |= SES_FLAG_INVALID;
|
|
|
|
xpt_print_path(periph->path);
|
|
printf("lost device\n");
|
|
}
|
|
|
|
static void
|
|
sescleanup(struct cam_periph *periph)
|
|
{
|
|
struct ses_softc *softc;
|
|
|
|
softc = (struct ses_softc *)periph->softc;
|
|
|
|
destroy_dev(softc->ses_dev);
|
|
|
|
cam_extend_release(sesperiphs, periph->unit_number);
|
|
xpt_print_path(periph->path);
|
|
printf("removing device entry\n");
|
|
free(softc, M_DEVBUF);
|
|
}
|
|
|
|
static void
|
|
sesasync(void *callback_arg, u_int32_t code, struct cam_path *path, void *arg)
|
|
{
|
|
struct cam_periph *periph;
|
|
|
|
periph = (struct cam_periph *)callback_arg;
|
|
|
|
switch(code) {
|
|
case AC_FOUND_DEVICE:
|
|
{
|
|
cam_status status;
|
|
struct ccb_getdev *cgd;
|
|
|
|
cgd = (struct ccb_getdev *)arg;
|
|
|
|
/*
|
|
* PROBLEM: WE NEED TO LOOK AT BYTES 48-53 TO SEE IF THIS IS
|
|
* PROBLEM: IS A SAF-TE DEVICE.
|
|
*/
|
|
switch (ses_type(&cgd->inq_data, cgd->inq_len)) {
|
|
case SES_SES:
|
|
case SES_SES_SCSI2:
|
|
case SES_SES_PASSTHROUGH:
|
|
case SES_SEN:
|
|
case SES_SAFT:
|
|
break;
|
|
default:
|
|
return;
|
|
}
|
|
|
|
status = cam_periph_alloc(sesregister, sesoninvalidate,
|
|
sescleanup, sesstart, "ses", CAM_PERIPH_BIO,
|
|
cgd->ccb_h.path, sesasync, AC_FOUND_DEVICE, cgd);
|
|
|
|
if (status != CAM_REQ_CMP && status != CAM_REQ_INPROG) {
|
|
printf("sesasync: Unable to probe new device due to "
|
|
"status 0x%x\n", status);
|
|
}
|
|
break;
|
|
}
|
|
default:
|
|
cam_periph_async(periph, code, path, arg);
|
|
break;
|
|
}
|
|
}
|
|
|
|
static cam_status
|
|
sesregister(struct cam_periph *periph, void *arg)
|
|
{
|
|
struct ses_softc *softc;
|
|
struct ccb_setasync csa;
|
|
struct ccb_getdev *cgd;
|
|
char *tname;
|
|
|
|
cgd = (struct ccb_getdev *)arg;
|
|
if (periph == NULL) {
|
|
printf("sesregister: periph was NULL!!\n");
|
|
return (CAM_REQ_CMP_ERR);
|
|
}
|
|
|
|
if (cgd == NULL) {
|
|
printf("sesregister: no getdev CCB, can't register device\n");
|
|
return (CAM_REQ_CMP_ERR);
|
|
}
|
|
|
|
softc = malloc(sizeof (struct ses_softc), M_DEVBUF, M_NOWAIT);
|
|
if (softc == NULL) {
|
|
printf("sesregister: Unable to probe new device. "
|
|
"Unable to allocate softc\n");
|
|
return (CAM_REQ_CMP_ERR);
|
|
}
|
|
bzero(softc, sizeof (struct ses_softc));
|
|
periph->softc = softc;
|
|
softc->periph = periph;
|
|
|
|
softc->ses_type = ses_type(&cgd->inq_data, sizeof (cgd->inq_data));
|
|
|
|
switch (softc->ses_type) {
|
|
case SES_SES:
|
|
case SES_SES_SCSI2:
|
|
case SES_SES_PASSTHROUGH:
|
|
softc->ses_vec.softc_init = ses_softc_init;
|
|
softc->ses_vec.init_enc = ses_init_enc;
|
|
softc->ses_vec.get_encstat = ses_get_encstat;
|
|
softc->ses_vec.set_encstat = ses_set_encstat;
|
|
softc->ses_vec.get_objstat = ses_get_objstat;
|
|
softc->ses_vec.set_objstat = ses_set_objstat;
|
|
break;
|
|
case SES_SAFT:
|
|
softc->ses_vec.softc_init = safte_softc_init;
|
|
softc->ses_vec.init_enc = safte_init_enc;
|
|
softc->ses_vec.get_encstat = safte_get_encstat;
|
|
softc->ses_vec.set_encstat = safte_set_encstat;
|
|
softc->ses_vec.get_objstat = safte_get_objstat;
|
|
softc->ses_vec.set_objstat = safte_set_objstat;
|
|
break;
|
|
case SES_SEN:
|
|
break;
|
|
case SES_NONE:
|
|
default:
|
|
free(softc, M_DEVBUF);
|
|
return (CAM_REQ_CMP_ERR);
|
|
}
|
|
|
|
cam_extend_set(sesperiphs, periph->unit_number, periph);
|
|
|
|
softc->ses_dev = make_dev(&ses_cdevsw, periph->unit_number,
|
|
UID_ROOT, GID_OPERATOR, 0600, "%s%d",
|
|
periph->periph_name, periph->unit_number);
|
|
|
|
/*
|
|
* Add an async callback so that we get
|
|
* notified if this device goes away.
|
|
*/
|
|
xpt_setup_ccb(&csa.ccb_h, periph->path, 5);
|
|
csa.ccb_h.func_code = XPT_SASYNC_CB;
|
|
csa.event_enable = AC_LOST_DEVICE;
|
|
csa.callback = sesasync;
|
|
csa.callback_arg = periph;
|
|
xpt_action((union ccb *)&csa);
|
|
|
|
switch (softc->ses_type) {
|
|
default:
|
|
case SES_NONE:
|
|
tname = "No SES device";
|
|
break;
|
|
case SES_SES_SCSI2:
|
|
tname = "SCSI-2 SES Device";
|
|
break;
|
|
case SES_SES:
|
|
tname = "SCSI-3 SES Device";
|
|
break;
|
|
case SES_SES_PASSTHROUGH:
|
|
tname = "SES Passthrough Device";
|
|
break;
|
|
case SES_SEN:
|
|
tname = "UNISYS SEN Device (NOT HANDLED YET)";
|
|
break;
|
|
case SES_SAFT:
|
|
tname = "SAF-TE Compliant Device";
|
|
break;
|
|
}
|
|
xpt_announce_periph(periph, tname);
|
|
return (CAM_REQ_CMP);
|
|
}
|
|
|
|
static int
|
|
sesopen(dev_t dev, int flags, int fmt, struct proc *p)
|
|
{
|
|
struct cam_periph *periph;
|
|
struct ses_softc *softc;
|
|
int error, s;
|
|
|
|
s = splsoftcam();
|
|
periph = cam_extend_get(sesperiphs, SESUNIT(dev));
|
|
if (periph == NULL) {
|
|
splx(s);
|
|
return (ENXIO);
|
|
}
|
|
if ((error = cam_periph_lock(periph, PRIBIO | PCATCH)) != 0) {
|
|
splx(s);
|
|
return (error);
|
|
}
|
|
splx(s);
|
|
|
|
if (cam_periph_acquire(periph) != CAM_REQ_CMP) {
|
|
cam_periph_unlock(periph);
|
|
return (ENXIO);
|
|
}
|
|
|
|
softc = (struct ses_softc *)periph->softc;
|
|
|
|
if (softc->ses_flags & SES_FLAG_INVALID) {
|
|
error = ENXIO;
|
|
goto out;
|
|
}
|
|
if (softc->ses_flags & SES_FLAG_OPEN) {
|
|
error = EBUSY;
|
|
goto out;
|
|
}
|
|
if (softc->ses_vec.softc_init == NULL) {
|
|
error = ENXIO;
|
|
goto out;
|
|
}
|
|
|
|
softc->ses_flags |= SES_FLAG_OPEN;
|
|
if ((softc->ses_flags & SES_FLAG_INITIALIZED) == 0) {
|
|
error = (*softc->ses_vec.softc_init)(softc, 1);
|
|
if (error)
|
|
softc->ses_flags &= ~SES_FLAG_OPEN;
|
|
else
|
|
softc->ses_flags |= SES_FLAG_INITIALIZED;
|
|
}
|
|
|
|
out:
|
|
if (error) {
|
|
cam_periph_release(periph);
|
|
}
|
|
cam_periph_unlock(periph);
|
|
return (error);
|
|
}
|
|
|
|
static int
|
|
sesclose(dev_t dev, int flag, int fmt, struct proc *p)
|
|
{
|
|
struct cam_periph *periph;
|
|
struct ses_softc *softc;
|
|
int unit, error;
|
|
|
|
error = 0;
|
|
|
|
unit = SESUNIT(dev);
|
|
periph = cam_extend_get(sesperiphs, unit);
|
|
if (periph == NULL)
|
|
return (ENXIO);
|
|
|
|
softc = (struct ses_softc *)periph->softc;
|
|
|
|
if ((error = cam_periph_lock(periph, PRIBIO)) != 0)
|
|
return (error);
|
|
|
|
softc->ses_flags &= ~SES_FLAG_OPEN;
|
|
|
|
cam_periph_unlock(periph);
|
|
cam_periph_release(periph);
|
|
|
|
return (0);
|
|
}
|
|
|
|
static void
|
|
sesstart(struct cam_periph *p, union ccb *sccb)
|
|
{
|
|
int s = splbio();
|
|
if (p->immediate_priority <= p->pinfo.priority) {
|
|
SLIST_INSERT_HEAD(&p->ccb_list, &sccb->ccb_h, periph_links.sle);
|
|
p->immediate_priority = CAM_PRIORITY_NONE;
|
|
wakeup(&p->ccb_list);
|
|
}
|
|
splx(s);
|
|
}
|
|
|
|
static void
|
|
sesdone(struct cam_periph *periph, union ccb *dccb)
|
|
{
|
|
wakeup(&dccb->ccb_h.cbfcnp);
|
|
}
|
|
|
|
static int
|
|
seserror(union ccb *ccb, u_int32_t cflags, u_int32_t sflags)
|
|
{
|
|
struct ses_softc *softc;
|
|
struct cam_periph *periph;
|
|
|
|
periph = xpt_path_periph(ccb->ccb_h.path);
|
|
softc = (struct ses_softc *)periph->softc;
|
|
|
|
return (cam_periph_error(ccb, cflags, sflags, &softc->ses_saved_ccb));
|
|
}
|
|
|
|
static int
|
|
sesioctl(dev_t dev, u_long cmd, caddr_t arg_addr, int flag, struct proc *p)
|
|
{
|
|
struct cam_periph *periph;
|
|
ses_encstat tmp;
|
|
ses_objstat objs;
|
|
ses_object obj, *uobj;
|
|
struct ses_softc *ssc;
|
|
void *addr;
|
|
int error, i;
|
|
|
|
|
|
if (arg_addr)
|
|
addr = *((caddr_t *) arg_addr);
|
|
else
|
|
addr = NULL;
|
|
|
|
periph = cam_extend_get(sesperiphs, SESUNIT(dev));
|
|
if (periph == NULL)
|
|
return (ENXIO);
|
|
|
|
CAM_DEBUG(periph->path, CAM_DEBUG_TRACE, ("entering sesioctl\n"));
|
|
|
|
ssc = (struct ses_softc *)periph->softc;
|
|
|
|
/*
|
|
* Now check to see whether we're initialized or not.
|
|
*/
|
|
if ((ssc->ses_flags & SES_FLAG_INITIALIZED) == 0) {
|
|
return (ENXIO);
|
|
}
|
|
|
|
error = 0;
|
|
|
|
CAM_DEBUG(periph->path, CAM_DEBUG_TRACE,
|
|
("trying to do ioctl %#lx\n", cmd));
|
|
|
|
/*
|
|
* If this command can change the device's state,
|
|
* we must have the device open for writing.
|
|
*/
|
|
switch (cmd) {
|
|
case SESIOC_GETNOBJ:
|
|
case SESIOC_GETOBJMAP:
|
|
case SESIOC_GETENCSTAT:
|
|
case SESIOC_GETOBJSTAT:
|
|
break;
|
|
default:
|
|
if ((flag & FWRITE) == 0) {
|
|
return (EBADF);
|
|
}
|
|
}
|
|
|
|
switch (cmd) {
|
|
case SESIOC_GETNOBJ:
|
|
error = copyout(&ssc->ses_nobjects, addr,
|
|
sizeof (ssc->ses_nobjects));
|
|
break;
|
|
|
|
case SESIOC_GETOBJMAP:
|
|
for (uobj = addr, i = 0; i != ssc->ses_nobjects; i++, uobj++) {
|
|
obj.obj_id = i;
|
|
obj.subencid = ssc->ses_objmap[i].subenclosure;
|
|
obj.object_type = ssc->ses_objmap[i].enctype;
|
|
error = copyout(&obj, uobj, sizeof (ses_object));
|
|
if (error) {
|
|
break;
|
|
}
|
|
}
|
|
break;
|
|
|
|
case SESIOC_GETENCSTAT:
|
|
error = (*ssc->ses_vec.get_encstat)(ssc, 1);
|
|
if (error)
|
|
break;
|
|
tmp = ssc->ses_encstat & ~ENCI_SVALID;
|
|
error = copyout(&tmp, addr, sizeof (ses_encstat));
|
|
ssc->ses_encstat = tmp;
|
|
break;
|
|
|
|
case SESIOC_SETENCSTAT:
|
|
error = copyin(addr, &tmp, sizeof (ses_encstat));
|
|
if (error)
|
|
break;
|
|
error = (*ssc->ses_vec.set_encstat)(ssc, tmp, 1);
|
|
break;
|
|
|
|
case SESIOC_GETOBJSTAT:
|
|
error = copyin(addr, &objs, sizeof (ses_objstat));
|
|
if (error)
|
|
break;
|
|
if (objs.obj_id >= ssc->ses_nobjects) {
|
|
error = EINVAL;
|
|
break;
|
|
}
|
|
error = (*ssc->ses_vec.get_objstat)(ssc, &objs, 1);
|
|
if (error)
|
|
break;
|
|
error = copyout(&objs, addr, sizeof (ses_objstat));
|
|
/*
|
|
* Always (for now) invalidate entry.
|
|
*/
|
|
ssc->ses_objmap[objs.obj_id].svalid = 0;
|
|
break;
|
|
|
|
case SESIOC_SETOBJSTAT:
|
|
error = copyin(addr, &objs, sizeof (ses_objstat));
|
|
if (error)
|
|
break;
|
|
|
|
if (objs.obj_id >= ssc->ses_nobjects) {
|
|
error = EINVAL;
|
|
break;
|
|
}
|
|
error = (*ssc->ses_vec.set_objstat)(ssc, &objs, 1);
|
|
|
|
/*
|
|
* Always (for now) invalidate entry.
|
|
*/
|
|
ssc->ses_objmap[objs.obj_id].svalid = 0;
|
|
break;
|
|
|
|
case SESIOC_INIT:
|
|
|
|
error = (*ssc->ses_vec.init_enc)(ssc);
|
|
break;
|
|
|
|
default:
|
|
error = cam_periph_ioctl(periph, cmd, arg_addr, seserror);
|
|
break;
|
|
}
|
|
return (error);
|
|
}
|
|
|
|
#define SES_FLAGS SF_NO_PRINT | SF_RETRY_SELTO | SF_RETRY_UA
|
|
static int
|
|
ses_runcmd(struct ses_softc *ssc, char *cdb, int cdbl, char *dptr, int *dlenp)
|
|
{
|
|
int error, dlen;
|
|
ccb_flags ddf;
|
|
union ccb *ccb;
|
|
|
|
if (dptr) {
|
|
if ((dlen = *dlenp) < 0) {
|
|
dlen = -dlen;
|
|
ddf = CAM_DIR_OUT;
|
|
} else {
|
|
ddf = CAM_DIR_IN;
|
|
}
|
|
} else {
|
|
dlen = 0;
|
|
ddf = CAM_DIR_NONE;
|
|
}
|
|
|
|
if (cdbl > IOCDBLEN) {
|
|
cdbl = IOCDBLEN;
|
|
}
|
|
|
|
ccb = cam_periph_getccb(ssc->periph, 1);
|
|
cam_fill_csio(&ccb->csio, 0, sesdone, ddf, MSG_SIMPLE_Q_TAG, dptr,
|
|
dlen, sizeof (struct scsi_sense_data), cdbl, 60 * 1000);
|
|
bcopy(cdb, ccb->csio.cdb_io.cdb_bytes, cdbl);
|
|
|
|
error = cam_periph_runccb(ccb, seserror, 0, SES_FLAGS, NULL);
|
|
if ((ccb->ccb_h.status & CAM_DEV_QFRZN) != 0)
|
|
cam_release_devq(ccb->ccb_h.path, 0, 0, 0, FALSE);
|
|
if (error) {
|
|
if (dptr) {
|
|
*dlenp = dlen;
|
|
}
|
|
} else {
|
|
if (dptr) {
|
|
*dlenp = ccb->csio.resid;
|
|
}
|
|
}
|
|
xpt_release_ccb(ccb);
|
|
return (error);
|
|
}
|
|
|
|
static void
|
|
ses_log(struct ses_softc *ssc, const char *fmt, ...)
|
|
{
|
|
va_list ap;
|
|
|
|
printf("%s%d: ", ssc->periph->periph_name, ssc->periph->unit_number);
|
|
va_start(ap, fmt);
|
|
vprintf(fmt, ap);
|
|
va_end(ap);
|
|
}
|
|
|
|
/*
|
|
* The code after this point runs on many platforms,
|
|
* so forgive the slightly awkward and nonconforming
|
|
* appearance.
|
|
*/
|
|
|
|
/*
|
|
* Is this a device that supports enclosure services?
|
|
*
|
|
* It's a a pretty simple ruleset- if it is device type 0x0D (13), it's
|
|
* an SES device. If it happens to be an old UNISYS SEN device, we can
|
|
* handle that too.
|
|
*/
|
|
|
|
#define SAFTE_START 44
|
|
#define SAFTE_END 50
|
|
#define SAFTE_LEN SAFTE_END-SAFTE_START
|
|
|
|
static enctyp
|
|
ses_type(void *buf, int buflen)
|
|
{
|
|
unsigned char *iqd = buf;
|
|
|
|
if (buflen < 8+SEN_ID_LEN)
|
|
return (SES_NONE);
|
|
|
|
if ((iqd[0] & 0x1f) == T_ENCLOSURE) {
|
|
if (STRNCMP(&iqd[8], SEN_ID, SEN_ID_LEN) == 0) {
|
|
return (SES_SEN);
|
|
} else if ((iqd[2] & 0x7) > 2) {
|
|
return (SES_SES);
|
|
} else {
|
|
return (SES_SES_SCSI2);
|
|
}
|
|
return (SES_NONE);
|
|
}
|
|
|
|
#ifdef SES_ENABLE_PASSTHROUGH
|
|
if ((iqd[6] & 0x40) && (iqd[2] & 0x7) >= 2) {
|
|
/*
|
|
* PassThrough Device.
|
|
*/
|
|
return (SES_SES_PASSTHROUGH);
|
|
}
|
|
#endif
|
|
|
|
/*
|
|
* The comparison is short for a reason-
|
|
* some vendors were chopping it short.
|
|
*/
|
|
|
|
if (buflen < SAFTE_END - 2) {
|
|
return (SES_NONE);
|
|
}
|
|
|
|
if (STRNCMP((char *)&iqd[SAFTE_START], "SAF-TE", SAFTE_LEN - 2) == 0) {
|
|
return (SES_SAFT);
|
|
}
|
|
return (SES_NONE);
|
|
}
|
|
|
|
/*
|
|
* SES Native Type Device Support
|
|
*/
|
|
|
|
/*
|
|
* SES Diagnostic Page Codes
|
|
*/
|
|
|
|
typedef enum {
|
|
SesConfigPage = 0x1,
|
|
SesControlPage,
|
|
#define SesStatusPage SesControlPage
|
|
SesHelpTxt,
|
|
SesStringOut,
|
|
#define SesStringIn SesStringOut
|
|
SesThresholdOut,
|
|
#define SesThresholdIn SesThresholdOut
|
|
SesArrayControl,
|
|
#define SesArrayStatus SesArrayControl
|
|
SesElementDescriptor,
|
|
SesShortStatus
|
|
} SesDiagPageCodes;
|
|
|
|
/*
|
|
* minimal amounts
|
|
*/
|
|
|
|
/*
|
|
* Minimum amount of data, starting from byte 0, to have
|
|
* the config header.
|
|
*/
|
|
#define SES_CFGHDR_MINLEN 12
|
|
|
|
/*
|
|
* Minimum amount of data, starting from byte 0, to have
|
|
* the config header and one enclosure header.
|
|
*/
|
|
#define SES_ENCHDR_MINLEN 48
|
|
|
|
/*
|
|
* Take this value, subtract it from VEnclen and you know
|
|
* the length of the vendor unique bytes.
|
|
*/
|
|
#define SES_ENCHDR_VMIN 36
|
|
|
|
/*
|
|
* SES Data Structures
|
|
*/
|
|
|
|
typedef struct {
|
|
uint32_t GenCode; /* Generation Code */
|
|
uint8_t Nsubenc; /* Number of Subenclosures */
|
|
} SesCfgHdr;
|
|
|
|
typedef struct {
|
|
uint8_t Subencid; /* SubEnclosure Identifier */
|
|
uint8_t Ntypes; /* # of supported types */
|
|
uint8_t VEnclen; /* Enclosure Descriptor Length */
|
|
} SesEncHdr;
|
|
|
|
typedef struct {
|
|
uint8_t encWWN[8]; /* XXX- Not Right Yet */
|
|
uint8_t encVid[8];
|
|
uint8_t encPid[16];
|
|
uint8_t encRev[4];
|
|
uint8_t encVen[1];
|
|
} SesEncDesc;
|
|
|
|
typedef struct {
|
|
uint8_t enc_type; /* type of element */
|
|
uint8_t enc_maxelt; /* maximum supported */
|
|
uint8_t enc_subenc; /* in SubEnc # N */
|
|
uint8_t enc_tlen; /* Type Descriptor Text Length */
|
|
} SesThdr;
|
|
|
|
typedef struct {
|
|
uint8_t comstatus;
|
|
uint8_t comstat[3];
|
|
} SesComStat;
|
|
|
|
struct typidx {
|
|
int ses_tidx;
|
|
int ses_oidx;
|
|
};
|
|
|
|
struct sscfg {
|
|
uint8_t ses_ntypes; /* total number of types supported */
|
|
|
|
/*
|
|
* We need to keep a type index as well as an
|
|
* object index for each object in an enclosure.
|
|
*/
|
|
struct typidx *ses_typidx;
|
|
|
|
/*
|
|
* We also need to keep track of the number of elements
|
|
* per type of element. This is needed later so that we
|
|
* can find precisely in the returned status data the
|
|
* status for the Nth element of the Kth type.
|
|
*/
|
|
uint8_t * ses_eltmap;
|
|
};
|
|
|
|
|
|
/*
|
|
* (de)canonicalization defines
|
|
*/
|
|
#define sbyte(x, byte) ((((uint32_t)(x)) >> (byte * 8)) & 0xff)
|
|
#define sbit(x, bit) (((uint32_t)(x)) << bit)
|
|
#define sset8(outp, idx, sval) (((uint8_t *)(outp))[idx++]) = sbyte(sval, 0)
|
|
|
|
#define sset16(outp, idx, sval) \
|
|
(((uint8_t *)(outp))[idx++]) = sbyte(sval, 1), \
|
|
(((uint8_t *)(outp))[idx++]) = sbyte(sval, 0)
|
|
|
|
|
|
#define sset24(outp, idx, sval) \
|
|
(((uint8_t *)(outp))[idx++]) = sbyte(sval, 2), \
|
|
(((uint8_t *)(outp))[idx++]) = sbyte(sval, 1), \
|
|
(((uint8_t *)(outp))[idx++]) = sbyte(sval, 0)
|
|
|
|
|
|
#define sset32(outp, idx, sval) \
|
|
(((uint8_t *)(outp))[idx++]) = sbyte(sval, 3), \
|
|
(((uint8_t *)(outp))[idx++]) = sbyte(sval, 2), \
|
|
(((uint8_t *)(outp))[idx++]) = sbyte(sval, 1), \
|
|
(((uint8_t *)(outp))[idx++]) = sbyte(sval, 0)
|
|
|
|
#define gbyte(x, byte) ((((uint32_t)(x)) & 0xff) << (byte * 8))
|
|
#define gbit(lv, in, idx, shft, mask) lv = ((in[idx] >> shft) & mask)
|
|
#define sget8(inp, idx, lval) lval = (((uint8_t *)(inp))[idx++])
|
|
#define gget8(inp, idx, lval) lval = (((uint8_t *)(inp))[idx])
|
|
|
|
#define sget16(inp, idx, lval) \
|
|
lval = gbyte((((uint8_t *)(inp))[idx]), 1) | \
|
|
(((uint8_t *)(inp))[idx+1]), idx += 2
|
|
|
|
#define gget16(inp, idx, lval) \
|
|
lval = gbyte((((uint8_t *)(inp))[idx]), 1) | \
|
|
(((uint8_t *)(inp))[idx+1])
|
|
|
|
#define sget24(inp, idx, lval) \
|
|
lval = gbyte((((uint8_t *)(inp))[idx]), 2) | \
|
|
gbyte((((uint8_t *)(inp))[idx+1]), 1) | \
|
|
(((uint8_t *)(inp))[idx+2]), idx += 3
|
|
|
|
#define gget24(inp, idx, lval) \
|
|
lval = gbyte((((uint8_t *)(inp))[idx]), 2) | \
|
|
gbyte((((uint8_t *)(inp))[idx+1]), 1) | \
|
|
(((uint8_t *)(inp))[idx+2])
|
|
|
|
#define sget32(inp, idx, lval) \
|
|
lval = gbyte((((uint8_t *)(inp))[idx]), 3) | \
|
|
gbyte((((uint8_t *)(inp))[idx+1]), 2) | \
|
|
gbyte((((uint8_t *)(inp))[idx+2]), 1) | \
|
|
(((uint8_t *)(inp))[idx+3]), idx += 4
|
|
|
|
#define gget32(inp, idx, lval) \
|
|
lval = gbyte((((uint8_t *)(inp))[idx]), 3) | \
|
|
gbyte((((uint8_t *)(inp))[idx+1]), 2) | \
|
|
gbyte((((uint8_t *)(inp))[idx+2]), 1) | \
|
|
(((uint8_t *)(inp))[idx+3])
|
|
|
|
#define SCSZ 0x2000
|
|
#define CFLEN (256 + SES_ENCHDR_MINLEN)
|
|
|
|
/*
|
|
* Routines specific && private to SES only
|
|
*/
|
|
|
|
static int ses_getconfig(ses_softc_t *);
|
|
static int ses_getputstat(ses_softc_t *, int, SesComStat *, int, int);
|
|
static int ses_cfghdr(uint8_t *, int, SesCfgHdr *);
|
|
static int ses_enchdr(uint8_t *, int, uint8_t, SesEncHdr *);
|
|
static int ses_encdesc(uint8_t *, int, uint8_t, SesEncDesc *);
|
|
static int ses_getthdr(uint8_t *, int, int, SesThdr *);
|
|
static int ses_decode(char *, int, uint8_t *, int, int, SesComStat *);
|
|
static int ses_encode(char *, int, uint8_t *, int, int, SesComStat *);
|
|
|
|
static int
|
|
ses_softc_init(ses_softc_t *ssc, int doinit)
|
|
{
|
|
if (doinit == 0) {
|
|
struct sscfg *cc;
|
|
if (ssc->ses_nobjects) {
|
|
SES_FREE(ssc->ses_objmap,
|
|
ssc->ses_nobjects * sizeof (encobj));
|
|
ssc->ses_objmap = NULL;
|
|
}
|
|
if ((cc = ssc->ses_private) != NULL) {
|
|
if (cc->ses_eltmap && cc->ses_ntypes) {
|
|
SES_FREE(cc->ses_eltmap, cc->ses_ntypes);
|
|
cc->ses_eltmap = NULL;
|
|
cc->ses_ntypes = 0;
|
|
}
|
|
if (cc->ses_typidx && ssc->ses_nobjects) {
|
|
SES_FREE(cc->ses_typidx,
|
|
ssc->ses_nobjects * sizeof (struct typidx));
|
|
cc->ses_typidx = NULL;
|
|
}
|
|
SES_FREE(cc, sizeof (struct sscfg));
|
|
ssc->ses_private = NULL;
|
|
}
|
|
ssc->ses_nobjects = 0;
|
|
return (0);
|
|
}
|
|
if (ssc->ses_private == NULL) {
|
|
ssc->ses_private = SES_MALLOC(sizeof (struct sscfg));
|
|
}
|
|
if (ssc->ses_private == NULL) {
|
|
return (ENOMEM);
|
|
}
|
|
ssc->ses_nobjects = 0;
|
|
ssc->ses_encstat = 0;
|
|
return (ses_getconfig(ssc));
|
|
}
|
|
|
|
static int
|
|
ses_init_enc(ses_softc_t *ssc)
|
|
{
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
ses_get_encstat(ses_softc_t *ssc, int slpflag)
|
|
{
|
|
SesComStat ComStat;
|
|
int status;
|
|
|
|
if ((status = ses_getputstat(ssc, -1, &ComStat, slpflag, 1)) != 0) {
|
|
return (status);
|
|
}
|
|
ssc->ses_encstat = ComStat.comstatus | ENCI_SVALID;
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
ses_set_encstat(ses_softc_t *ssc, uint8_t encstat, int slpflag)
|
|
{
|
|
SesComStat ComStat;
|
|
int status;
|
|
|
|
ComStat.comstatus = encstat & 0xf;
|
|
if ((status = ses_getputstat(ssc, -1, &ComStat, slpflag, 0)) != 0) {
|
|
return (status);
|
|
}
|
|
ssc->ses_encstat = encstat & 0xf; /* note no SVALID set */
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
ses_get_objstat(ses_softc_t *ssc, ses_objstat *obp, int slpflag)
|
|
{
|
|
int i = (int)obp->obj_id;
|
|
|
|
if (ssc->ses_objmap[i].svalid == 0) {
|
|
SesComStat ComStat;
|
|
int err = ses_getputstat(ssc, i, &ComStat, slpflag, 1);
|
|
if (err)
|
|
return (err);
|
|
ssc->ses_objmap[i].encstat[0] = ComStat.comstatus;
|
|
ssc->ses_objmap[i].encstat[1] = ComStat.comstat[0];
|
|
ssc->ses_objmap[i].encstat[2] = ComStat.comstat[1];
|
|
ssc->ses_objmap[i].encstat[3] = ComStat.comstat[2];
|
|
ssc->ses_objmap[i].svalid = 1;
|
|
}
|
|
obp->cstat[0] = ssc->ses_objmap[i].encstat[0];
|
|
obp->cstat[1] = ssc->ses_objmap[i].encstat[1];
|
|
obp->cstat[2] = ssc->ses_objmap[i].encstat[2];
|
|
obp->cstat[3] = ssc->ses_objmap[i].encstat[3];
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
ses_set_objstat(ses_softc_t *ssc, ses_objstat *obp, int slpflag)
|
|
{
|
|
SesComStat ComStat;
|
|
int err;
|
|
/*
|
|
* If this is clear, we don't do diddly.
|
|
*/
|
|
if ((obp->cstat[0] & SESCTL_CSEL) == 0) {
|
|
return (0);
|
|
}
|
|
ComStat.comstatus = obp->cstat[0];
|
|
ComStat.comstat[0] = obp->cstat[1];
|
|
ComStat.comstat[1] = obp->cstat[2];
|
|
ComStat.comstat[2] = obp->cstat[3];
|
|
err = ses_getputstat(ssc, (int)obp->obj_id, &ComStat, slpflag, 0);
|
|
ssc->ses_objmap[(int)obp->obj_id].svalid = 0;
|
|
return (err);
|
|
}
|
|
|
|
static int
|
|
ses_getconfig(ses_softc_t *ssc)
|
|
{
|
|
struct sscfg *cc;
|
|
SesCfgHdr cf;
|
|
SesEncHdr hd;
|
|
SesEncDesc *cdp;
|
|
SesThdr thdr;
|
|
int err, amt, i, nobj, ntype, maxima;
|
|
char storage[CFLEN], *sdata;
|
|
static char cdb[6] = {
|
|
RECEIVE_DIAGNOSTIC, 0x1, SesConfigPage, SCSZ >> 8, SCSZ & 0xff, 0
|
|
};
|
|
|
|
cc = ssc->ses_private;
|
|
if (cc == NULL) {
|
|
return (ENXIO);
|
|
}
|
|
|
|
sdata = SES_MALLOC(SCSZ);
|
|
if (sdata == NULL)
|
|
return (ENOMEM);
|
|
|
|
amt = SCSZ;
|
|
err = ses_runcmd(ssc, cdb, 6, sdata, &amt);
|
|
if (err) {
|
|
SES_FREE(sdata, SCSZ);
|
|
return (err);
|
|
}
|
|
amt = SCSZ - amt;
|
|
|
|
if (ses_cfghdr((uint8_t *) sdata, amt, &cf)) {
|
|
SES_LOG(ssc, "Unable to parse SES Config Header\n");
|
|
SES_FREE(sdata, SCSZ);
|
|
return (EIO);
|
|
}
|
|
if (amt < SES_ENCHDR_MINLEN) {
|
|
SES_LOG(ssc, "runt enclosure length (%d)\n", amt);
|
|
SES_FREE(sdata, SCSZ);
|
|
return (EIO);
|
|
}
|
|
|
|
SES_VLOG(ssc, "GenCode %x %d Subenclosures\n", cf.GenCode, cf.Nsubenc);
|
|
|
|
/*
|
|
* Now waltz through all the subenclosures toting up the
|
|
* number of types available in each. For this, we only
|
|
* really need the enclosure header. However, we get the
|
|
* enclosure descriptor for debug purposes, as well
|
|
* as self-consistency checking purposes.
|
|
*/
|
|
|
|
maxima = cf.Nsubenc + 1;
|
|
cdp = (SesEncDesc *) storage;
|
|
for (ntype = i = 0; i < maxima; i++) {
|
|
MEMZERO((caddr_t)cdp, sizeof (*cdp));
|
|
if (ses_enchdr((uint8_t *) sdata, amt, i, &hd)) {
|
|
SES_LOG(ssc, "Cannot Extract Enclosure Header %d\n", i);
|
|
SES_FREE(sdata, SCSZ);
|
|
return (EIO);
|
|
}
|
|
SES_VLOG(ssc, " SubEnclosure ID %d, %d Types With this ID, En"
|
|
"closure Length %d\n", hd.Subencid, hd.Ntypes, hd.VEnclen);
|
|
|
|
if (ses_encdesc((uint8_t *)sdata, amt, i, cdp)) {
|
|
SES_LOG(ssc, "Can't get Enclosure Descriptor %d\n", i);
|
|
SES_FREE(sdata, SCSZ);
|
|
return (EIO);
|
|
}
|
|
SES_VLOG(ssc, " WWN: %02x%02x%02x%02x%02x%02x%02x%02x\n",
|
|
cdp->encWWN[0], cdp->encWWN[1], cdp->encWWN[2],
|
|
cdp->encWWN[3], cdp->encWWN[4], cdp->encWWN[5],
|
|
cdp->encWWN[6], cdp->encWWN[7]);
|
|
ntype += hd.Ntypes;
|
|
}
|
|
|
|
/*
|
|
* Now waltz through all the types that are available, getting
|
|
* the type header so we can start adding up the number of
|
|
* objects available.
|
|
*/
|
|
for (nobj = i = 0; i < ntype; i++) {
|
|
if (ses_getthdr((uint8_t *)sdata, amt, i, &thdr)) {
|
|
SES_LOG(ssc, "Can't get Enclosure Type Header %d\n", i);
|
|
SES_FREE(sdata, SCSZ);
|
|
return (EIO);
|
|
}
|
|
SES_LOG(ssc, " Type Desc[%d]: Type 0x%x, MaxElt %d, In Subenc "
|
|
"%d, Text Length %d\n", i, thdr.enc_type, thdr.enc_maxelt,
|
|
thdr.enc_subenc, thdr.enc_tlen);
|
|
nobj += thdr.enc_maxelt;
|
|
}
|
|
|
|
|
|
/*
|
|
* Now allocate the object array and type map.
|
|
*/
|
|
|
|
ssc->ses_objmap = SES_MALLOC(nobj * sizeof (encobj));
|
|
cc->ses_typidx = SES_MALLOC(nobj * sizeof (struct typidx));
|
|
cc->ses_eltmap = SES_MALLOC(ntype);
|
|
|
|
if (ssc->ses_objmap == NULL || cc->ses_typidx == NULL ||
|
|
cc->ses_eltmap == NULL) {
|
|
if (ssc->ses_objmap) {
|
|
SES_FREE(ssc->ses_objmap, (nobj * sizeof (encobj)));
|
|
ssc->ses_objmap = NULL;
|
|
}
|
|
if (cc->ses_typidx) {
|
|
SES_FREE(cc->ses_typidx,
|
|
(nobj * sizeof (struct typidx)));
|
|
cc->ses_typidx = NULL;
|
|
}
|
|
if (cc->ses_eltmap) {
|
|
SES_FREE(cc->ses_eltmap, ntype);
|
|
cc->ses_eltmap = NULL;
|
|
}
|
|
SES_FREE(sdata, SCSZ);
|
|
return (ENOMEM);
|
|
}
|
|
MEMZERO(ssc->ses_objmap, nobj * sizeof (encobj));
|
|
MEMZERO(cc->ses_typidx, nobj * sizeof (struct typidx));
|
|
MEMZERO(cc->ses_eltmap, ntype);
|
|
cc->ses_ntypes = (uint8_t) ntype;
|
|
ssc->ses_nobjects = nobj;
|
|
|
|
/*
|
|
* Now waltz through the # of types again to fill in the types
|
|
* (and subenclosure ids) of the allocated objects.
|
|
*/
|
|
nobj = 0;
|
|
for (i = 0; i < ntype; i++) {
|
|
int j;
|
|
if (ses_getthdr((uint8_t *)sdata, amt, i, &thdr)) {
|
|
continue;
|
|
}
|
|
cc->ses_eltmap[i] = thdr.enc_maxelt;
|
|
for (j = 0; j < thdr.enc_maxelt; j++) {
|
|
cc->ses_typidx[nobj].ses_tidx = i;
|
|
cc->ses_typidx[nobj].ses_oidx = j;
|
|
ssc->ses_objmap[nobj].subenclosure = thdr.enc_subenc;
|
|
ssc->ses_objmap[nobj++].enctype = thdr.enc_type;
|
|
}
|
|
}
|
|
SES_FREE(sdata, SCSZ);
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
ses_getputstat(ses_softc_t *ssc, int objid, SesComStat *sp, int slp, int in)
|
|
{
|
|
struct sscfg *cc;
|
|
int err, amt, bufsiz, tidx, oidx;
|
|
char cdb[6], *sdata;
|
|
|
|
cc = ssc->ses_private;
|
|
if (cc == NULL) {
|
|
return (ENXIO);
|
|
}
|
|
|
|
/*
|
|
* If we're just getting overall enclosure status,
|
|
* we only need 2 bytes of data storage.
|
|
*
|
|
* If we're getting anything else, we know how much
|
|
* storage we need by noting that starting at offset
|
|
* 8 in returned data, all object status bytes are 4
|
|
* bytes long, and are stored in chunks of types(M)
|
|
* and nth+1 instances of type M.
|
|
*/
|
|
if (objid == -1) {
|
|
bufsiz = 2;
|
|
} else {
|
|
bufsiz = (ssc->ses_nobjects * 4) + (cc->ses_ntypes * 4) + 8;
|
|
}
|
|
sdata = SES_MALLOC(bufsiz);
|
|
if (sdata == NULL)
|
|
return (ENOMEM);
|
|
|
|
cdb[0] = RECEIVE_DIAGNOSTIC;
|
|
cdb[1] = 1;
|
|
cdb[2] = SesStatusPage;
|
|
cdb[3] = bufsiz >> 8;
|
|
cdb[4] = bufsiz & 0xff;
|
|
cdb[5] = 0;
|
|
amt = bufsiz;
|
|
err = ses_runcmd(ssc, cdb, 6, sdata, &amt);
|
|
if (err) {
|
|
SES_FREE(sdata, bufsiz);
|
|
return (err);
|
|
}
|
|
amt = bufsiz - amt;
|
|
|
|
if (objid == -1) {
|
|
tidx = -1;
|
|
oidx = -1;
|
|
} else {
|
|
tidx = cc->ses_typidx[objid].ses_tidx;
|
|
oidx = cc->ses_typidx[objid].ses_oidx;
|
|
}
|
|
if (in) {
|
|
if (ses_decode(sdata, amt, cc->ses_eltmap, tidx, oidx, sp)) {
|
|
err = ENODEV;
|
|
}
|
|
} else {
|
|
if (ses_encode(sdata, amt, cc->ses_eltmap, tidx, oidx, sp)) {
|
|
err = ENODEV;
|
|
} else {
|
|
cdb[0] = SEND_DIAGNOSTIC;
|
|
cdb[1] = 0x10;
|
|
cdb[2] = 0;
|
|
cdb[3] = bufsiz >> 8;
|
|
cdb[4] = bufsiz & 0xff;
|
|
cdb[5] = 0;
|
|
amt = -bufsiz;
|
|
err = ses_runcmd(ssc, cdb, 6, sdata, &amt);
|
|
}
|
|
}
|
|
SES_FREE(sdata, bufsiz);
|
|
return (0);
|
|
}
|
|
|
|
|
|
/*
|
|
* Routines to parse returned SES data structures.
|
|
* Architecture and compiler independent.
|
|
*/
|
|
|
|
static int
|
|
ses_cfghdr(uint8_t *buffer, int buflen, SesCfgHdr *cfp)
|
|
{
|
|
if (buflen < SES_CFGHDR_MINLEN) {
|
|
return (-1);
|
|
}
|
|
gget8(buffer, 1, cfp->Nsubenc);
|
|
gget32(buffer, 4, cfp->GenCode);
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
ses_enchdr(uint8_t *buffer, int amt, uint8_t SubEncId, SesEncHdr *chp)
|
|
{
|
|
int s, off = 8;
|
|
for (s = 0; s < SubEncId; s++) {
|
|
if (off + 3 > amt)
|
|
return (-1);
|
|
off += buffer[off+3] + 4;
|
|
}
|
|
if (off + 3 > amt) {
|
|
return (-1);
|
|
}
|
|
gget8(buffer, off+1, chp->Subencid);
|
|
gget8(buffer, off+2, chp->Ntypes);
|
|
gget8(buffer, off+3, chp->VEnclen);
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
ses_encdesc(uint8_t *buffer, int amt, uint8_t SubEncId, SesEncDesc *cdp)
|
|
{
|
|
int s, e, enclen, off = 8;
|
|
for (s = 0; s < SubEncId; s++) {
|
|
if (off + 3 > amt)
|
|
return (-1);
|
|
off += buffer[off+3] + 4;
|
|
}
|
|
if (off + 3 > amt) {
|
|
return (-1);
|
|
}
|
|
gget8(buffer, off+3, enclen);
|
|
off += 4;
|
|
if (off >= amt)
|
|
return (-1);
|
|
|
|
e = off + enclen;
|
|
if (e > amt) {
|
|
e = amt;
|
|
}
|
|
MEMCPY(cdp, &buffer[off], e - off);
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
ses_getthdr(uint8_t *buffer, int amt, int nth, SesThdr *thp)
|
|
{
|
|
int s, off = 8;
|
|
|
|
if (amt < SES_CFGHDR_MINLEN) {
|
|
return (-1);
|
|
}
|
|
for (s = 0; s < buffer[1]; s++) {
|
|
if (off + 3 > amt)
|
|
return (-1);
|
|
off += buffer[off+3] + 4;
|
|
}
|
|
if (off + 3 > amt) {
|
|
return (-1);
|
|
}
|
|
off += buffer[off+3] + 4 + (nth * 4);
|
|
if (amt < (off + 4))
|
|
return (-1);
|
|
|
|
gget8(buffer, off++, thp->enc_type);
|
|
gget8(buffer, off++, thp->enc_maxelt);
|
|
gget8(buffer, off++, thp->enc_subenc);
|
|
gget8(buffer, off, thp->enc_tlen);
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* This function needs a little explanation.
|
|
*
|
|
* The arguments are:
|
|
*
|
|
*
|
|
* char *b, int amt
|
|
*
|
|
* These describes the raw input SES status data and length.
|
|
*
|
|
* uint8_t *ep
|
|
*
|
|
* This is a map of the number of types for each element type
|
|
* in the enclosure.
|
|
*
|
|
* int elt
|
|
*
|
|
* This is the element type being sought. If elt is -1,
|
|
* then overall enclosure status is being sought.
|
|
*
|
|
* int elm
|
|
*
|
|
* This is the ordinal Mth element of type elt being sought.
|
|
*
|
|
* SesComStat *sp
|
|
*
|
|
* This is the output area to store the status for
|
|
* the Mth element of type Elt.
|
|
*/
|
|
|
|
static int
|
|
ses_decode(char *b, int amt, uint8_t *ep, int elt, int elm, SesComStat *sp)
|
|
{
|
|
int idx, i;
|
|
|
|
/*
|
|
* If it's overall enclosure status being sought, get that.
|
|
* We need at least 2 bytes of status data to get that.
|
|
*/
|
|
if (elt == -1) {
|
|
if (amt < 2)
|
|
return (-1);
|
|
gget8(b, 1, sp->comstatus);
|
|
sp->comstat[0] = 0;
|
|
sp->comstat[1] = 0;
|
|
sp->comstat[2] = 0;
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* Check to make sure that the Mth element is legal for type Elt.
|
|
*/
|
|
|
|
if (elm >= ep[elt])
|
|
return (-1);
|
|
|
|
/*
|
|
* Starting at offset 8, start skipping over the storage
|
|
* for the element types we're not interested in.
|
|
*/
|
|
for (idx = 8, i = 0; i < elt; i++) {
|
|
idx += ((ep[i] + 1) * 4);
|
|
}
|
|
|
|
/*
|
|
* Skip over Overall status for this element type.
|
|
*/
|
|
idx += 4;
|
|
|
|
/*
|
|
* And skip to the index for the Mth element that we're going for.
|
|
*/
|
|
idx += (4 * elm);
|
|
|
|
/*
|
|
* Make sure we haven't overflowed the buffer.
|
|
*/
|
|
if (idx+4 > amt)
|
|
return (-1);
|
|
|
|
/*
|
|
* Retrieve the status.
|
|
*/
|
|
gget8(b, idx++, sp->comstatus);
|
|
gget8(b, idx++, sp->comstat[0]);
|
|
gget8(b, idx++, sp->comstat[1]);
|
|
gget8(b, idx++, sp->comstat[2]);
|
|
#if 0
|
|
PRINTF("Get Elt 0x%x Elm 0x%x (idx %d)\n", elt, elm, idx-4);
|
|
#endif
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* This is the mirror function to ses_decode, but we set the 'select'
|
|
* bit for the object which we're interested in. All other objects,
|
|
* after a status fetch, should have that bit off. Hmm. It'd be easy
|
|
* enough to ensure this, so we will.
|
|
*/
|
|
|
|
static int
|
|
ses_encode(char *b, int amt, uint8_t *ep, int elt, int elm, SesComStat *sp)
|
|
{
|
|
int idx, i;
|
|
|
|
/*
|
|
* If it's overall enclosure status being sought, get that.
|
|
* We need at least 2 bytes of status data to get that.
|
|
*/
|
|
if (elt == -1) {
|
|
if (amt < 2)
|
|
return (-1);
|
|
i = 0;
|
|
sset8(b, i, 0);
|
|
sset8(b, i, sp->comstatus & 0xf);
|
|
#if 0
|
|
PRINTF("set EncStat %x\n", sp->comstatus);
|
|
#endif
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* Check to make sure that the Mth element is legal for type Elt.
|
|
*/
|
|
|
|
if (elm >= ep[elt])
|
|
return (-1);
|
|
|
|
/*
|
|
* Starting at offset 8, start skipping over the storage
|
|
* for the element types we're not interested in.
|
|
*/
|
|
for (idx = 8, i = 0; i < elt; i++) {
|
|
idx += ((ep[i] + 1) * 4);
|
|
}
|
|
|
|
/*
|
|
* Skip over Overall status for this element type.
|
|
*/
|
|
idx += 4;
|
|
|
|
/*
|
|
* And skip to the index for the Mth element that we're going for.
|
|
*/
|
|
idx += (4 * elm);
|
|
|
|
/*
|
|
* Make sure we haven't overflowed the buffer.
|
|
*/
|
|
if (idx+4 > amt)
|
|
return (-1);
|
|
|
|
/*
|
|
* Set the status.
|
|
*/
|
|
sset8(b, idx, sp->comstatus);
|
|
sset8(b, idx, sp->comstat[0]);
|
|
sset8(b, idx, sp->comstat[1]);
|
|
sset8(b, idx, sp->comstat[2]);
|
|
idx -= 4;
|
|
|
|
#if 0
|
|
PRINTF("Set Elt 0x%x Elm 0x%x (idx %d) with %x %x %x %x\n",
|
|
elt, elm, idx, sp->comstatus, sp->comstat[0],
|
|
sp->comstat[1], sp->comstat[2]);
|
|
#endif
|
|
|
|
/*
|
|
* Now make sure all other 'Select' bits are off.
|
|
*/
|
|
for (i = 8; i < amt; i += 4) {
|
|
if (i != idx)
|
|
b[i] &= ~0x80;
|
|
}
|
|
/*
|
|
* And make sure the INVOP bit is clear.
|
|
*/
|
|
b[2] &= ~0x10;
|
|
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* SAF-TE Type Device Emulation
|
|
*/
|
|
|
|
static int safte_getconfig(ses_softc_t *);
|
|
static int safte_rdstat(ses_softc_t *, int);;
|
|
static int set_objstat_sel(ses_softc_t *, ses_objstat *, int);
|
|
static int wrbuf16(ses_softc_t *, uint8_t, uint8_t, uint8_t, uint8_t, int);
|
|
static void wrslot_stat(ses_softc_t *, int);
|
|
static int perf_slotop(ses_softc_t *, uint8_t, uint8_t, int);
|
|
|
|
#define ALL_ENC_STAT (SES_ENCSTAT_CRITICAL | SES_ENCSTAT_UNRECOV | \
|
|
SES_ENCSTAT_NONCRITICAL | SES_ENCSTAT_INFO)
|
|
/*
|
|
* SAF-TE specific defines- Mandatory ones only...
|
|
*/
|
|
|
|
/*
|
|
* READ BUFFER ('get' commands) IDs- placed in offset 2 of cdb
|
|
*/
|
|
#define SAFTE_RD_RDCFG 0x00 /* read enclosure configuration */
|
|
#define SAFTE_RD_RDESTS 0x01 /* read enclosure status */
|
|
#define SAFTE_RD_RDDSTS 0x04 /* read drive slot status */
|
|
|
|
/*
|
|
* WRITE BUFFER ('set' commands) IDs- placed in offset 0 of databuf
|
|
*/
|
|
#define SAFTE_WT_DSTAT 0x10 /* write device slot status */
|
|
#define SAFTE_WT_SLTOP 0x12 /* perform slot operation */
|
|
#define SAFTE_WT_FANSPD 0x13 /* set fan speed */
|
|
#define SAFTE_WT_ACTPWS 0x14 /* turn on/off power supply */
|
|
#define SAFTE_WT_GLOBAL 0x15 /* send global command */
|
|
|
|
|
|
#define SAFT_SCRATCH 64
|
|
#define NPSEUDO_THERM 16
|
|
#define NPSEUDO_ALARM 1
|
|
struct scfg {
|
|
/*
|
|
* Cached Configuration
|
|
*/
|
|
uint8_t Nfans; /* Number of Fans */
|
|
uint8_t Npwr; /* Number of Power Supplies */
|
|
uint8_t Nslots; /* Number of Device Slots */
|
|
uint8_t DoorLock; /* Door Lock Installed */
|
|
uint8_t Ntherm; /* Number of Temperature Sensors */
|
|
uint8_t Nspkrs; /* Number of Speakers */
|
|
uint8_t Nalarm; /* Number of Alarms (at least one) */
|
|
/*
|
|
* Cached Flag Bytes for Global Status
|
|
*/
|
|
uint8_t flag1;
|
|
uint8_t flag2;
|
|
/*
|
|
* What object index ID is where various slots start.
|
|
*/
|
|
uint8_t pwroff;
|
|
uint8_t slotoff;
|
|
#define SAFT_ALARM_OFFSET(cc) (cc)->slotoff - 1
|
|
};
|
|
|
|
#define SAFT_FLG1_ALARM 0x1
|
|
#define SAFT_FLG1_GLOBFAIL 0x2
|
|
#define SAFT_FLG1_GLOBWARN 0x4
|
|
#define SAFT_FLG1_ENCPWROFF 0x8
|
|
#define SAFT_FLG1_ENCFANFAIL 0x10
|
|
#define SAFT_FLG1_ENCPWRFAIL 0x20
|
|
#define SAFT_FLG1_ENCDRVFAIL 0x40
|
|
#define SAFT_FLG1_ENCDRVWARN 0x80
|
|
|
|
#define SAFT_FLG2_LOCKDOOR 0x4
|
|
#define SAFT_PRIVATE sizeof (struct scfg)
|
|
|
|
static char *safte_2little = "Too Little Data Returned (%d) at line %d\n";
|
|
#define SAFT_BAIL(r, x, k, l) \
|
|
if (r >= x) { \
|
|
SES_LOG(ssc, safte_2little, x, __LINE__);\
|
|
SES_FREE(k, l); \
|
|
return (EIO); \
|
|
}
|
|
|
|
|
|
int
|
|
safte_softc_init(ses_softc_t *ssc, int doinit)
|
|
{
|
|
int err, i, r;
|
|
struct scfg *cc;
|
|
|
|
if (doinit == 0) {
|
|
if (ssc->ses_nobjects) {
|
|
if (ssc->ses_objmap) {
|
|
SES_FREE(ssc->ses_objmap,
|
|
ssc->ses_nobjects * sizeof (encobj));
|
|
ssc->ses_objmap = NULL;
|
|
}
|
|
ssc->ses_nobjects = 0;
|
|
}
|
|
if (ssc->ses_private) {
|
|
SES_FREE(ssc->ses_private, SAFT_PRIVATE);
|
|
ssc->ses_private = NULL;
|
|
}
|
|
return (0);
|
|
}
|
|
|
|
if (ssc->ses_private == NULL) {
|
|
ssc->ses_private = SES_MALLOC(SAFT_PRIVATE);
|
|
if (ssc->ses_private == NULL) {
|
|
return (ENOMEM);
|
|
}
|
|
MEMZERO(ssc->ses_private, SAFT_PRIVATE);
|
|
}
|
|
|
|
ssc->ses_nobjects = 0;
|
|
ssc->ses_encstat = 0;
|
|
|
|
if ((err = safte_getconfig(ssc)) != 0) {
|
|
return (err);
|
|
}
|
|
|
|
/*
|
|
* The number of objects here, as well as that reported by the
|
|
* READ_BUFFER/GET_CONFIG call, are the over-temperature flags (15)
|
|
* that get reported during READ_BUFFER/READ_ENC_STATUS.
|
|
*/
|
|
cc = ssc->ses_private;
|
|
ssc->ses_nobjects = cc->Nfans + cc->Npwr + cc->Nslots + cc->DoorLock +
|
|
cc->Ntherm + cc->Nspkrs + NPSEUDO_THERM + NPSEUDO_ALARM;
|
|
ssc->ses_objmap = (encobj *)
|
|
SES_MALLOC(ssc->ses_nobjects * sizeof (encobj));
|
|
if (ssc->ses_objmap == NULL) {
|
|
return (ENOMEM);
|
|
}
|
|
MEMZERO(ssc->ses_objmap, ssc->ses_nobjects * sizeof (encobj));
|
|
|
|
r = 0;
|
|
/*
|
|
* Note that this is all arranged for the convenience
|
|
* in later fetches of status.
|
|
*/
|
|
for (i = 0; i < cc->Nfans; i++)
|
|
ssc->ses_objmap[r++].enctype = SESTYP_FAN;
|
|
cc->pwroff = (uint8_t) r;
|
|
for (i = 0; i < cc->Npwr; i++)
|
|
ssc->ses_objmap[r++].enctype = SESTYP_POWER;
|
|
for (i = 0; i < cc->DoorLock; i++)
|
|
ssc->ses_objmap[r++].enctype = SESTYP_DOORLOCK;
|
|
for (i = 0; i < cc->Nspkrs; i++)
|
|
ssc->ses_objmap[r++].enctype = SESTYP_ALARM;
|
|
for (i = 0; i < cc->Ntherm; i++)
|
|
ssc->ses_objmap[r++].enctype = SESTYP_THERM;
|
|
for (i = 0; i < NPSEUDO_THERM; i++)
|
|
ssc->ses_objmap[r++].enctype = SESTYP_THERM;
|
|
ssc->ses_objmap[r++].enctype = SESTYP_ALARM;
|
|
cc->slotoff = (uint8_t) r;
|
|
for (i = 0; i < cc->Nslots; i++)
|
|
ssc->ses_objmap[r++].enctype = SESTYP_DEVICE;
|
|
return (0);
|
|
}
|
|
|
|
int
|
|
safte_init_enc(ses_softc_t *ssc)
|
|
{
|
|
int err;
|
|
static char cdb0[6] = { SEND_DIAGNOSTIC };
|
|
|
|
err = ses_runcmd(ssc, cdb0, 6, NULL, 0);
|
|
if (err) {
|
|
return (err);
|
|
}
|
|
DELAY(5000);
|
|
err = wrbuf16(ssc, SAFTE_WT_GLOBAL, 0, 0, 0, 1);
|
|
return (err);
|
|
}
|
|
|
|
int
|
|
safte_get_encstat(ses_softc_t *ssc, int slpflg)
|
|
{
|
|
return (safte_rdstat(ssc, slpflg));
|
|
}
|
|
|
|
int
|
|
safte_set_encstat(ses_softc_t *ssc, uint8_t encstat, int slpflg)
|
|
{
|
|
struct scfg *cc = ssc->ses_private;
|
|
if (cc == NULL)
|
|
return (0);
|
|
/*
|
|
* Since SAF-TE devices aren't necessarily sticky in terms
|
|
* of state, make our soft copy of enclosure status 'sticky'-
|
|
* that is, things set in enclosure status stay set (as implied
|
|
* by conditions set in reading object status) until cleared.
|
|
*/
|
|
ssc->ses_encstat &= ~ALL_ENC_STAT;
|
|
ssc->ses_encstat |= (encstat & ALL_ENC_STAT);
|
|
ssc->ses_encstat |= ENCI_SVALID;
|
|
cc->flag1 &= ~(SAFT_FLG1_ALARM|SAFT_FLG1_GLOBFAIL|SAFT_FLG1_GLOBWARN);
|
|
if ((encstat & (SES_ENCSTAT_CRITICAL|SES_ENCSTAT_UNRECOV)) != 0) {
|
|
cc->flag1 |= SAFT_FLG1_ALARM|SAFT_FLG1_GLOBFAIL;
|
|
} else if ((encstat & SES_ENCSTAT_NONCRITICAL) != 0) {
|
|
cc->flag1 |= SAFT_FLG1_GLOBWARN;
|
|
}
|
|
return (wrbuf16(ssc, SAFTE_WT_GLOBAL, cc->flag1, cc->flag2, 0, slpflg));
|
|
}
|
|
|
|
int
|
|
safte_get_objstat(ses_softc_t *ssc, ses_objstat *obp, int slpflg)
|
|
{
|
|
int i = (int)obp->obj_id;
|
|
|
|
if ((ssc->ses_encstat & ENCI_SVALID) == 0 ||
|
|
(ssc->ses_objmap[i].svalid) == 0) {
|
|
int err = safte_rdstat(ssc, slpflg);
|
|
if (err)
|
|
return (err);
|
|
}
|
|
obp->cstat[0] = ssc->ses_objmap[i].encstat[0];
|
|
obp->cstat[1] = ssc->ses_objmap[i].encstat[1];
|
|
obp->cstat[2] = ssc->ses_objmap[i].encstat[2];
|
|
obp->cstat[3] = ssc->ses_objmap[i].encstat[3];
|
|
return (0);
|
|
}
|
|
|
|
|
|
int
|
|
safte_set_objstat(ses_softc_t *ssc, ses_objstat *obp, int slp)
|
|
{
|
|
int idx, err;
|
|
encobj *ep;
|
|
struct scfg *cc;
|
|
|
|
|
|
SES_DLOG(ssc, "safte_set_objstat(%d): %x %x %x %x\n",
|
|
(int)obp->obj_id, obp->cstat[0], obp->cstat[1], obp->cstat[2],
|
|
obp->cstat[3]);
|
|
|
|
/*
|
|
* If this is clear, we don't do diddly.
|
|
*/
|
|
if ((obp->cstat[0] & SESCTL_CSEL) == 0) {
|
|
return (0);
|
|
}
|
|
|
|
err = 0;
|
|
/*
|
|
* Check to see if the common bits are set and do them first.
|
|
*/
|
|
if (obp->cstat[0] & ~SESCTL_CSEL) {
|
|
err = set_objstat_sel(ssc, obp, slp);
|
|
if (err)
|
|
return (err);
|
|
}
|
|
|
|
cc = ssc->ses_private;
|
|
if (cc == NULL)
|
|
return (0);
|
|
|
|
idx = (int)obp->obj_id;
|
|
ep = &ssc->ses_objmap[idx];
|
|
|
|
switch (ep->enctype) {
|
|
case SESTYP_DEVICE:
|
|
{
|
|
uint8_t slotop = 0;
|
|
/*
|
|
* XXX: I should probably cache the previous state
|
|
* XXX: of SESCTL_DEVOFF so that when it goes from
|
|
* XXX: true to false I can then set PREPARE FOR OPERATION
|
|
* XXX: flag in PERFORM SLOT OPERATION write buffer command.
|
|
*/
|
|
if (obp->cstat[2] & (SESCTL_RQSINS|SESCTL_RQSRMV)) {
|
|
slotop |= 0x2;
|
|
}
|
|
if (obp->cstat[2] & SESCTL_RQSID) {
|
|
slotop |= 0x4;
|
|
}
|
|
err = perf_slotop(ssc, (uint8_t) idx - (uint8_t) cc->slotoff,
|
|
slotop, slp);
|
|
if (err)
|
|
return (err);
|
|
if (obp->cstat[3] & SESCTL_RQSFLT) {
|
|
ep->priv |= 0x2;
|
|
} else {
|
|
ep->priv &= ~0x2;
|
|
}
|
|
if (ep->priv & 0xc6) {
|
|
ep->priv &= ~0x1;
|
|
} else {
|
|
ep->priv |= 0x1; /* no errors */
|
|
}
|
|
wrslot_stat(ssc, slp);
|
|
break;
|
|
}
|
|
case SESTYP_POWER:
|
|
if (obp->cstat[3] & SESCTL_RQSTFAIL) {
|
|
cc->flag1 |= SAFT_FLG1_ENCPWRFAIL;
|
|
} else {
|
|
cc->flag1 &= ~SAFT_FLG1_ENCPWRFAIL;
|
|
}
|
|
err = wrbuf16(ssc, SAFTE_WT_GLOBAL, cc->flag1,
|
|
cc->flag2, 0, slp);
|
|
if (err)
|
|
return (err);
|
|
if (obp->cstat[3] & SESCTL_RQSTON) {
|
|
(void) wrbuf16(ssc, SAFTE_WT_ACTPWS,
|
|
idx - cc->pwroff, 0, 0, slp);
|
|
} else {
|
|
(void) wrbuf16(ssc, SAFTE_WT_ACTPWS,
|
|
idx - cc->pwroff, 0, 1, slp);
|
|
}
|
|
break;
|
|
case SESTYP_FAN:
|
|
if (obp->cstat[3] & SESCTL_RQSTFAIL) {
|
|
cc->flag1 |= SAFT_FLG1_ENCFANFAIL;
|
|
} else {
|
|
cc->flag1 &= ~SAFT_FLG1_ENCFANFAIL;
|
|
}
|
|
err = wrbuf16(ssc, SAFTE_WT_GLOBAL, cc->flag1,
|
|
cc->flag2, 0, slp);
|
|
if (err)
|
|
return (err);
|
|
if (obp->cstat[3] & SESCTL_RQSTON) {
|
|
uint8_t fsp;
|
|
if ((obp->cstat[3] & 0x7) == 7) {
|
|
fsp = 4;
|
|
} else if ((obp->cstat[3] & 0x7) == 6) {
|
|
fsp = 3;
|
|
} else if ((obp->cstat[3] & 0x7) == 4) {
|
|
fsp = 2;
|
|
} else {
|
|
fsp = 1;
|
|
}
|
|
(void) wrbuf16(ssc, SAFTE_WT_FANSPD, idx, fsp, 0, slp);
|
|
} else {
|
|
(void) wrbuf16(ssc, SAFTE_WT_FANSPD, idx, 0, 0, slp);
|
|
}
|
|
break;
|
|
case SESTYP_DOORLOCK:
|
|
if (obp->cstat[3] & 0x1) {
|
|
cc->flag2 &= ~SAFT_FLG2_LOCKDOOR;
|
|
} else {
|
|
cc->flag2 |= SAFT_FLG2_LOCKDOOR;
|
|
}
|
|
(void) wrbuf16(ssc, SAFTE_WT_GLOBAL, cc->flag1,
|
|
cc->flag2, 0, slp);
|
|
break;
|
|
case SESTYP_ALARM:
|
|
/*
|
|
* On all nonzero but the 'muted' bit, we turn on the alarm,
|
|
*/
|
|
obp->cstat[3] &= ~0xa;
|
|
if (obp->cstat[3] & 0x40) {
|
|
cc->flag2 &= ~SAFT_FLG1_ALARM;
|
|
} else if (obp->cstat[3] != 0) {
|
|
cc->flag2 |= SAFT_FLG1_ALARM;
|
|
} else {
|
|
cc->flag2 &= ~SAFT_FLG1_ALARM;
|
|
}
|
|
ep->priv = obp->cstat[3];
|
|
(void) wrbuf16(ssc, SAFTE_WT_GLOBAL, cc->flag1,
|
|
cc->flag2, 0, slp);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
ep->svalid = 0;
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
safte_getconfig(ses_softc_t *ssc)
|
|
{
|
|
struct scfg *cfg;
|
|
int err, amt;
|
|
char *sdata;
|
|
static char cdb[10] =
|
|
{ READ_BUFFER, 1, SAFTE_RD_RDCFG, 0, 0, 0, 0, 0, SAFT_SCRATCH, 0 };
|
|
|
|
cfg = ssc->ses_private;
|
|
if (cfg == NULL)
|
|
return (ENXIO);
|
|
|
|
sdata = SES_MALLOC(SAFT_SCRATCH);
|
|
if (sdata == NULL)
|
|
return (ENOMEM);
|
|
|
|
amt = SAFT_SCRATCH;
|
|
err = ses_runcmd(ssc, cdb, 10, sdata, &amt);
|
|
if (err) {
|
|
SES_FREE(sdata, SAFT_SCRATCH);
|
|
return (err);
|
|
}
|
|
amt = SAFT_SCRATCH - amt;
|
|
if (amt < 6) {
|
|
SES_LOG(ssc, "too little data (%d) for configuration\n", amt);
|
|
SES_FREE(sdata, SAFT_SCRATCH);
|
|
return (EIO);
|
|
}
|
|
SES_VLOG(ssc, "Nfans %d Npwr %d Nslots %d Lck %d Ntherm %d Nspkrs %d\n",
|
|
sdata[0], sdata[1], sdata[2], sdata[3], sdata[4], sdata[5]);
|
|
cfg->Nfans = sdata[0];
|
|
cfg->Npwr = sdata[1];
|
|
cfg->Nslots = sdata[2];
|
|
cfg->DoorLock = sdata[3];
|
|
cfg->Ntherm = sdata[4];
|
|
cfg->Nspkrs = sdata[5];
|
|
cfg->Nalarm = NPSEUDO_ALARM;
|
|
SES_FREE(sdata, SAFT_SCRATCH);
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
safte_rdstat(ses_softc_t *ssc, int slpflg)
|
|
{
|
|
int err, oid, r, i, hiwater, nitems, amt;
|
|
uint16_t tempflags;
|
|
size_t buflen;
|
|
uint8_t status, oencstat;
|
|
char *sdata, cdb[10];
|
|
struct scfg *cc = ssc->ses_private;
|
|
|
|
|
|
/*
|
|
* The number of objects overstates things a bit,
|
|
* both for the bogus 'thermometer' entries and
|
|
* the drive status (which isn't read at the same
|
|
* time as the enclosure status), but that's okay.
|
|
*/
|
|
buflen = 4 * cc->Nslots;
|
|
if (ssc->ses_nobjects > buflen)
|
|
buflen = ssc->ses_nobjects;
|
|
sdata = SES_MALLOC(buflen);
|
|
if (sdata == NULL)
|
|
return (ENOMEM);
|
|
|
|
cdb[0] = READ_BUFFER;
|
|
cdb[1] = 1;
|
|
cdb[2] = SAFTE_RD_RDESTS;
|
|
cdb[3] = 0;
|
|
cdb[4] = 0;
|
|
cdb[5] = 0;
|
|
cdb[6] = 0;
|
|
cdb[7] = (buflen >> 8) & 0xff;
|
|
cdb[8] = buflen & 0xff;
|
|
cdb[9] = 0;
|
|
amt = buflen;
|
|
err = ses_runcmd(ssc, cdb, 10, sdata, &amt);
|
|
if (err) {
|
|
SES_FREE(sdata, buflen);
|
|
return (err);
|
|
}
|
|
hiwater = buflen - amt;
|
|
|
|
|
|
/*
|
|
* invalidate all status bits.
|
|
*/
|
|
for (i = 0; i < ssc->ses_nobjects; i++)
|
|
ssc->ses_objmap[i].svalid = 0;
|
|
oencstat = ssc->ses_encstat & ALL_ENC_STAT;
|
|
ssc->ses_encstat = 0;
|
|
|
|
|
|
/*
|
|
* Now parse returned buffer.
|
|
* If we didn't get enough data back,
|
|
* that's considered a fatal error.
|
|
*/
|
|
oid = r = 0;
|
|
|
|
for (nitems = i = 0; i < cc->Nfans; i++) {
|
|
SAFT_BAIL(r, hiwater, sdata, buflen);
|
|
/*
|
|
* 0 = Fan Operational
|
|
* 1 = Fan is malfunctioning
|
|
* 2 = Fan is not present
|
|
* 0x80 = Unknown or Not Reportable Status
|
|
*/
|
|
ssc->ses_objmap[oid].encstat[1] = 0; /* resvd */
|
|
ssc->ses_objmap[oid].encstat[2] = 0; /* resvd */
|
|
switch ((int)(uint8_t)sdata[r]) {
|
|
case 0:
|
|
nitems++;
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_OK;
|
|
/*
|
|
* We could get fancier and cache
|
|
* fan speeds that we have set, but
|
|
* that isn't done now.
|
|
*/
|
|
ssc->ses_objmap[oid].encstat[3] = 7;
|
|
break;
|
|
|
|
case 1:
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_CRIT;
|
|
/*
|
|
* FAIL and FAN STOPPED synthesized
|
|
*/
|
|
ssc->ses_objmap[oid].encstat[3] = 0x40;
|
|
/*
|
|
* Enclosure marked with CRITICAL error
|
|
* if only one fan or no thermometers,
|
|
* else the NONCRITICAL error is set.
|
|
*/
|
|
if (cc->Nfans == 1 || cc->Ntherm == 0)
|
|
ssc->ses_encstat |= SES_ENCSTAT_CRITICAL;
|
|
else
|
|
ssc->ses_encstat |= SES_ENCSTAT_NONCRITICAL;
|
|
break;
|
|
case 2:
|
|
ssc->ses_objmap[oid].encstat[0] =
|
|
SES_OBJSTAT_NOTINSTALLED;
|
|
ssc->ses_objmap[oid].encstat[3] = 0;
|
|
/*
|
|
* Enclosure marked with CRITICAL error
|
|
* if only one fan or no thermometers,
|
|
* else the NONCRITICAL error is set.
|
|
*/
|
|
if (cc->Nfans == 1)
|
|
ssc->ses_encstat |= SES_ENCSTAT_CRITICAL;
|
|
else
|
|
ssc->ses_encstat |= SES_ENCSTAT_NONCRITICAL;
|
|
break;
|
|
case 0x80:
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_UNKNOWN;
|
|
ssc->ses_objmap[oid].encstat[3] = 0;
|
|
ssc->ses_encstat |= SES_ENCSTAT_INFO;
|
|
break;
|
|
default:
|
|
ssc->ses_objmap[oid].encstat[0] =
|
|
SES_OBJSTAT_UNSUPPORTED;
|
|
SES_LOG(ssc, "Unknown fan%d status 0x%x\n", i,
|
|
sdata[r] & 0xff);
|
|
break;
|
|
}
|
|
ssc->ses_objmap[oid++].svalid = 1;
|
|
r++;
|
|
}
|
|
|
|
/*
|
|
* No matter how you cut it, no cooling elements when there
|
|
* should be some there is critical.
|
|
*/
|
|
if (cc->Nfans && nitems == 0) {
|
|
ssc->ses_encstat |= SES_ENCSTAT_CRITICAL;
|
|
}
|
|
|
|
|
|
for (i = 0; i < cc->Npwr; i++) {
|
|
SAFT_BAIL(r, hiwater, sdata, buflen);
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_UNKNOWN;
|
|
ssc->ses_objmap[oid].encstat[1] = 0; /* resvd */
|
|
ssc->ses_objmap[oid].encstat[2] = 0; /* resvd */
|
|
ssc->ses_objmap[oid].encstat[3] = 0x20; /* requested on */
|
|
switch ((uint8_t)sdata[r]) {
|
|
case 0x00: /* pws operational and on */
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_OK;
|
|
break;
|
|
case 0x01: /* pws operational and off */
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_OK;
|
|
ssc->ses_objmap[oid].encstat[3] = 0x10;
|
|
ssc->ses_encstat |= SES_ENCSTAT_INFO;
|
|
break;
|
|
case 0x10: /* pws is malfunctioning and commanded on */
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_CRIT;
|
|
ssc->ses_objmap[oid].encstat[3] = 0x61;
|
|
ssc->ses_encstat |= SES_ENCSTAT_NONCRITICAL;
|
|
break;
|
|
|
|
case 0x11: /* pws is malfunctioning and commanded off */
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_NONCRIT;
|
|
ssc->ses_objmap[oid].encstat[3] = 0x51;
|
|
ssc->ses_encstat |= SES_ENCSTAT_NONCRITICAL;
|
|
break;
|
|
case 0x20: /* pws is not present */
|
|
ssc->ses_objmap[oid].encstat[0] =
|
|
SES_OBJSTAT_NOTINSTALLED;
|
|
ssc->ses_objmap[oid].encstat[3] = 0;
|
|
ssc->ses_encstat |= SES_ENCSTAT_INFO;
|
|
break;
|
|
case 0x21: /* pws is present */
|
|
/*
|
|
* This is for enclosures that cannot tell whether the
|
|
* device is on or malfunctioning, but know that it is
|
|
* present. Just fall through.
|
|
*/
|
|
/* FALLTHROUGH */
|
|
case 0x80: /* Unknown or Not Reportable Status */
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_UNKNOWN;
|
|
ssc->ses_objmap[oid].encstat[3] = 0;
|
|
ssc->ses_encstat |= SES_ENCSTAT_INFO;
|
|
break;
|
|
default:
|
|
SES_LOG(ssc, "unknown power supply %d status (0x%x)\n",
|
|
i, sdata[r] & 0xff);
|
|
break;
|
|
}
|
|
ssc->ses_objmap[oid++].svalid = 1;
|
|
r++;
|
|
}
|
|
|
|
/*
|
|
* Skip over Slot SCSI IDs
|
|
*/
|
|
r += cc->Nslots;
|
|
|
|
/*
|
|
* We always have doorlock status, no matter what,
|
|
* but we only save the status if we have one.
|
|
*/
|
|
SAFT_BAIL(r, hiwater, sdata, buflen);
|
|
if (cc->DoorLock) {
|
|
/*
|
|
* 0 = Door Locked
|
|
* 1 = Door Unlocked, or no Lock Installed
|
|
* 0x80 = Unknown or Not Reportable Status
|
|
*/
|
|
ssc->ses_objmap[oid].encstat[1] = 0;
|
|
ssc->ses_objmap[oid].encstat[2] = 0;
|
|
switch ((uint8_t)sdata[r]) {
|
|
case 0:
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_OK;
|
|
ssc->ses_objmap[oid].encstat[3] = 0;
|
|
break;
|
|
case 1:
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_OK;
|
|
ssc->ses_objmap[oid].encstat[3] = 1;
|
|
break;
|
|
case 0x80:
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_UNKNOWN;
|
|
ssc->ses_objmap[oid].encstat[3] = 0;
|
|
ssc->ses_encstat |= SES_ENCSTAT_INFO;
|
|
break;
|
|
default:
|
|
ssc->ses_objmap[oid].encstat[0] =
|
|
SES_OBJSTAT_UNSUPPORTED;
|
|
SES_LOG(ssc, "unknown lock status 0x%x\n",
|
|
sdata[r] & 0xff);
|
|
break;
|
|
}
|
|
ssc->ses_objmap[oid++].svalid = 1;
|
|
}
|
|
r++;
|
|
|
|
/*
|
|
* We always have speaker status, no matter what,
|
|
* but we only save the status if we have one.
|
|
*/
|
|
SAFT_BAIL(r, hiwater, sdata, buflen);
|
|
if (cc->Nspkrs) {
|
|
ssc->ses_objmap[oid].encstat[1] = 0;
|
|
ssc->ses_objmap[oid].encstat[2] = 0;
|
|
if (sdata[r] == 1) {
|
|
/*
|
|
* We need to cache tone urgency indicators.
|
|
* Someday.
|
|
*/
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_NONCRIT;
|
|
ssc->ses_objmap[oid].encstat[3] = 0x8;
|
|
ssc->ses_encstat |= SES_ENCSTAT_NONCRITICAL;
|
|
} else if (sdata[r] == 0) {
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_OK;
|
|
ssc->ses_objmap[oid].encstat[3] = 0;
|
|
} else {
|
|
ssc->ses_objmap[oid].encstat[0] =
|
|
SES_OBJSTAT_UNSUPPORTED;
|
|
ssc->ses_objmap[oid].encstat[3] = 0;
|
|
SES_LOG(ssc, "unknown spkr status 0x%x\n",
|
|
sdata[r] & 0xff);
|
|
}
|
|
ssc->ses_objmap[oid++].svalid = 1;
|
|
}
|
|
r++;
|
|
|
|
for (i = 0; i < cc->Ntherm; i++) {
|
|
SAFT_BAIL(r, hiwater, sdata, buflen);
|
|
/*
|
|
* Status is a range from -10 to 245 deg Celsius,
|
|
* which we need to normalize to -20 to -245 according
|
|
* to the latest SCSI spec, which makes little
|
|
* sense since this would overflow an 8bit value.
|
|
* Well, still, the base normalization is -20,
|
|
* not -10, so we have to adjust.
|
|
*
|
|
* So what's over and under temperature?
|
|
* Hmm- we'll state that 'normal' operating
|
|
* is 10 to 40 deg Celsius.
|
|
*/
|
|
ssc->ses_objmap[oid].encstat[1] = 0;
|
|
ssc->ses_objmap[oid].encstat[2] =
|
|
((unsigned int) sdata[r]) - 10;
|
|
if (sdata[r] < 20) {
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_CRIT;
|
|
/*
|
|
* Set 'under temperature' failure.
|
|
*/
|
|
ssc->ses_objmap[oid].encstat[3] = 2;
|
|
ssc->ses_encstat |= SES_ENCSTAT_CRITICAL;
|
|
} else if (sdata[r] > 30) {
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_CRIT;
|
|
/*
|
|
* Set 'over temperature' failure.
|
|
*/
|
|
ssc->ses_objmap[oid].encstat[3] = 8;
|
|
ssc->ses_encstat |= SES_ENCSTAT_CRITICAL;
|
|
} else {
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_OK;
|
|
}
|
|
ssc->ses_objmap[oid++].svalid = 1;
|
|
r++;
|
|
}
|
|
|
|
/*
|
|
* Now, for "pseudo" thermometers, we have two bytes
|
|
* of information in enclosure status- 16 bits. Actually,
|
|
* the MSB is a single TEMP ALERT flag indicating whether
|
|
* any other bits are set, but, thanks to fuzzy thinking,
|
|
* in the SAF-TE spec, this can also be set even if no
|
|
* other bits are set, thus making this really another
|
|
* binary temperature sensor.
|
|
*/
|
|
|
|
SAFT_BAIL(r, hiwater, sdata, buflen);
|
|
tempflags = sdata[r++];
|
|
SAFT_BAIL(r, hiwater, sdata, buflen);
|
|
tempflags |= (tempflags << 8) | sdata[r++];
|
|
|
|
for (i = 0; i < NPSEUDO_THERM; i++) {
|
|
ssc->ses_objmap[oid].encstat[1] = 0;
|
|
if (tempflags & (1 << (NPSEUDO_THERM - i - 1))) {
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_CRIT;
|
|
ssc->ses_objmap[4].encstat[2] = 0xff;
|
|
/*
|
|
* Set 'over temperature' failure.
|
|
*/
|
|
ssc->ses_objmap[oid].encstat[3] = 8;
|
|
ssc->ses_encstat |= SES_ENCSTAT_CRITICAL;
|
|
} else {
|
|
/*
|
|
* We used to say 'not available' and synthesize a
|
|
* nominal 30 deg (C)- that was wrong. Actually,
|
|
* Just say 'OK', and use the reserved value of
|
|
* zero.
|
|
*/
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_OK;
|
|
ssc->ses_objmap[oid].encstat[2] = 0;
|
|
ssc->ses_objmap[oid].encstat[3] = 0;
|
|
}
|
|
ssc->ses_objmap[oid++].svalid = 1;
|
|
}
|
|
|
|
/*
|
|
* Get alarm status.
|
|
*/
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_OK;
|
|
ssc->ses_objmap[oid].encstat[3] = ssc->ses_objmap[oid].priv;
|
|
ssc->ses_objmap[oid++].svalid = 1;
|
|
|
|
/*
|
|
* Now get drive slot status
|
|
*/
|
|
cdb[2] = SAFTE_RD_RDDSTS;
|
|
amt = buflen;
|
|
err = ses_runcmd(ssc, cdb, 10, sdata, &amt);
|
|
if (err) {
|
|
SES_FREE(sdata, buflen);
|
|
return (err);
|
|
}
|
|
hiwater = buflen - amt;
|
|
for (r = i = 0; i < cc->Nslots; i++, r += 4) {
|
|
SAFT_BAIL(r+3, hiwater, sdata, buflen);
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_UNSUPPORTED;
|
|
ssc->ses_objmap[oid].encstat[1] = (uint8_t) i;
|
|
ssc->ses_objmap[oid].encstat[2] = 0;
|
|
ssc->ses_objmap[oid].encstat[3] = 0;
|
|
status = sdata[r+3];
|
|
if ((status & 0x1) == 0) { /* no device */
|
|
ssc->ses_objmap[oid].encstat[0] =
|
|
SES_OBJSTAT_NOTINSTALLED;
|
|
} else {
|
|
ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_OK;
|
|
}
|
|
if (status & 0x2) {
|
|
ssc->ses_objmap[oid].encstat[2] = 0x8;
|
|
}
|
|
if ((status & 0x4) == 0) {
|
|
ssc->ses_objmap[oid].encstat[3] = 0x10;
|
|
}
|
|
ssc->ses_objmap[oid++].svalid = 1;
|
|
}
|
|
/* see comment below about sticky enclosure status */
|
|
ssc->ses_encstat |= ENCI_SVALID | oencstat;
|
|
SES_FREE(sdata, buflen);
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
set_objstat_sel(ses_softc_t *ssc, ses_objstat *obp, int slp)
|
|
{
|
|
int idx;
|
|
encobj *ep;
|
|
struct scfg *cc = ssc->ses_private;
|
|
|
|
if (cc == NULL)
|
|
return (0);
|
|
|
|
idx = (int)obp->obj_id;
|
|
ep = &ssc->ses_objmap[idx];
|
|
|
|
switch (ep->enctype) {
|
|
case SESTYP_DEVICE:
|
|
if (obp->cstat[0] & SESCTL_PRDFAIL) {
|
|
ep->priv |= 0x40;
|
|
}
|
|
/* SESCTL_RSTSWAP has no correspondence in SAF-TE */
|
|
if (obp->cstat[0] & SESCTL_DISABLE) {
|
|
ep->priv |= 0x80;
|
|
/*
|
|
* Hmm. Try to set the 'No Drive' flag.
|
|
* Maybe that will count as a 'disable'.
|
|
*/
|
|
}
|
|
if (ep->priv & 0xc6) {
|
|
ep->priv &= ~0x1;
|
|
} else {
|
|
ep->priv |= 0x1; /* no errors */
|
|
}
|
|
wrslot_stat(ssc, slp);
|
|
break;
|
|
case SESTYP_POWER:
|
|
/*
|
|
* Okay- the only one that makes sense here is to
|
|
* do the 'disable' for a power supply.
|
|
*/
|
|
if (obp->cstat[0] & SESCTL_DISABLE) {
|
|
(void) wrbuf16(ssc, SAFTE_WT_ACTPWS,
|
|
idx - cc->pwroff, 0, 0, slp);
|
|
}
|
|
break;
|
|
case SESTYP_FAN:
|
|
/*
|
|
* Okay- the only one that makes sense here is to
|
|
* set fan speed to zero on disable.
|
|
*/
|
|
if (obp->cstat[0] & SESCTL_DISABLE) {
|
|
/* remember- fans are the first items, so idx works */
|
|
(void) wrbuf16(ssc, SAFTE_WT_FANSPD, idx, 0, 0, slp);
|
|
}
|
|
break;
|
|
case SESTYP_DOORLOCK:
|
|
/*
|
|
* Well, we can 'disable' the lock.
|
|
*/
|
|
if (obp->cstat[0] & SESCTL_DISABLE) {
|
|
cc->flag2 &= ~SAFT_FLG2_LOCKDOOR;
|
|
(void) wrbuf16(ssc, SAFTE_WT_GLOBAL, cc->flag1,
|
|
cc->flag2, 0, slp);
|
|
}
|
|
break;
|
|
case SESTYP_ALARM:
|
|
/*
|
|
* Well, we can 'disable' the alarm.
|
|
*/
|
|
if (obp->cstat[0] & SESCTL_DISABLE) {
|
|
cc->flag2 &= ~SAFT_FLG1_ALARM;
|
|
ep->priv |= 0x40; /* Muted */
|
|
(void) wrbuf16(ssc, SAFTE_WT_GLOBAL, cc->flag1,
|
|
cc->flag2, 0, slp);
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
ep->svalid = 0;
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* This function handles all of the 16 byte WRITE BUFFER commands.
|
|
*/
|
|
static int
|
|
wrbuf16(ses_softc_t *ssc, uint8_t op, uint8_t b1, uint8_t b2,
|
|
uint8_t b3, int slp)
|
|
{
|
|
int err, amt;
|
|
char *sdata;
|
|
struct scfg *cc = ssc->ses_private;
|
|
static char cdb[10] = { WRITE_BUFFER, 1, 0, 0, 0, 0, 0, 0, 16, 0 };
|
|
|
|
if (cc == NULL)
|
|
return (0);
|
|
|
|
sdata = SES_MALLOC(16);
|
|
if (sdata == NULL)
|
|
return (ENOMEM);
|
|
|
|
SES_DLOG(ssc, "saf_wrbuf16 %x %x %x %x\n", op, b1, b2, b3);
|
|
|
|
sdata[0] = op;
|
|
sdata[1] = b1;
|
|
sdata[2] = b2;
|
|
sdata[3] = b3;
|
|
MEMZERO(&sdata[4], 12);
|
|
amt = -16;
|
|
err = ses_runcmd(ssc, cdb, 10, sdata, &amt);
|
|
SES_FREE(sdata, 16);
|
|
return (err);
|
|
}
|
|
|
|
/*
|
|
* This function updates the status byte for the device slot described.
|
|
*
|
|
* Since this is an optional SAF-TE command, there's no point in
|
|
* returning an error.
|
|
*/
|
|
static void
|
|
wrslot_stat(ses_softc_t *ssc, int slp)
|
|
{
|
|
int i, amt;
|
|
encobj *ep;
|
|
char cdb[10], *sdata;
|
|
struct scfg *cc = ssc->ses_private;
|
|
|
|
if (cc == NULL)
|
|
return;
|
|
|
|
SES_DLOG(ssc, "saf_wrslot\n");
|
|
cdb[0] = WRITE_BUFFER;
|
|
cdb[1] = 1;
|
|
cdb[2] = 0;
|
|
cdb[3] = 0;
|
|
cdb[4] = 0;
|
|
cdb[5] = 0;
|
|
cdb[6] = 0;
|
|
cdb[7] = 0;
|
|
cdb[8] = cc->Nslots * 3 + 1;
|
|
cdb[9] = 0;
|
|
|
|
sdata = SES_MALLOC(cc->Nslots * 3 + 1);
|
|
if (sdata == NULL)
|
|
return;
|
|
MEMZERO(sdata, cc->Nslots * 3 + 1);
|
|
|
|
sdata[0] = SAFTE_WT_DSTAT;
|
|
for (i = 0; i < cc->Nslots; i++) {
|
|
ep = &ssc->ses_objmap[cc->slotoff + i];
|
|
SES_DLOG(ssc, "saf_wrslot %d <- %x\n", i, ep->priv & 0xff);
|
|
sdata[1 + (3 * i)] = ep->priv & 0xff;
|
|
}
|
|
amt = -(cc->Nslots * 3 + 1);
|
|
(void) ses_runcmd(ssc, cdb, 10, sdata, &amt);
|
|
SES_FREE(sdata, cc->Nslots * 3 + 1);
|
|
}
|
|
|
|
/*
|
|
* This function issues the "PERFORM SLOT OPERATION" command.
|
|
*/
|
|
static int
|
|
perf_slotop(ses_softc_t *ssc, uint8_t slot, uint8_t opflag, int slp)
|
|
{
|
|
int err, amt;
|
|
char *sdata;
|
|
struct scfg *cc = ssc->ses_private;
|
|
static char cdb[10] =
|
|
{ WRITE_BUFFER, 1, 0, 0, 0, 0, 0, 0, SAFT_SCRATCH, 0 };
|
|
|
|
if (cc == NULL)
|
|
return (0);
|
|
|
|
sdata = SES_MALLOC(SAFT_SCRATCH);
|
|
if (sdata == NULL)
|
|
return (ENOMEM);
|
|
MEMZERO(sdata, SAFT_SCRATCH);
|
|
|
|
sdata[0] = SAFTE_WT_SLTOP;
|
|
sdata[1] = slot;
|
|
sdata[2] = opflag;
|
|
SES_DLOG(ssc, "saf_slotop slot %d op %x\n", slot, opflag);
|
|
amt = -SAFT_SCRATCH;
|
|
err = ses_runcmd(ssc, cdb, 10, sdata, &amt);
|
|
SES_FREE(sdata, SAFT_SCRATCH);
|
|
return (err);
|
|
}
|