sys/bus/cam/scsi/scsi_ses.c

   1 /* $FreeBSD: src/sys/cam/scsi/scsi_ses.c,v 1.8.2.2 2000/08/08 23:19:21 mjacob Exp $ */
   2 /* $DragonFly: src/sys/bus/cam/scsi/scsi_ses.c,v 1.29 2008/05/18 20:30:20 pavalos Exp $ */
   3 /*
   4  * Copyright (c) 2000 Matthew Jacob
   5  * All rights reserved.
   6  *
   7  * Redistribution and use in source and binary forms, with or without
   8  * modification, are permitted provided that the following conditions
   9  * are met:
  10  * 1. Redistributions of source code must retain the above copyright
  11  *    notice, this list of conditions, and the following disclaimer,
  12  *    without modification, immediately at the beginning of the file.
  13  * 2. The name of the author may not be used to endorse or promote products
  14  *    derived from this software without specific prior written permission.
  15  *
  16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  17  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  18  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  19  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
  20  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  21  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  22  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  23  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  24  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  25  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  26  * SUCH DAMAGE.
  27  *
  28  */
  29 #include <sys/param.h>
  30 #include <sys/queue.h>
  31 #include <sys/systm.h>
  32 #include <sys/kernel.h>
  33 #include <sys/types.h>
  34 #include <sys/malloc.h>
  35 #include <sys/fcntl.h>
  36 #include <sys/conf.h>
  37 #include <sys/buf.h>
  38 #include <sys/errno.h>
  39 #include <sys/devicestat.h>
  40 #include <sys/thread2.h>
  41 #include <machine/stdarg.h>
  42
  43 #include "../cam.h"
  44 #include "../cam_ccb.h"
  45 #include "../cam_extend.h"
  46 #include "../cam_periph.h"
  47 #include "../cam_xpt_periph.h"
  48 #include "../cam_debug.h"
  49 #include "../cam_sim.h"
  50
  51 #include "scsi_all.h"
  52 #include "scsi_message.h"
  53 #include "scsi_ses.h"
  54
  55 #include <opt_ses.h>
  56
  57 MALLOC_DEFINE(M_SCSISES, "SCSI SES", "SCSI SES buffers");
  58
  59 /*
  60  * Platform Independent Driver Internal Definitions for SES devices.
  61  */
  62 typedef enum {
  63         SES_NONE,
  64         SES_SES_SCSI2,
  65         SES_SES,
  66         SES_SES_PASSTHROUGH,
  67         SES_SEN,
  68         SES_SAFT
  69 } enctyp;
  70
  71 struct ses_softc;
  72 typedef struct ses_softc ses_softc_t;
  73 typedef struct {
  74         int (*softc_init)(ses_softc_t *, int);
  75         int (*init_enc)(ses_softc_t *);
  76         int (*get_encstat)(ses_softc_t *, int);
  77         int (*set_encstat)(ses_softc_t *, ses_encstat, int);
  78         int (*get_objstat)(ses_softc_t *, ses_objstat *, int);
  79         int (*set_objstat)(ses_softc_t *, ses_objstat *, int);
  80 } encvec;
  81
  82 #define ENCI_SVALID     0x80
  83
  84 typedef struct {
  85         uint32_t
  86                 enctype : 8,            /* enclosure type */
  87                 subenclosure : 8,       /* subenclosure id */
  88                 svalid  : 1,            /* enclosure information valid */
  89                 priv    : 15;           /* private data, per object */
  90         uint8_t encstat[4];     /* state && stats */
  91 } encobj;
  92
  93 #define SEN_ID          "UNISYS           SUN_SEN"
  94 #define SEN_ID_LEN      24
  95
  96
  97 static enctyp ses_type(void *, int);
  98
  99
 100 /* Forward reference to Enclosure Functions */
 101 static int ses_softc_init(ses_softc_t *, int);
 102 static int ses_init_enc(ses_softc_t *);
 103 static int ses_get_encstat(ses_softc_t *, int);
 104 static int ses_set_encstat(ses_softc_t *, uint8_t, int);
 105 static int ses_get_objstat(ses_softc_t *, ses_objstat *, int);
 106 static int ses_set_objstat(ses_softc_t *, ses_objstat *, int);
 107
 108 static int safte_softc_init(ses_softc_t *, int);
 109 static int safte_init_enc(ses_softc_t *);
 110 static int safte_get_encstat(ses_softc_t *, int);
 111 static int safte_set_encstat(ses_softc_t *, uint8_t, int);
 112 static int safte_get_objstat(ses_softc_t *, ses_objstat *, int);
 113 static int safte_set_objstat(ses_softc_t *, ses_objstat *, int);
 114
 115 /*
 116  * Platform implementation defines/functions for SES internal kernel stuff
 117  */
 118
 119 #define STRNCMP                 strncmp
 120 #define PRINTF                  kprintf
 121 #define SES_LOG                 ses_log
 122 #ifdef  DEBUG
 123 #define SES_DLOG                ses_log
 124 #else
 125 #define SES_DLOG                if (0) ses_log
 126 #endif
 127 #define SES_VLOG                if (bootverbose) ses_log
 128 #define SES_MALLOC(amt)         kmalloc(amt, M_SCSISES, M_INTWAIT)
 129 #define SES_FREE(ptr, amt)      kfree(ptr, M_SCSISES)
 130 #define MEMZERO                 bzero
 131 #define MEMCPY(dest, src, amt)  bcopy(src, dest, amt)
 132
 133 static int ses_runcmd(struct ses_softc *, char *, int, char *, int *);
 134 static void ses_log(struct ses_softc *, const char *, ...);
 135
 136 /*
 137  * Gerenal FreeBSD kernel stuff.
 138  */
 139
 140
 141 #define ccb_state       ppriv_field0
 142 #define ccb_bio         ppriv_ptr1
 143
 144 struct ses_softc {
 145         enctyp          ses_type;       /* type of enclosure */
 146         encvec          ses_vec;        /* vector to handlers */
 147         void *          ses_private;    /* per-type private data */
 148         encobj *        ses_objmap;     /* objects */
 149         u_int32_t       ses_nobjects;   /* number of objects */
 150         ses_encstat     ses_encstat;    /* overall status */
 151         u_int8_t        ses_flags;
 152         union ccb       ses_saved_ccb;
 153         struct cam_periph *periph;
 154 };
 155 #define SES_FLAG_INVALID        0x01
 156 #define SES_FLAG_OPEN           0x02
 157 #define SES_FLAG_INITIALIZED    0x04
 158
 159 #define SESUNIT(x)       (minor((x)))
 160 #define SES_CDEV_MAJOR  110
 161
 162 static  d_open_t        sesopen;
 163 static  d_close_t       sesclose;
 164 static  d_ioctl_t       sesioctl;
 165 static  periph_init_t   sesinit;
 166 static  periph_ctor_t   sesregister;
 167 static  periph_oninv_t  sesoninvalidate;
 168 static  periph_dtor_t   sescleanup;
 169 static  periph_start_t  sesstart;
 170
 171 static void sesasync(void *, u_int32_t, struct cam_path *, void *);
 172 static void sesdone(struct cam_periph *, union ccb *);
 173 static int seserror(union ccb *, u_int32_t, u_int32_t);
 174
 175 static struct periph_driver sesdriver = {
 176         sesinit, "ses",
 177         TAILQ_HEAD_INITIALIZER(sesdriver.units), /* generation */ 0
 178 };
 179
 180 PERIPHDRIVER_DECLARE(ses, sesdriver);
 181
 182 static struct dev_ops ses_ops = {
 183         { "ses", SES_CDEV_MAJOR, 0 },
 184         .d_open =       sesopen,
 185         .d_close =      sesclose,
 186         .d_ioctl =      sesioctl,
 187 };
 188 static struct extend_array *sesperiphs;
 189
 190 static void
 191 sesinit(void)
 192 {
 193         cam_status status;
 194
 195         /*
 196          * Create our extend array for storing the devices we attach to.
 197          */
 198         sesperiphs = cam_extend_new();
 199         if (sesperiphs == NULL) {
 200                 kprintf("ses: Failed to alloc extend array!\n");
 201                 return;
 202         }
 203
 204         /*
 205          * Install a global async callback.  This callback will
 206          * receive async callbacks like "new device found".
 207          */
 208         status = xpt_register_async(AC_FOUND_DEVICE, sesasync, NULL, NULL);
 209
 210         if (status != CAM_REQ_CMP) {
 211                 kprintf("ses: Failed to attach master async callback "
 212                        "due to status 0x%x!\n", status);
 213         }
 214 }
 215
 216 static void
 217 sesoninvalidate(struct cam_periph *periph)
 218 {
 219         struct ses_softc *softc;
 220
 221         softc = (struct ses_softc *)periph->softc;
 222
 223         /*
 224          * Unregister any async callbacks.
 225          */
 226         xpt_register_async(0, sesasync, periph, periph->path);
 227
 228         softc->ses_flags |= SES_FLAG_INVALID;
 229
 230         xpt_print(periph->path, "lost device\n");
 231 }
 232
 233 static void
 234 sescleanup(struct cam_periph *periph)
 235 {
 236         struct ses_softc *softc;
 237
 238         softc = (struct ses_softc *)periph->softc;
 239
 240         cam_extend_release(sesperiphs, periph->unit_number);
 241         xpt_print(periph->path, "removing device entry\n");
 242         dev_ops_remove(&ses_ops, -1, periph->unit_number);
 243         kfree(softc, M_SCSISES);
 244 }
 245
 246 static void
 247 sesasync(void *callback_arg, u_int32_t code, struct cam_path *path, void *arg)
 248 {
 249         struct cam_periph *periph;
 250
 251         periph = (struct cam_periph *)callback_arg;
 252
 253         switch(code) {
 254         case AC_FOUND_DEVICE:
 255         {
 256                 cam_status status;
 257                 struct ccb_getdev *cgd;
 258                 int inq_len;
 259
 260                 cgd = (struct ccb_getdev *)arg;
 261                 if (arg == NULL) {
 262                         break;
 263                 }
 264
 265                 inq_len = cgd->inq_data.additional_length + 4;
 266
 267                 /*
 268                  * PROBLEM: WE NEED TO LOOK AT BYTES 48-53 TO SEE IF THIS IS
 269                  * PROBLEM: IS A SAF-TE DEVICE.
 270                  */
 271                 switch (ses_type(&cgd->inq_data, inq_len)) {
 272                 case SES_SES:
 273                 case SES_SES_SCSI2:
 274                 case SES_SES_PASSTHROUGH:
 275                 case SES_SEN:
 276                 case SES_SAFT:
 277                         break;
 278                 default:
 279                         return;
 280                 }
 281
 282                 status = cam_periph_alloc(sesregister, sesoninvalidate,
 283                     sescleanup, sesstart, "ses", CAM_PERIPH_BIO,
 284                     cgd->ccb_h.path, sesasync, AC_FOUND_DEVICE, cgd);
 285
 286                 if (status != CAM_REQ_CMP && status != CAM_REQ_INPROG) {
 287                         kprintf("sesasync: Unable to probe new device due to "
 288                             "status 0x%x\n", status);
 289                 }
 290                 break;
 291         }
 292         default:
 293                 cam_periph_async(periph, code, path, arg);
 294                 break;
 295         }
 296 }
 297
 298 static cam_status
 299 sesregister(struct cam_periph *periph, void *arg)
 300 {
 301         struct ses_softc *softc;
 302         struct ccb_getdev *cgd;
 303         char *tname;
 304
 305         cgd = (struct ccb_getdev *)arg;
 306         if (periph == NULL) {
 307                 kprintf("sesregister: periph was NULL!!\n");
 308                 return (CAM_REQ_CMP_ERR);
 309         }
 310
 311         if (cgd == NULL) {
 312                 kprintf("sesregister: no getdev CCB, can't register device\n");
 313                 return (CAM_REQ_CMP_ERR);
 314         }
 315
 316         softc = kmalloc(sizeof (struct ses_softc), M_SCSISES, M_INTWAIT | M_ZERO);
 317         periph->softc = softc;
 318         softc->periph = periph;
 319
 320         softc->ses_type = ses_type(&cgd->inq_data, sizeof (cgd->inq_data));
 321
 322         switch (softc->ses_type) {
 323         case SES_SES:
 324         case SES_SES_SCSI2:
 325         case SES_SES_PASSTHROUGH:
 326                 softc->ses_vec.softc_init = ses_softc_init;
 327                 softc->ses_vec.init_enc = ses_init_enc;
 328                 softc->ses_vec.get_encstat = ses_get_encstat;
 329                 softc->ses_vec.set_encstat = ses_set_encstat;
 330                 softc->ses_vec.get_objstat = ses_get_objstat;
 331                 softc->ses_vec.set_objstat = ses_set_objstat;
 332                 break;
 333         case SES_SAFT:
 334                 softc->ses_vec.softc_init = safte_softc_init;
 335                 softc->ses_vec.init_enc = safte_init_enc;
 336                 softc->ses_vec.get_encstat = safte_get_encstat;
 337                 softc->ses_vec.set_encstat = safte_set_encstat;
 338                 softc->ses_vec.get_objstat = safte_get_objstat;
 339                 softc->ses_vec.set_objstat = safte_set_objstat;
 340                 break;
 341         case SES_SEN:
 342                 break;
 343         case SES_NONE:
 344         default:
 345                 kfree(softc, M_SCSISES);
 346                 return (CAM_REQ_CMP_ERR);
 347         }
 348
 349         cam_extend_set(sesperiphs, periph->unit_number, periph);
 350
 351         cam_periph_unlock(periph);
 352         dev_ops_add(&ses_ops, -1, periph->unit_number);
 353         make_dev(&ses_ops, periph->unit_number,
 354                     UID_ROOT, GID_OPERATOR, 0600, "%s%d",
 355                     periph->periph_name, periph->unit_number);
 356         cam_periph_lock(periph);
 357
 358         /*
 359          * Add an async callback so that we get
 360          * notified if this device goes away.
 361          */
 362         xpt_register_async(AC_LOST_DEVICE, sesasync, periph, periph->path);
 363
 364         switch (softc->ses_type) {
 365         default:
 366         case SES_NONE:
 367                 tname = "No SES device";
 368                 break;
 369         case SES_SES_SCSI2:
 370                 tname = "SCSI-2 SES Device";
 371                 break;
 372         case SES_SES:
 373                 tname = "SCSI-3 SES Device";
 374                 break;
 375         case SES_SES_PASSTHROUGH:
 376                 tname = "SES Passthrough Device";
 377                 break;
 378         case SES_SEN:
 379                 tname = "UNISYS SEN Device (NOT HANDLED YET)";
 380                 break;
 381         case SES_SAFT:
 382                 tname = "SAF-TE Compliant Device";
 383                 break;
 384         }
 385         xpt_announce_periph(periph, tname);
 386         return (CAM_REQ_CMP);
 387 }
 388
 389 static int
 390 sesopen(struct dev_open_args *ap)
 391 {
 392         cdev_t dev = ap->a_head.a_dev;
 393         struct cam_periph *periph;
 394         struct ses_softc *softc;
 395         int error = 0;
 396
 397         periph = cam_extend_get(sesperiphs, SESUNIT(dev));
 398         if (periph == NULL) {
 399                 return (ENXIO);
 400         }
 401
 402         if (cam_periph_acquire(periph) != CAM_REQ_CMP) {
 403                 cam_periph_unlock(periph);
 404                 return (ENXIO);
 405         }
 406
 407         cam_periph_lock(periph);
 408
 409         softc = (struct ses_softc *)periph->softc;
 410
 411         if (softc->ses_flags & SES_FLAG_INVALID) {
 412                 error = ENXIO;
 413                 goto out;
 414         }
 415         if (softc->ses_flags & SES_FLAG_OPEN) {
 416                 error = EBUSY;
 417                 goto out;
 418         }
 419         if (softc->ses_vec.softc_init == NULL) {
 420                 error = ENXIO;
 421                 goto out;
 422         }
 423
 424         softc->ses_flags |= SES_FLAG_OPEN;
 425         if ((softc->ses_flags & SES_FLAG_INITIALIZED) == 0) {
 426                 error = (*softc->ses_vec.softc_init)(softc, 1);
 427                 if (error)
 428                         softc->ses_flags &= ~SES_FLAG_OPEN;
 429                 else
 430                         softc->ses_flags |= SES_FLAG_INITIALIZED;
 431         }
 432
 433 out:
 434         cam_periph_unlock(periph);
 435         if (error) {
 436                 cam_periph_release(periph);
 437         }
 438         return (error);
 439 }
 440
 441 static int
 442 sesclose(struct dev_close_args *ap)
 443 {
 444         cdev_t dev = ap->a_head.a_dev;
 445         struct cam_periph *periph;
 446         struct ses_softc *softc;
 447         int unit, error;
 448
 449         error = 0;
 450
 451         unit = SESUNIT(dev);
 452         periph = cam_extend_get(sesperiphs, unit);
 453         if (periph == NULL)
 454                 return (ENXIO);
 455
 456         cam_periph_lock(periph);
 457
 458         softc = (struct ses_softc *)periph->softc;
 459         softc->ses_flags &= ~SES_FLAG_OPEN;
 460
 461         cam_periph_unlock(periph);
 462         cam_periph_release(periph);
 463
 464         return (0);
 465 }
 466
 467 static void
 468 sesstart(struct cam_periph *p, union ccb *sccb)
 469 {
 470         if (p->immediate_priority <= p->pinfo.priority) {
 471                 SLIST_INSERT_HEAD(&p->ccb_list, &sccb->ccb_h, periph_links.sle);
 472                 p->immediate_priority = CAM_PRIORITY_NONE;
 473                 wakeup(&p->ccb_list);
 474         }
 475 }
 476
 477 static void
 478 sesdone(struct cam_periph *periph, union ccb *dccb)
 479 {
 480         wakeup(&dccb->ccb_h.cbfcnp);
 481 }
 482
 483 static int
 484 seserror(union ccb *ccb, u_int32_t cflags, u_int32_t sflags)
 485 {
 486         struct ses_softc *softc;
 487         struct cam_periph *periph;
 488
 489         periph = xpt_path_periph(ccb->ccb_h.path);
 490         softc = (struct ses_softc *)periph->softc;
 491
 492         return (cam_periph_error(ccb, cflags, sflags, &softc->ses_saved_ccb));
 493 }
 494
 495 static int
 496 sesioctl(struct dev_ioctl_args *ap)
 497 {
 498         cdev_t dev = ap->a_head.a_dev;
 499         struct cam_periph *periph;
 500         ses_encstat tmp;
 501         ses_objstat objs;
 502         ses_object obj, *uobj;
 503         struct ses_softc *ssc;
 504         void *addr;
 505         int error, i;
 506
 507
 508         if (ap->a_data)
 509                 addr = *((caddr_t *)ap->a_data);
 510         else
 511                 addr = NULL;
 512
 513         periph = cam_extend_get(sesperiphs, SESUNIT(dev));
 514         if (periph == NULL)
 515                 return (ENXIO);
 516
 517         CAM_DEBUG(periph->path, CAM_DEBUG_TRACE, ("entering sesioctl\n"));
 518
 519         cam_periph_lock(periph);
 520         ssc = (struct ses_softc *)periph->softc;
 521
 522         /*
 523          * Now check to see whether we're initialized or not.
 524          */
 525         if ((ssc->ses_flags & SES_FLAG_INITIALIZED) == 0) {
 526                 cam_periph_unlock(periph);
 527                 return (ENXIO);
 528         }
 529         cam_periph_unlock(periph);
 530
 531         error = 0;
 532
 533         CAM_DEBUG(periph->path, CAM_DEBUG_TRACE,
 534             ("trying to do ioctl %#lx\n", ap->a_cmd));
 535
 536         /*
 537          * If this command can change the device's state,
 538          * we must have the device open for writing.
 539          */
 540         switch (ap->a_cmd) {
 541         case SESIOC_GETNOBJ:
 542         case SESIOC_GETOBJMAP:
 543         case SESIOC_GETENCSTAT:
 544         case SESIOC_GETOBJSTAT:
 545                 break;
 546         default:
 547                 if ((ap->a_fflag & FWRITE) == 0) {
 548                         return (EBADF);
 549                 }
 550         }
 551
 552         switch (ap->a_cmd) {
 553         case SESIOC_GETNOBJ:
 554                 error = copyout(&ssc->ses_nobjects, addr,
 555                     sizeof (ssc->ses_nobjects));
 556                 break;
 557
 558         case SESIOC_GETOBJMAP:
 559                 /*
 560                  * XXX Dropping the lock while copying multiple segments is
 561                  * bogus.
 562                  */
 563                 cam_periph_lock(periph);
 564                 for (uobj = addr, i = 0; i != ssc->ses_nobjects; i++, uobj++) {
 565                         obj.obj_id = i;
 566                         obj.subencid = ssc->ses_objmap[i].subenclosure;
 567                         obj.object_type = ssc->ses_objmap[i].enctype;
 568                         cam_periph_unlock(periph);
 569                         error = copyout(&obj, uobj, sizeof (ses_object));
 570                         cam_periph_lock(periph);
 571                         if (error) {
 572                                 break;
 573                         }
 574                 }
 575                 cam_periph_unlock(periph);
 576                 break;
 577
 578         case SESIOC_GETENCSTAT:
 579                 cam_periph_lock(periph);
 580                 error = (*ssc->ses_vec.get_encstat)(ssc, 1);
 581                 if (error) {
 582                         cam_periph_unlock(periph);
 583                         break;
 584                 }
 585                 tmp = ssc->ses_encstat & ~ENCI_SVALID;
 586                 cam_periph_unlock(periph);
 587                 error = copyout(&tmp, addr, sizeof (ses_encstat));
 588                 ssc->ses_encstat = tmp;
 589                 break;
 590
 591         case SESIOC_SETENCSTAT:
 592                 error = copyin(addr, &tmp, sizeof (ses_encstat));
 593                 if (error)
 594                         break;
 595                 cam_periph_lock(periph);
 596                 error = (*ssc->ses_vec.set_encstat)(ssc, tmp, 1);
 597                 cam_periph_unlock(periph);
 598                 break;
 599
 600         case SESIOC_GETOBJSTAT:
 601                 error = copyin(addr, &objs, sizeof (ses_objstat));
 602                 if (error)
 603                         break;
 604                 if (objs.obj_id >= ssc->ses_nobjects) {
 605                         error = EINVAL;
 606                         break;
 607                 }
 608                 cam_periph_lock(periph);
 609                 error = (*ssc->ses_vec.get_objstat)(ssc, &objs, 1);
 610                 cam_periph_unlock(periph);
 611                 if (error)
 612                         break;
 613                 error = copyout(&objs, addr, sizeof (ses_objstat));
 614                 /*
 615                  * Always (for now) invalidate entry.
 616                  */
 617                 ssc->ses_objmap[objs.obj_id].svalid = 0;
 618                 break;
 619
 620         case SESIOC_SETOBJSTAT:
 621                 error = copyin(addr, &objs, sizeof (ses_objstat));
 622                 if (error)
 623                         break;
 624
 625                 if (objs.obj_id >= ssc->ses_nobjects) {
 626                         error = EINVAL;
 627                         break;
 628                 }
 629                 cam_periph_lock(periph);
 630                 error = (*ssc->ses_vec.set_objstat)(ssc, &objs, 1);
 631                 cam_periph_unlock(periph);
 632
 633                 /*
 634                  * Always (for now) invalidate entry.
 635                  */
 636                 ssc->ses_objmap[objs.obj_id].svalid = 0;
 637                 break;
 638
 639         case SESIOC_INIT:
 640
 641                 cam_periph_lock(periph);
 642                 error = (*ssc->ses_vec.init_enc)(ssc);
 643                 cam_periph_unlock(periph);
 644                 break;
 645
 646         default:
 647                 cam_periph_lock(periph);
 648                 error = cam_periph_ioctl(periph, ap->a_cmd, ap->a_data, seserror);
 649                 cam_periph_unlock(periph);
 650                 break;
 651         }
 652         return (error);
 653 }
 654
 655 #define SES_CFLAGS      CAM_RETRY_SELTO
 656 #define SES_FLAGS       SF_NO_PRINT | SF_RETRY_UA
 657 static int
 658 ses_runcmd(struct ses_softc *ssc, char *cdb, int cdbl, char *dptr, int *dlenp)
 659 {
 660         int error, dlen;
 661         ccb_flags ddf;
 662         union ccb *ccb;
 663
 664         if (dptr) {
 665                 if ((dlen = *dlenp) < 0) {
 666                         dlen = -dlen;
 667                         ddf = CAM_DIR_OUT;
 668                 } else {
 669                         ddf = CAM_DIR_IN;
 670                 }
 671         } else {
 672                 dlen = 0;
 673                 ddf = CAM_DIR_NONE;
 674         }
 675
 676         if (cdbl > IOCDBLEN) {
 677                 cdbl = IOCDBLEN;
 678         }
 679
 680         ccb = cam_periph_getccb(ssc->periph, 1);
 681         cam_fill_csio(&ccb->csio, 0, sesdone, ddf, MSG_SIMPLE_Q_TAG, dptr,
 682             dlen, sizeof (struct scsi_sense_data), cdbl, 60 * 1000);
 683         bcopy(cdb, ccb->csio.cdb_io.cdb_bytes, cdbl);
 684
 685         error = cam_periph_runccb(ccb, seserror, SES_CFLAGS, SES_FLAGS, NULL);
 686         if ((ccb->ccb_h.status & CAM_DEV_QFRZN) != 0)
 687                 cam_release_devq(ccb->ccb_h.path, 0, 0, 0, FALSE);
 688         if (error) {
 689                 if (dptr) {
 690                         *dlenp = dlen;
 691                 }
 692         } else {
 693                 if (dptr) {
 694                         *dlenp = ccb->csio.resid;
 695                 }
 696         }
 697         xpt_release_ccb(ccb);
 698         return (error);
 699 }
 700
 701 static void
 702 ses_log(struct ses_softc *ssc, const char *fmt, ...)
 703 {
 704         __va_list ap;
 705
 706         kprintf("%s%d: ", ssc->periph->periph_name, ssc->periph->unit_number);
 707         __va_start(ap, fmt);
 708         kvprintf(fmt, ap);
 709         __va_end(ap);
 710 }
 711
 712 /*
 713  * The code after this point runs on many platforms,
 714  * so forgive the slightly awkward and nonconforming
 715  * appearance.
 716  */
 717
 718 /*
 719  * Is this a device that supports enclosure services?
 720  *
 721  * It's a a pretty simple ruleset- if it is device type 0x0D (13), it's
 722  * an SES device. If it happens to be an old UNISYS SEN device, we can
 723  * handle that too.
 724  */
 725
 726 #define SAFTE_START     44
 727 #define SAFTE_END       50
 728 #define SAFTE_LEN       SAFTE_END-SAFTE_START
 729
 730 static enctyp
 731 ses_type(void *buf, int buflen)
 732 {
 733         unsigned char *iqd = buf;
 734
 735         if (buflen < 8+SEN_ID_LEN)
 736                 return (SES_NONE);
 737
 738         if ((iqd[0] & 0x1f) == T_ENCLOSURE) {
 739                 if (STRNCMP(&iqd[8], SEN_ID, SEN_ID_LEN) == 0) {
 740                         return (SES_SEN);
 741                 } else if ((iqd[2] & 0x7) > 2) {
 742                         return (SES_SES);
 743                 } else {
 744                         return (SES_SES_SCSI2);
 745                 }
 746                 return (SES_NONE);
 747         }
 748
 749 #ifdef  SES_ENABLE_PASSTHROUGH
 750         if ((iqd[6] & 0x40) && (iqd[2] & 0x7) >= 2) {
 751                 /*
 752                  * PassThrough Device.
 753                  */
 754                 return (SES_SES_PASSTHROUGH);
 755         }
 756 #endif
 757
 758         /*
 759          * The comparison is short for a reason-
 760          * some vendors were chopping it short.
 761          */
 762
 763         if (buflen < SAFTE_END - 2) {
 764                 return (SES_NONE);
 765         }
 766
 767         if (STRNCMP((char *)&iqd[SAFTE_START], "SAF-TE", SAFTE_LEN - 2) == 0) {
 768                 return (SES_SAFT);
 769         }
 770         return (SES_NONE);
 771 }
 772
 773 /*
 774  * SES Native Type Device Support
 775  */
 776
 777 /*
 778  * SES Diagnostic Page Codes
 779  */
 780
 781 typedef enum {
 782         SesConfigPage = 0x1,
 783         SesControlPage,
 784 #define SesStatusPage SesControlPage
 785         SesHelpTxt,
 786         SesStringOut,
 787 #define SesStringIn     SesStringOut
 788         SesThresholdOut,
 789 #define SesThresholdIn SesThresholdOut
 790         SesArrayControl,
 791 #define SesArrayStatus  SesArrayControl
 792         SesElementDescriptor,
 793         SesShortStatus
 794 } SesDiagPageCodes;
 795
 796 /*
 797  * minimal amounts
 798  */
 799
 800 /*
 801  * Minimum amount of data, starting from byte 0, to have
 802  * the config header.
 803  */
 804 #define SES_CFGHDR_MINLEN       12
 805
 806 /*
 807  * Minimum amount of data, starting from byte 0, to have
 808  * the config header and one enclosure header.
 809  */
 810 #define SES_ENCHDR_MINLEN       48
 811
 812 /*
 813  * Take this value, subtract it from VEnclen and you know
 814  * the length of the vendor unique bytes.
 815  */
 816 #define SES_ENCHDR_VMIN         36
 817
 818 /*
 819  * SES Data Structures
 820  */
 821
 822 typedef struct {
 823         uint32_t GenCode;       /* Generation Code */
 824         uint8_t Nsubenc;        /* Number of Subenclosures */
 825 } SesCfgHdr;
 826
 827 typedef struct {
 828         uint8_t Subencid;       /* SubEnclosure Identifier */
 829         uint8_t Ntypes;         /* # of supported types */
 830         uint8_t VEnclen;        /* Enclosure Descriptor Length */
 831 } SesEncHdr;
 832
 833 typedef struct {
 834         uint8_t encWWN[8];      /* XXX- Not Right Yet */
 835         uint8_t encVid[8];
 836         uint8_t encPid[16];
 837         uint8_t encRev[4];
 838         uint8_t encVen[1];
 839 } SesEncDesc;
 840
 841 typedef struct {
 842         uint8_t enc_type;               /* type of element */
 843         uint8_t enc_maxelt;             /* maximum supported */
 844         uint8_t enc_subenc;             /* in SubEnc # N */
 845         uint8_t enc_tlen;               /* Type Descriptor Text Length */
 846 } SesThdr;
 847
 848 typedef struct {
 849         uint8_t comstatus;
 850         uint8_t comstat[3];
 851 } SesComStat;
 852
 853 struct typidx {
 854         int ses_tidx;
 855         int ses_oidx;
 856 };
 857
 858 struct sscfg {
 859         uint8_t ses_ntypes;     /* total number of types supported */
 860
 861         /*
 862          * We need to keep a type index as well as an
 863          * object index for each object in an enclosure.
 864          */
 865         struct typidx *ses_typidx;
 866
 867         /*
 868          * We also need to keep track of the number of elements
 869          * per type of element. This is needed later so that we
 870          * can find precisely in the returned status data the
 871          * status for the Nth element of the Kth type.
 872          */
 873         uint8_t *       ses_eltmap;
 874 };
 875
 876
 877 /*
 878  * (de)canonicalization defines
 879  */
 880 #define sbyte(x, byte)          ((((uint32_t)(x)) >> (byte * 8)) & 0xff)
 881 #define sbit(x, bit)            (((uint32_t)(x)) << bit)
 882 #define sset8(outp, idx, sval)  (((uint8_t *)(outp))[idx++]) = sbyte(sval, 0)
 883
 884 #define sset16(outp, idx, sval) \
 885         (((uint8_t *)(outp))[idx++]) = sbyte(sval, 1), \
 886         (((uint8_t *)(outp))[idx++]) = sbyte(sval, 0)
 887
 888
 889 #define sset24(outp, idx, sval) \
 890         (((uint8_t *)(outp))[idx++]) = sbyte(sval, 2), \
 891         (((uint8_t *)(outp))[idx++]) = sbyte(sval, 1), \
 892         (((uint8_t *)(outp))[idx++]) = sbyte(sval, 0)
 893
 894
 895 #define sset32(outp, idx, sval) \
 896         (((uint8_t *)(outp))[idx++]) = sbyte(sval, 3), \
 897         (((uint8_t *)(outp))[idx++]) = sbyte(sval, 2), \
 898         (((uint8_t *)(outp))[idx++]) = sbyte(sval, 1), \
 899         (((uint8_t *)(outp))[idx++]) = sbyte(sval, 0)
 900
 901 #define gbyte(x, byte)  ((((uint32_t)(x)) & 0xff) << (byte * 8))
 902 #define gbit(lv, in, idx, shft, mask)   lv = ((in[idx] >> shft) & mask)
 903 #define sget8(inp, idx, lval)   lval = (((uint8_t *)(inp))[idx++])
 904 #define gget8(inp, idx, lval)   lval = (((uint8_t *)(inp))[idx])
 905
 906 #define sget16(inp, idx, lval)  \
 907         lval = gbyte((((uint8_t *)(inp))[idx]), 1) | \
 908                 (((uint8_t *)(inp))[idx+1]), idx += 2
 909
 910 #define gget16(inp, idx, lval)  \
 911         lval = gbyte((((uint8_t *)(inp))[idx]), 1) | \
 912                 (((uint8_t *)(inp))[idx+1])
 913
 914 #define sget24(inp, idx, lval)  \
 915         lval = gbyte((((uint8_t *)(inp))[idx]), 2) | \
 916                 gbyte((((uint8_t *)(inp))[idx+1]), 1) | \
 917                         (((uint8_t *)(inp))[idx+2]), idx += 3
 918
 919 #define gget24(inp, idx, lval)  \
 920         lval = gbyte((((uint8_t *)(inp))[idx]), 2) | \
 921                 gbyte((((uint8_t *)(inp))[idx+1]), 1) | \
 922                         (((uint8_t *)(inp))[idx+2])
 923
 924 #define sget32(inp, idx, lval)  \
 925         lval = gbyte((((uint8_t *)(inp))[idx]), 3) | \
 926                 gbyte((((uint8_t *)(inp))[idx+1]), 2) | \
 927                 gbyte((((uint8_t *)(inp))[idx+2]), 1) | \
 928                         (((uint8_t *)(inp))[idx+3]), idx += 4
 929
 930 #define gget32(inp, idx, lval)  \
 931         lval = gbyte((((uint8_t *)(inp))[idx]), 3) | \
 932                 gbyte((((uint8_t *)(inp))[idx+1]), 2) | \
 933                 gbyte((((uint8_t *)(inp))[idx+2]), 1) | \
 934                         (((uint8_t *)(inp))[idx+3])
 935
 936 #define SCSZ    0x2000
 937 #define CFLEN   (256 + SES_ENCHDR_MINLEN)
 938
 939 /*
 940  * Routines specific && private to SES only
 941  */
 942
 943 static int ses_getconfig(ses_softc_t *);
 944 static int ses_getputstat(ses_softc_t *, int, SesComStat *, int, int);
 945 static int ses_cfghdr(uint8_t *, int, SesCfgHdr *);
 946 static int ses_enchdr(uint8_t *, int, uint8_t, SesEncHdr *);
 947 static int ses_encdesc(uint8_t *, int, uint8_t, SesEncDesc *);
 948 static int ses_getthdr(uint8_t *, int,  int, SesThdr *);
 949 static int ses_decode(char *, int, uint8_t *, int, int, SesComStat *);
 950 static int ses_encode(char *, int, uint8_t *, int, int, SesComStat *);
 951
 952 static int
 953 ses_softc_init(ses_softc_t *ssc, int doinit)
 954 {
 955         if (doinit == 0) {
 956                 struct sscfg *cc;
 957                 if (ssc->ses_nobjects) {
 958                         SES_FREE(ssc->ses_objmap,
 959                             ssc->ses_nobjects * sizeof (encobj));
 960                         ssc->ses_objmap = NULL;
 961                 }
 962                 if ((cc = ssc->ses_private) != NULL) {
 963                         if (cc->ses_eltmap && cc->ses_ntypes) {
 964                                 SES_FREE(cc->ses_eltmap, cc->ses_ntypes);
 965                                 cc->ses_eltmap = NULL;
 966                                 cc->ses_ntypes = 0;
 967                         }
 968                         if (cc->ses_typidx && ssc->ses_nobjects) {
 969                                 SES_FREE(cc->ses_typidx,
 970                                     ssc->ses_nobjects * sizeof (struct typidx));
 971                                 cc->ses_typidx = NULL;
 972                         }
 973                         SES_FREE(cc, sizeof (struct sscfg));
 974                         ssc->ses_private = NULL;
 975                 }
 976                 ssc->ses_nobjects = 0;
 977                 return (0);
 978         }
 979         if (ssc->ses_private == NULL) {
 980                 ssc->ses_private = SES_MALLOC(sizeof (struct sscfg));
 981         }
 982         if (ssc->ses_private == NULL) {
 983                 return (ENOMEM);
 984         }
 985         ssc->ses_nobjects = 0;
 986         ssc->ses_encstat = 0;
 987         return (ses_getconfig(ssc));
 988 }
 989
 990 static int
 991 ses_init_enc(ses_softc_t *ssc)
 992 {
 993         return (0);
 994 }
 995
 996 static int
 997 ses_get_encstat(ses_softc_t *ssc, int slpflag)
 998 {
 999         SesComStat ComStat;
1000         int status;
1001
1002         if ((status = ses_getputstat(ssc, -1, &ComStat, slpflag, 1)) != 0) {
1003                 return (status);
1004         }
1005         ssc->ses_encstat = ComStat.comstatus | ENCI_SVALID;
1006         return (0);
1007 }
1008
1009 static int
1010 ses_set_encstat(ses_softc_t *ssc, uint8_t encstat, int slpflag)
1011 {
1012         SesComStat ComStat;
1013         int status;
1014
1015         ComStat.comstatus = encstat & 0xf;
1016         if ((status = ses_getputstat(ssc, -1, &ComStat, slpflag, 0)) != 0) {
1017                 return (status);
1018         }
1019         ssc->ses_encstat = encstat & 0xf;       /* note no SVALID set */
1020         return (0);
1021 }
1022
1023 static int
1024 ses_get_objstat(ses_softc_t *ssc, ses_objstat *obp, int slpflag)
1025 {
1026         int i = (int)obp->obj_id;
1027
1028         if (ssc->ses_objmap[i].svalid == 0) {
1029                 SesComStat ComStat;
1030                 int err = ses_getputstat(ssc, i, &ComStat, slpflag, 1);
1031                 if (err)
1032                         return (err);
1033                 ssc->ses_objmap[i].encstat[0] = ComStat.comstatus;
1034                 ssc->ses_objmap[i].encstat[1] = ComStat.comstat[0];
1035                 ssc->ses_objmap[i].encstat[2] = ComStat.comstat[1];
1036                 ssc->ses_objmap[i].encstat[3] = ComStat.comstat[2];
1037                 ssc->ses_objmap[i].svalid = 1;
1038         }
1039         obp->cstat[0] = ssc->ses_objmap[i].encstat[0];
1040         obp->cstat[1] = ssc->ses_objmap[i].encstat[1];
1041         obp->cstat[2] = ssc->ses_objmap[i].encstat[2];
1042         obp->cstat[3] = ssc->ses_objmap[i].encstat[3];
1043         return (0);
1044 }
1045
1046 static int
1047 ses_set_objstat(ses_softc_t *ssc, ses_objstat *obp, int slpflag)
1048 {
1049         SesComStat ComStat;
1050         int err;
1051         /*
1052          * If this is clear, we don't do diddly.
1053          */
1054         if ((obp->cstat[0] & SESCTL_CSEL) == 0) {
1055                 return (0);
1056         }
1057         ComStat.comstatus = obp->cstat[0];
1058         ComStat.comstat[0] = obp->cstat[1];
1059         ComStat.comstat[1] = obp->cstat[2];
1060         ComStat.comstat[2] = obp->cstat[3];
1061         err = ses_getputstat(ssc, (int)obp->obj_id, &ComStat, slpflag, 0);
1062         ssc->ses_objmap[(int)obp->obj_id].svalid = 0;
1063         return (err);
1064 }
1065
1066 static int
1067 ses_getconfig(ses_softc_t *ssc)
1068 {
1069         struct sscfg *cc;
1070         SesCfgHdr cf;
1071         SesEncHdr hd;
1072         SesEncDesc *cdp;
1073         SesThdr thdr;
1074         int err, amt, i, nobj, ntype, maxima;
1075         char storage[CFLEN], *sdata;
1076         static char cdb[6] = {
1077             RECEIVE_DIAGNOSTIC, 0x1, SesConfigPage, SCSZ >> 8, SCSZ & 0xff, 0
1078         };
1079
1080         cc = ssc->ses_private;
1081         if (cc == NULL) {
1082                 return (ENXIO);
1083         }
1084
1085         sdata = SES_MALLOC(SCSZ);
1086         if (sdata == NULL)
1087                 return (ENOMEM);
1088
1089         amt = SCSZ;
1090         err = ses_runcmd(ssc, cdb, 6, sdata, &amt);
1091         if (err) {
1092                 SES_FREE(sdata, SCSZ);
1093                 return (err);
1094         }
1095         amt = SCSZ - amt;
1096
1097         if (ses_cfghdr((uint8_t *) sdata, amt, &cf)) {
1098                 SES_LOG(ssc, "Unable to parse SES Config Header\n");
1099                 SES_FREE(sdata, SCSZ);
1100                 return (EIO);
1101         }
1102         if (amt < SES_ENCHDR_MINLEN) {
1103                 SES_LOG(ssc, "runt enclosure length (%d)\n", amt);
1104                 SES_FREE(sdata, SCSZ);
1105                 return (EIO);
1106         }
1107
1108         SES_VLOG(ssc, "GenCode %x %d Subenclosures\n", cf.GenCode, cf.Nsubenc);
1109
1110         /*
1111          * Now waltz through all the subenclosures toting up the
1112          * number of types available in each. For this, we only
1113          * really need the enclosure header. However, we get the
1114          * enclosure descriptor for debug purposes, as well
1115          * as self-consistency checking purposes.
1116          */
1117
1118         maxima = cf.Nsubenc + 1;
1119         cdp = (SesEncDesc *) storage;
1120         for (ntype = i = 0; i < maxima; i++) {
1121                 MEMZERO((caddr_t)cdp, sizeof (*cdp));
1122                 if (ses_enchdr((uint8_t *) sdata, amt, i, &hd)) {
1123                         SES_LOG(ssc, "Cannot Extract Enclosure Header %d\n", i);
1124                         SES_FREE(sdata, SCSZ);
1125                         return (EIO);
1126                 }
1127                 SES_VLOG(ssc, " SubEnclosure ID %d, %d Types With this ID, En"
1128                     "closure Length %d\n", hd.Subencid, hd.Ntypes, hd.VEnclen);
1129
1130                 if (ses_encdesc((uint8_t *)sdata, amt, i, cdp)) {
1131                         SES_LOG(ssc, "Can't get Enclosure Descriptor %d\n", i);
1132                         SES_FREE(sdata, SCSZ);
1133                         return (EIO);
1134                 }
1135                 SES_VLOG(ssc, " WWN: %02x%02x%02x%02x%02x%02x%02x%02x\n",
1136                     cdp->encWWN[0], cdp->encWWN[1], cdp->encWWN[2],
1137                     cdp->encWWN[3], cdp->encWWN[4], cdp->encWWN[5],
1138                     cdp->encWWN[6], cdp->encWWN[7]);
1139                 ntype += hd.Ntypes;
1140         }
1141
1142         /*
1143          * Now waltz through all the types that are available, getting
1144          * the type header so we can start adding up the number of
1145          * objects available.
1146          */
1147         for (nobj = i = 0; i < ntype; i++) {
1148                 if (ses_getthdr((uint8_t *)sdata, amt, i, &thdr)) {
1149                         SES_LOG(ssc, "Can't get Enclosure Type Header %d\n", i);
1150                         SES_FREE(sdata, SCSZ);
1151                         return (EIO);
1152                 }
1153                 SES_LOG(ssc, " Type Desc[%d]: Type 0x%x, MaxElt %d, In Subenc "
1154                     "%d, Text Length %d\n", i, thdr.enc_type, thdr.enc_maxelt,
1155                     thdr.enc_subenc, thdr.enc_tlen);
1156                 nobj += thdr.enc_maxelt;
1157         }
1158
1159
1160         /*
1161          * Now allocate the object array and type map.
1162          */
1163
1164         ssc->ses_objmap = SES_MALLOC(nobj * sizeof (encobj));
1165         cc->ses_typidx = SES_MALLOC(nobj * sizeof (struct typidx));
1166         cc->ses_eltmap = SES_MALLOC(ntype);
1167
1168         if (ssc->ses_objmap == NULL || cc->ses_typidx == NULL ||
1169             cc->ses_eltmap == NULL) {
1170                 if (ssc->ses_objmap) {
1171                         SES_FREE(ssc->ses_objmap, (nobj * sizeof (encobj)));
1172                         ssc->ses_objmap = NULL;
1173                 }
1174                 if (cc->ses_typidx) {
1175                         SES_FREE(cc->ses_typidx,
1176                             (nobj * sizeof (struct typidx)));
1177                         cc->ses_typidx = NULL;
1178                 }
1179                 if (cc->ses_eltmap) {
1180                         SES_FREE(cc->ses_eltmap, ntype);
1181                         cc->ses_eltmap = NULL;
1182                 }
1183                 SES_FREE(sdata, SCSZ);
1184                 return (ENOMEM);
1185         }
1186         MEMZERO(ssc->ses_objmap, nobj * sizeof (encobj));
1187         MEMZERO(cc->ses_typidx, nobj * sizeof (struct typidx));
1188         MEMZERO(cc->ses_eltmap, ntype);
1189         cc->ses_ntypes = (uint8_t) ntype;
1190         ssc->ses_nobjects = nobj;
1191
1192         /*
1193          * Now waltz through the # of types again to fill in the types
1194          * (and subenclosure ids) of the allocated objects.
1195          */
1196         nobj = 0;
1197         for (i = 0; i < ntype; i++) {
1198                 int j;
1199                 if (ses_getthdr((uint8_t *)sdata, amt, i, &thdr)) {
1200                         continue;
1201                 }
1202                 cc->ses_eltmap[i] = thdr.enc_maxelt;
1203                 for (j = 0; j < thdr.enc_maxelt; j++) {
1204                         cc->ses_typidx[nobj].ses_tidx = i;
1205                         cc->ses_typidx[nobj].ses_oidx = j;
1206                         ssc->ses_objmap[nobj].subenclosure = thdr.enc_subenc;
1207                         ssc->ses_objmap[nobj++].enctype = thdr.enc_type;
1208                 }
1209         }
1210         SES_FREE(sdata, SCSZ);
1211         return (0);
1212 }
1213
1214 static int
1215 ses_getputstat(ses_softc_t *ssc, int objid, SesComStat *sp, int slp, int in)
1216 {
1217         struct sscfg *cc;
1218         int err, amt, bufsiz, tidx, oidx;
1219         char cdb[6], *sdata;
1220
1221         cc = ssc->ses_private;
1222         if (cc == NULL) {
1223                 return (ENXIO);
1224         }
1225
1226         /*
1227          * If we're just getting overall enclosure status,
1228          * we only need 2 bytes of data storage.
1229          *
1230          * If we're getting anything else, we know how much
1231          * storage we need by noting that starting at offset
1232          * 8 in returned data, all object status bytes are 4
1233          * bytes long, and are stored in chunks of types(M)
1234          * and nth+1 instances of type M.
1235          */
1236         if (objid == -1) {
1237                 bufsiz = 2;
1238         } else {
1239                 bufsiz = (ssc->ses_nobjects * 4) + (cc->ses_ntypes * 4) + 8;
1240         }
1241         sdata = SES_MALLOC(bufsiz);
1242         if (sdata == NULL)
1243                 return (ENOMEM);
1244
1245         cdb[0] = RECEIVE_DIAGNOSTIC;
1246         cdb[1] = 1;
1247         cdb[2] = SesStatusPage;
1248         cdb[3] = bufsiz >> 8;
1249         cdb[4] = bufsiz & 0xff;
1250         cdb[5] = 0;
1251         amt = bufsiz;
1252         err = ses_runcmd(ssc, cdb, 6, sdata, &amt);
1253         if (err) {
1254                 SES_FREE(sdata, bufsiz);
1255                 return (err);
1256         }
1257         amt = bufsiz - amt;
1258
1259         if (objid == -1) {
1260                 tidx = -1;
1261                 oidx = -1;
1262         } else {
1263                 tidx = cc->ses_typidx[objid].ses_tidx;
1264                 oidx = cc->ses_typidx[objid].ses_oidx;
1265         }
1266         if (in) {
1267                 if (ses_decode(sdata, amt, cc->ses_eltmap, tidx, oidx, sp)) {
1268                         err = ENODEV;
1269                 }
1270         } else {
1271                 if (ses_encode(sdata, amt, cc->ses_eltmap, tidx, oidx, sp)) {
1272                         err = ENODEV;
1273                 } else {
1274                         cdb[0] = SEND_DIAGNOSTIC;
1275                         cdb[1] = 0x10;
1276                         cdb[2] = 0;
1277                         cdb[3] = bufsiz >> 8;
1278                         cdb[4] = bufsiz & 0xff;
1279                         cdb[5] = 0;
1280                         amt = -bufsiz;
1281                         err = ses_runcmd(ssc, cdb, 6, sdata, &amt);
1282                 }
1283         }
1284         SES_FREE(sdata, bufsiz);
1285         return (0);
1286 }
1287
1288
1289 /*
1290  * Routines to parse returned SES data structures.
1291  * Architecture and compiler independent.
1292  */
1293
1294 static int
1295 ses_cfghdr(uint8_t *buffer, int buflen, SesCfgHdr *cfp)
1296 {
1297         if (buflen < SES_CFGHDR_MINLEN) {
1298                 return (-1);
1299         }
1300         gget8(buffer, 1, cfp->Nsubenc);
1301         gget32(buffer, 4, cfp->GenCode);
1302         return (0);
1303 }
1304
1305 static int
1306 ses_enchdr(uint8_t *buffer, int amt, uint8_t SubEncId, SesEncHdr *chp)
1307 {
1308         int s, off = 8;
1309         for (s = 0; s < SubEncId; s++) {
1310                 if (off + 3 > amt)
1311                         return (-1);
1312                 off += buffer[off+3] + 4;
1313         }
1314         if (off + 3 > amt) {
1315                 return (-1);
1316         }
1317         gget8(buffer, off+1, chp->Subencid);
1318         gget8(buffer, off+2, chp->Ntypes);
1319         gget8(buffer, off+3, chp->VEnclen);
1320         return (0);
1321 }
1322
1323 static int
1324 ses_encdesc(uint8_t *buffer, int amt, uint8_t SubEncId, SesEncDesc *cdp)
1325 {
1326         int s, e, enclen, off = 8;
1327         for (s = 0; s < SubEncId; s++) {
1328                 if (off + 3 > amt)
1329                         return (-1);
1330                 off += buffer[off+3] + 4;
1331         }
1332         if (off + 3 > amt) {
1333                 return (-1);
1334         }
1335         gget8(buffer, off+3, enclen);
1336         off += 4;
1337         if (off  >= amt)
1338                 return (-1);
1339
1340         e = off + enclen;
1341         if (e > amt) {
1342                 e = amt;
1343         }
1344         MEMCPY(cdp, &buffer[off], e - off);
1345         return (0);
1346 }
1347
1348 static int
1349 ses_getthdr(uint8_t *buffer, int amt, int nth, SesThdr *thp)
1350 {
1351         int s, off = 8;
1352
1353         if (amt < SES_CFGHDR_MINLEN) {
1354                 return (-1);
1355         }
1356         for (s = 0; s < buffer[1]; s++) {
1357                 if (off + 3 > amt)
1358                         return (-1);
1359                 off += buffer[off+3] + 4;
1360         }
1361         if (off + 3 > amt) {
1362                 return (-1);
1363         }
1364         off += buffer[off+3] + 4 + (nth * 4);
1365         if (amt < (off + 4))
1366                 return (-1);
1367
1368         gget8(buffer, off++, thp->enc_type);
1369         gget8(buffer, off++, thp->enc_maxelt);
1370         gget8(buffer, off++, thp->enc_subenc);
1371         gget8(buffer, off, thp->enc_tlen);
1372         return (0);
1373 }
1374
1375 /*
1376  * This function needs a little explanation.
1377  *
1378  * The arguments are:
1379  *
1380  *
1381  *      char *b, int amt
1382  *
1383  *              These describes the raw input SES status data and length.
1384  *
1385  *      uint8_t *ep
1386  *
1387  *              This is a map of the number of types for each element type
1388  *              in the enclosure.
1389  *
1390  *      int elt
1391  *
1392  *              This is the element type being sought. If elt is -1,
1393  *              then overall enclosure status is being sought.
1394  *
1395  *      int elm
1396  *
1397  *              This is the ordinal Mth element of type elt being sought.
1398  *
1399  *      SesComStat *sp
1400  *
1401  *              This is the output area to store the status for
1402  *              the Mth element of type Elt.
1403  */
1404
1405 static int
1406 ses_decode(char *b, int amt, uint8_t *ep, int elt, int elm, SesComStat *sp)
1407 {
1408         int idx, i;
1409
1410         /*
1411          * If it's overall enclosure status being sought, get that.
1412          * We need at least 2 bytes of status data to get that.
1413          */
1414         if (elt == -1) {
1415                 if (amt < 2)
1416                         return (-1);
1417                 gget8(b, 1, sp->comstatus);
1418                 sp->comstat[0] = 0;
1419                 sp->comstat[1] = 0;
1420                 sp->comstat[2] = 0;
1421                 return (0);
1422         }
1423
1424         /*
1425          * Check to make sure that the Mth element is legal for type Elt.
1426          */
1427
1428         if (elm >= ep[elt])
1429                 return (-1);
1430
1431         /*
1432          * Starting at offset 8, start skipping over the storage
1433          * for the element types we're not interested in.
1434          */
1435         for (idx = 8, i = 0; i < elt; i++) {
1436                 idx += ((ep[i] + 1) * 4);
1437         }
1438
1439         /*
1440          * Skip over Overall status for this element type.
1441          */
1442         idx += 4;
1443
1444         /*
1445          * And skip to the index for the Mth element that we're going for.
1446          */
1447         idx += (4 * elm);
1448
1449         /*
1450          * Make sure we haven't overflowed the buffer.
1451          */
1452         if (idx+4 > amt)
1453                 return (-1);
1454
1455         /*
1456          * Retrieve the status.
1457          */
1458         gget8(b, idx++, sp->comstatus);
1459         gget8(b, idx++, sp->comstat[0]);
1460         gget8(b, idx++, sp->comstat[1]);
1461         gget8(b, idx++, sp->comstat[2]);
1462 #if     0
1463         PRINTF("Get Elt 0x%x Elm 0x%x (idx %d)\n", elt, elm, idx-4);
1464 #endif
1465         return (0);
1466 }
1467
1468 /*
1469  * This is the mirror function to ses_decode, but we set the 'select'
1470  * bit for the object which we're interested in. All other objects,
1471  * after a status fetch, should have that bit off. Hmm. It'd be easy
1472  * enough to ensure this, so we will.
1473  */
1474
1475 static int
1476 ses_encode(char *b, int amt, uint8_t *ep, int elt, int elm, SesComStat *sp)
1477 {
1478         int idx, i;
1479
1480         /*
1481          * If it's overall enclosure status being sought, get that.
1482          * We need at least 2 bytes of status data to get that.
1483          */
1484         if (elt == -1) {
1485                 if (amt < 2)
1486                         return (-1);
1487                 i = 0;
1488                 sset8(b, i, 0);
1489                 sset8(b, i, sp->comstatus & 0xf);
1490 #if     0
1491                 PRINTF("set EncStat %x\n", sp->comstatus);
1492 #endif
1493                 return (0);
1494         }
1495
1496         /*
1497          * Check to make sure that the Mth element is legal for type Elt.
1498          */
1499
1500         if (elm >= ep[elt])
1501                 return (-1);
1502
1503         /*
1504          * Starting at offset 8, start skipping over the storage
1505          * for the element types we're not interested in.
1506          */
1507         for (idx = 8, i = 0; i < elt; i++) {
1508                 idx += ((ep[i] + 1) * 4);
1509         }
1510
1511         /*
1512          * Skip over Overall status for this element type.
1513          */
1514         idx += 4;
1515
1516         /*
1517          * And skip to the index for the Mth element that we're going for.
1518          */
1519         idx += (4 * elm);
1520
1521         /*
1522          * Make sure we haven't overflowed the buffer.
1523          */
1524         if (idx+4 > amt)
1525                 return (-1);
1526
1527         /*
1528          * Set the status.
1529          */
1530         sset8(b, idx, sp->comstatus);
1531         sset8(b, idx, sp->comstat[0]);
1532         sset8(b, idx, sp->comstat[1]);
1533         sset8(b, idx, sp->comstat[2]);
1534         idx -= 4;
1535
1536 #if     0
1537         PRINTF("Set Elt 0x%x Elm 0x%x (idx %d) with %x %x %x %x\n",
1538             elt, elm, idx, sp->comstatus, sp->comstat[0],
1539             sp->comstat[1], sp->comstat[2]);
1540 #endif
1541
1542         /*
1543          * Now make sure all other 'Select' bits are off.
1544          */
1545         for (i = 8; i < amt; i += 4) {
1546                 if (i != idx)
1547                         b[i] &= ~0x80;
1548         }
1549         /*
1550          * And make sure the INVOP bit is clear.
1551          */
1552         b[2] &= ~0x10;
1553
1554         return (0);
1555 }
1556
1557 /*
1558  * SAF-TE Type Device Emulation
1559  */
1560
1561 static int safte_getconfig(ses_softc_t *);
1562 static int safte_rdstat(ses_softc_t *, int);
1563 static int set_objstat_sel(ses_softc_t *, ses_objstat *, int);
1564 static int wrbuf16(ses_softc_t *, uint8_t, uint8_t, uint8_t, uint8_t, int);
1565 static void wrslot_stat(ses_softc_t *, int);
1566 static int perf_slotop(ses_softc_t *, uint8_t, uint8_t, int);
1567
1568 #define ALL_ENC_STAT (SES_ENCSTAT_CRITICAL | SES_ENCSTAT_UNRECOV | \
1569         SES_ENCSTAT_NONCRITICAL | SES_ENCSTAT_INFO)
1570 /*
1571  * SAF-TE specific defines- Mandatory ones only...
1572  */
1573
1574 /*
1575  * READ BUFFER ('get' commands) IDs- placed in offset 2 of cdb
1576  */
1577 #define SAFTE_RD_RDCFG  0x00    /* read enclosure configuration */
1578 #define SAFTE_RD_RDESTS 0x01    /* read enclosure status */
1579 #define SAFTE_RD_RDDSTS 0x04    /* read drive slot status */
1580
1581 /*
1582  * WRITE BUFFER ('set' commands) IDs- placed in offset 0 of databuf
1583  */
1584 #define SAFTE_WT_DSTAT  0x10    /* write device slot status */
1585 #define SAFTE_WT_SLTOP  0x12    /* perform slot operation */
1586 #define SAFTE_WT_FANSPD 0x13    /* set fan speed */
1587 #define SAFTE_WT_ACTPWS 0x14    /* turn on/off power supply */
1588 #define SAFTE_WT_GLOBAL 0x15    /* send global command */
1589
1590
1591 #define SAFT_SCRATCH    64
1592 #define NPSEUDO_THERM   16
1593 #define NPSEUDO_ALARM   1
1594 struct scfg {
1595         /*
1596          * Cached Configuration
1597          */
1598         uint8_t Nfans;          /* Number of Fans */
1599         uint8_t Npwr;           /* Number of Power Supplies */
1600         uint8_t Nslots;         /* Number of Device Slots */
1601         uint8_t DoorLock;       /* Door Lock Installed */
1602         uint8_t Ntherm;         /* Number of Temperature Sensors */
1603         uint8_t Nspkrs;         /* Number of Speakers */
1604         uint8_t Nalarm;         /* Number of Alarms (at least one) */
1605         /*
1606          * Cached Flag Bytes for Global Status
1607          */
1608         uint8_t flag1;
1609         uint8_t flag2;
1610         /*
1611          * What object index ID is where various slots start.
1612          */
1613         uint8_t pwroff;
1614         uint8_t slotoff;
1615 #define SAFT_ALARM_OFFSET(cc)   (cc)->slotoff - 1
1616 };
1617
1618 #define SAFT_FLG1_ALARM         0x1
1619 #define SAFT_FLG1_GLOBFAIL      0x2
1620 #define SAFT_FLG1_GLOBWARN      0x4
1621 #define SAFT_FLG1_ENCPWROFF     0x8
1622 #define SAFT_FLG1_ENCFANFAIL    0x10
1623 #define SAFT_FLG1_ENCPWRFAIL    0x20
1624 #define SAFT_FLG1_ENCDRVFAIL    0x40
1625 #define SAFT_FLG1_ENCDRVWARN    0x80
1626
1627 #define SAFT_FLG2_LOCKDOOR      0x4
1628 #define SAFT_PRIVATE            sizeof (struct scfg)
1629
1630 static char *safte_2little = "Too Little Data Returned (%d) at line %d\n";
1631 #define SAFT_BAIL(r, x, k, l)   \
1632         if ((r) >= (x)) { \
1633                 SES_LOG(ssc, safte_2little, x, __LINE__);\
1634                 SES_FREE((k), (l)); \
1635                 return (EIO); \
1636         }
1637
1638
1639 static int
1640 safte_softc_init(ses_softc_t *ssc, int doinit)
1641 {
1642         int err, i, r;
1643         struct scfg *cc;
1644
1645         if (doinit == 0) {
1646                 if (ssc->ses_nobjects) {
1647                         if (ssc->ses_objmap) {
1648                                 SES_FREE(ssc->ses_objmap,
1649                                     ssc->ses_nobjects * sizeof (encobj));
1650                                 ssc->ses_objmap = NULL;
1651                         }
1652                         ssc->ses_nobjects = 0;
1653                 }
1654                 if (ssc->ses_private) {
1655                         SES_FREE(ssc->ses_private, SAFT_PRIVATE);
1656                         ssc->ses_private = NULL;
1657                 }
1658                 return (0);
1659         }
1660
1661         if (ssc->ses_private == NULL) {
1662                 ssc->ses_private = SES_MALLOC(SAFT_PRIVATE);
1663                 if (ssc->ses_private == NULL) {
1664                         return (ENOMEM);
1665                 }
1666                 MEMZERO(ssc->ses_private, SAFT_PRIVATE);
1667         }
1668
1669         ssc->ses_nobjects = 0;
1670         ssc->ses_encstat = 0;
1671
1672         if ((err = safte_getconfig(ssc)) != 0) {
1673                 return (err);
1674         }
1675
1676         /*
1677          * The number of objects here, as well as that reported by the
1678          * READ_BUFFER/GET_CONFIG call, are the over-temperature flags (15)
1679          * that get reported during READ_BUFFER/READ_ENC_STATUS.
1680          */
1681         cc = ssc->ses_private;
1682         ssc->ses_nobjects = cc->Nfans + cc->Npwr + cc->Nslots + cc->DoorLock +
1683             cc->Ntherm + cc->Nspkrs + NPSEUDO_THERM + NPSEUDO_ALARM;
1684         ssc->ses_objmap = (encobj *)
1685             SES_MALLOC(ssc->ses_nobjects * sizeof (encobj));
1686         if (ssc->ses_objmap == NULL) {
1687                 return (ENOMEM);
1688         }
1689         MEMZERO(ssc->ses_objmap, ssc->ses_nobjects * sizeof (encobj));
1690
1691         r = 0;
1692         /*
1693          * Note that this is all arranged for the convenience
1694          * in later fetches of status.
1695          */
1696         for (i = 0; i < cc->Nfans; i++)
1697                 ssc->ses_objmap[r++].enctype = SESTYP_FAN;
1698         cc->pwroff = (uint8_t) r;
1699         for (i = 0; i < cc->Npwr; i++)
1700                 ssc->ses_objmap[r++].enctype = SESTYP_POWER;
1701         for (i = 0; i < cc->DoorLock; i++)
1702                 ssc->ses_objmap[r++].enctype = SESTYP_DOORLOCK;
1703         for (i = 0; i < cc->Nspkrs; i++)
1704                 ssc->ses_objmap[r++].enctype = SESTYP_ALARM;
1705         for (i = 0; i < cc->Ntherm; i++)
1706                 ssc->ses_objmap[r++].enctype = SESTYP_THERM;
1707         for (i = 0; i < NPSEUDO_THERM; i++)
1708                 ssc->ses_objmap[r++].enctype = SESTYP_THERM;
1709         ssc->ses_objmap[r++].enctype = SESTYP_ALARM;
1710         cc->slotoff = (uint8_t) r;
1711         for (i = 0; i < cc->Nslots; i++)
1712                 ssc->ses_objmap[r++].enctype = SESTYP_DEVICE;
1713         return (0);
1714 }
1715
1716 static int
1717 safte_init_enc(ses_softc_t *ssc)
1718 {
1719         int err;
1720         static char cdb0[6] = { SEND_DIAGNOSTIC };
1721
1722         err = ses_runcmd(ssc, cdb0, 6, NULL, 0);
1723         if (err) {
1724                 return (err);
1725         }
1726         DELAY(5000);
1727         err = wrbuf16(ssc, SAFTE_WT_GLOBAL, 0, 0, 0, 1);
1728         return (err);
1729 }
1730
1731 static int
1732 safte_get_encstat(ses_softc_t *ssc, int slpflg)
1733 {
1734         return (safte_rdstat(ssc, slpflg));
1735 }
1736
1737 static int
1738 safte_set_encstat(ses_softc_t *ssc, uint8_t encstat, int slpflg)
1739 {
1740         struct scfg *cc = ssc->ses_private;
1741         if (cc == NULL)
1742                 return (0);
1743         /*
1744          * Since SAF-TE devices aren't necessarily sticky in terms
1745          * of state, make our soft copy of enclosure status 'sticky'-
1746          * that is, things set in enclosure status stay set (as implied
1747          * by conditions set in reading object status) until cleared.
1748          */
1749         ssc->ses_encstat &= ~ALL_ENC_STAT;
1750         ssc->ses_encstat |= (encstat & ALL_ENC_STAT);
1751         ssc->ses_encstat |= ENCI_SVALID;
1752         cc->flag1 &= ~(SAFT_FLG1_ALARM|SAFT_FLG1_GLOBFAIL|SAFT_FLG1_GLOBWARN);
1753         if ((encstat & (SES_ENCSTAT_CRITICAL|SES_ENCSTAT_UNRECOV)) != 0) {
1754                 cc->flag1 |= SAFT_FLG1_ALARM|SAFT_FLG1_GLOBFAIL;
1755         } else if ((encstat & SES_ENCSTAT_NONCRITICAL) != 0) {
1756                 cc->flag1 |= SAFT_FLG1_GLOBWARN;
1757         }
1758         return (wrbuf16(ssc, SAFTE_WT_GLOBAL, cc->flag1, cc->flag2, 0, slpflg));
1759 }
1760
1761 static int
1762 safte_get_objstat(ses_softc_t *ssc, ses_objstat *obp, int slpflg)
1763 {
1764         int i = (int)obp->obj_id;
1765
1766         if ((ssc->ses_encstat & ENCI_SVALID) == 0 ||
1767             (ssc->ses_objmap[i].svalid) == 0) {
1768                 int err = safte_rdstat(ssc, slpflg);
1769                 if (err)
1770                         return (err);
1771         }
1772         obp->cstat[0] = ssc->ses_objmap[i].encstat[0];
1773         obp->cstat[1] = ssc->ses_objmap[i].encstat[1];
1774         obp->cstat[2] = ssc->ses_objmap[i].encstat[2];
1775         obp->cstat[3] = ssc->ses_objmap[i].encstat[3];
1776         return (0);
1777 }
1778
1779
1780 static int
1781 safte_set_objstat(ses_softc_t *ssc, ses_objstat *obp, int slp)
1782 {
1783         int idx, err;
1784         encobj *ep;
1785         struct scfg *cc;
1786
1787
1788         SES_DLOG(ssc, "safte_set_objstat(%d): %x %x %x %x\n",
1789             (int)obp->obj_id, obp->cstat[0], obp->cstat[1], obp->cstat[2],
1790             obp->cstat[3]);
1791
1792         /*
1793          * If this is clear, we don't do diddly.
1794          */
1795         if ((obp->cstat[0] & SESCTL_CSEL) == 0) {
1796                 return (0);
1797         }
1798
1799         err = 0;
1800         /*
1801          * Check to see if the common bits are set and do them first.
1802          */
1803         if (obp->cstat[0] & ~SESCTL_CSEL) {
1804                 err = set_objstat_sel(ssc, obp, slp);
1805                 if (err)
1806                         return (err);
1807         }
1808
1809         cc = ssc->ses_private;
1810         if (cc == NULL)
1811                 return (0);
1812
1813         idx = (int)obp->obj_id;
1814         ep = &ssc->ses_objmap[idx];
1815
1816         switch (ep->enctype) {
1817         case SESTYP_DEVICE:
1818         {
1819                 uint8_t slotop = 0;
1820                 /*
1821                  * XXX: I should probably cache the previous state
1822                  * XXX: of SESCTL_DEVOFF so that when it goes from
1823                  * XXX: true to false I can then set PREPARE FOR OPERATION
1824                  * XXX: flag in PERFORM SLOT OPERATION write buffer command.
1825                  */
1826                 if (obp->cstat[2] & (SESCTL_RQSINS|SESCTL_RQSRMV)) {
1827                         slotop |= 0x2;
1828                 }
1829                 if (obp->cstat[2] & SESCTL_RQSID) {
1830                         slotop |= 0x4;
1831                 }
1832                 err = perf_slotop(ssc, (uint8_t) idx - (uint8_t) cc->slotoff,
1833                     slotop, slp);
1834                 if (err)
1835                         return (err);
1836                 if (obp->cstat[3] & SESCTL_RQSFLT) {
1837                         ep->priv |= 0x2;
1838                 } else {
1839                         ep->priv &= ~0x2;
1840                 }
1841                 if (ep->priv & 0xc6) {
1842                         ep->priv &= ~0x1;
1843                 } else {
1844                         ep->priv |= 0x1;        /* no errors */
1845                 }
1846                 wrslot_stat(ssc, slp);
1847                 break;
1848         }
1849         case SESTYP_POWER:
1850                 if (obp->cstat[3] & SESCTL_RQSTFAIL) {
1851                         cc->flag1 |= SAFT_FLG1_ENCPWRFAIL;
1852                 } else {
1853                         cc->flag1 &= ~SAFT_FLG1_ENCPWRFAIL;
1854                 }
1855                 err = wrbuf16(ssc, SAFTE_WT_GLOBAL, cc->flag1,
1856                     cc->flag2, 0, slp);
1857                 if (err)
1858                         return (err);
1859                 if (obp->cstat[3] & SESCTL_RQSTON) {
1860                         wrbuf16(ssc, SAFTE_WT_ACTPWS,
1861                                 idx - cc->pwroff, 0, 0, slp);
1862                 } else {
1863                         wrbuf16(ssc, SAFTE_WT_ACTPWS,
1864                                 idx - cc->pwroff, 0, 1, slp);
1865                 }
1866                 break;
1867         case SESTYP_FAN:
1868                 if (obp->cstat[3] & SESCTL_RQSTFAIL) {
1869                         cc->flag1 |= SAFT_FLG1_ENCFANFAIL;
1870                 } else {
1871                         cc->flag1 &= ~SAFT_FLG1_ENCFANFAIL;
1872                 }
1873                 err = wrbuf16(ssc, SAFTE_WT_GLOBAL, cc->flag1,
1874                     cc->flag2, 0, slp);
1875                 if (err)
1876                         return (err);
1877                 if (obp->cstat[3] & SESCTL_RQSTON) {
1878                         uint8_t fsp;
1879                         if ((obp->cstat[3] & 0x7) == 7) {
1880                                 fsp = 4;
1881                         } else if ((obp->cstat[3] & 0x7) == 6) {
1882                                 fsp = 3;
1883                         } else if ((obp->cstat[3] & 0x7) == 4) {
1884                                 fsp = 2;
1885                         } else {
1886                                 fsp = 1;
1887                         }
1888                         wrbuf16(ssc, SAFTE_WT_FANSPD, idx, fsp, 0, slp);
1889                 } else {
1890                         wrbuf16(ssc, SAFTE_WT_FANSPD, idx, 0, 0, slp);
1891                 }
1892                 break;
1893         case SESTYP_DOORLOCK:
1894                 if (obp->cstat[3] & 0x1) {
1895                         cc->flag2 &= ~SAFT_FLG2_LOCKDOOR;
1896                 } else {
1897                         cc->flag2 |= SAFT_FLG2_LOCKDOOR;
1898                 }
1899                 wrbuf16(ssc, SAFTE_WT_GLOBAL, cc->flag1, cc->flag2, 0, slp);
1900                 break;
1901         case SESTYP_ALARM:
1902                 /*
1903                  * On all nonzero but the 'muted' bit, we turn on the alarm,
1904                  */
1905                 obp->cstat[3] &= ~0xa;
1906                 if (obp->cstat[3] & 0x40) {
1907                         cc->flag2 &= ~SAFT_FLG1_ALARM;
1908                 } else if (obp->cstat[3] != 0) {
1909                         cc->flag2 |= SAFT_FLG1_ALARM;
1910                 } else {
1911                         cc->flag2 &= ~SAFT_FLG1_ALARM;
1912                 }
1913                 ep->priv = obp->cstat[3];
1914                 wrbuf16(ssc, SAFTE_WT_GLOBAL, cc->flag1, cc->flag2, 0, slp);
1915                 break;
1916         default:
1917                 break;
1918         }
1919         ep->svalid = 0;
1920         return (0);
1921 }
1922
1923 static int
1924 safte_getconfig(ses_softc_t *ssc)
1925 {
1926         struct scfg *cfg;
1927         int err, amt;
1928         char *sdata;
1929         static char cdb[10] =
1930             { READ_BUFFER, 1, SAFTE_RD_RDCFG, 0, 0, 0, 0, 0, SAFT_SCRATCH, 0 };
1931
1932         cfg = ssc->ses_private;
1933         if (cfg == NULL)
1934                 return (ENXIO);
1935
1936         sdata = SES_MALLOC(SAFT_SCRATCH);
1937         if (sdata == NULL)
1938                 return (ENOMEM);
1939
1940         amt = SAFT_SCRATCH;
1941         err = ses_runcmd(ssc, cdb, 10, sdata, &amt);
1942         if (err) {
1943                 SES_FREE(sdata, SAFT_SCRATCH);
1944                 return (err);
1945         }
1946         amt = SAFT_SCRATCH - amt;
1947         if (amt < 6) {
1948                 SES_LOG(ssc, "too little data (%d) for configuration\n", amt);
1949                 SES_FREE(sdata, SAFT_SCRATCH);
1950                 return (EIO);
1951         }
1952         SES_VLOG(ssc, "Nfans %d Npwr %d Nslots %d Lck %d Ntherm %d Nspkrs %d\n",
1953             sdata[0], sdata[1], sdata[2], sdata[3], sdata[4], sdata[5]);
1954         cfg->Nfans = sdata[0];
1955         cfg->Npwr = sdata[1];
1956         cfg->Nslots = sdata[2];
1957         cfg->DoorLock = sdata[3];
1958         cfg->Ntherm = sdata[4];
1959         cfg->Nspkrs = sdata[5];
1960         cfg->Nalarm = NPSEUDO_ALARM;
1961         SES_FREE(sdata, SAFT_SCRATCH);
1962         return (0);
1963 }
1964
1965 static int
1966 safte_rdstat(ses_softc_t *ssc, int slpflg)
1967 {
1968         int err, oid, r, i, hiwater, nitems, amt;
1969         uint16_t tempflags;
1970         size_t buflen;
1971         uint8_t status, oencstat;
1972         char *sdata, cdb[10];
1973         struct scfg *cc = ssc->ses_private;
1974
1975
1976         /*
1977          * The number of objects overstates things a bit,
1978          * both for the bogus 'thermometer' entries and
1979          * the drive status (which isn't read at the same
1980          * time as the enclosure status), but that's okay.
1981          */
1982         buflen = 4 * cc->Nslots;
1983         if (ssc->ses_nobjects > buflen)
1984                 buflen = ssc->ses_nobjects;
1985         sdata = SES_MALLOC(buflen);
1986         if (sdata == NULL)
1987                 return (ENOMEM);
1988
1989         cdb[0] = READ_BUFFER;
1990         cdb[1] = 1;
1991         cdb[2] = SAFTE_RD_RDESTS;
1992         cdb[3] = 0;
1993         cdb[4] = 0;
1994         cdb[5] = 0;
1995         cdb[6] = 0;
1996         cdb[7] = (buflen >> 8) & 0xff;
1997         cdb[8] = buflen & 0xff;
1998         cdb[9] = 0;
1999         amt = buflen;
2000         err = ses_runcmd(ssc, cdb, 10, sdata, &amt);
2001         if (err) {
2002                 SES_FREE(sdata, buflen);
2003                 return (err);
2004         }
2005         hiwater = buflen - amt;
2006
2007
2008         /*
2009          * invalidate all status bits.
2010          */
2011         for (i = 0; i < ssc->ses_nobjects; i++)
2012                 ssc->ses_objmap[i].svalid = 0;
2013         oencstat = ssc->ses_encstat & ALL_ENC_STAT;
2014         ssc->ses_encstat = 0;
2015
2016
2017         /*
2018          * Now parse returned buffer.
2019          * If we didn't get enough data back,
2020          * that's considered a fatal error.
2021          */
2022         oid = r = 0;
2023
2024         for (nitems = i = 0; i < cc->Nfans; i++) {
2025                 SAFT_BAIL(r, hiwater, sdata, buflen);
2026                 /*
2027                  * 0 = Fan Operational
2028                  * 1 = Fan is malfunctioning
2029                  * 2 = Fan is not present
2030                  * 0x80 = Unknown or Not Reportable Status
2031                  */
2032                 ssc->ses_objmap[oid].encstat[1] = 0;    /* resvd */
2033                 ssc->ses_objmap[oid].encstat[2] = 0;    /* resvd */
2034                 switch ((int)(uint8_t)sdata[r]) {
2035                 case 0:
2036                         nitems++;
2037                         ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_OK;
2038                         /*
2039                          * We could get fancier and cache
2040                          * fan speeds that we have set, but
2041                          * that isn't done now.
2042                          */
2043                         ssc->ses_objmap[oid].encstat[3] = 7;
2044                         break;
2045
2046                 case 1:
2047                         ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_CRIT;
2048                         /*
2049                          * FAIL and FAN STOPPED synthesized
2050                          */
2051                         ssc->ses_objmap[oid].encstat[3] = 0x40;
2052                         /*
2053                          * Enclosure marked with CRITICAL error
2054                          * if only one fan or no thermometers,
2055                          * else the NONCRITICAL error is set.
2056                          */
2057                         if (cc->Nfans == 1 || cc->Ntherm == 0)
2058                                 ssc->ses_encstat |= SES_ENCSTAT_CRITICAL;
2059                         else
2060                                 ssc->ses_encstat |= SES_ENCSTAT_NONCRITICAL;
2061                         break;
2062                 case 2:
2063                         ssc->ses_objmap[oid].encstat[0] =
2064                             SES_OBJSTAT_NOTINSTALLED;
2065                         ssc->ses_objmap[oid].encstat[3] = 0;
2066                         /*
2067                          * Enclosure marked with CRITICAL error
2068                          * if only one fan or no thermometers,
2069                          * else the NONCRITICAL error is set.
2070                          */
2071                         if (cc->Nfans == 1)
2072                                 ssc->ses_encstat |= SES_ENCSTAT_CRITICAL;
2073                         else
2074                                 ssc->ses_encstat |= SES_ENCSTAT_NONCRITICAL;
2075                         break;
2076                 case 0x80:
2077                         ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_UNKNOWN;
2078                         ssc->ses_objmap[oid].encstat[3] = 0;
2079                         ssc->ses_encstat |= SES_ENCSTAT_INFO;
2080                         break;
2081                 default:
2082                         ssc->ses_objmap[oid].encstat[0] =
2083                             SES_OBJSTAT_UNSUPPORTED;
2084                         SES_LOG(ssc, "Unknown fan%d status 0x%x\n", i,
2085                             sdata[r] & 0xff);
2086                         break;
2087                 }
2088                 ssc->ses_objmap[oid++].svalid = 1;
2089                 r++;
2090         }
2091
2092         /*
2093          * No matter how you cut it, no cooling elements when there
2094          * should be some there is critical.
2095          */
2096         if (cc->Nfans && nitems == 0) {
2097                 ssc->ses_encstat |= SES_ENCSTAT_CRITICAL;
2098         }
2099
2100
2101         for (i = 0; i < cc->Npwr; i++) {
2102                 SAFT_BAIL(r, hiwater, sdata, buflen);
2103                 ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_UNKNOWN;
2104                 ssc->ses_objmap[oid].encstat[1] = 0;    /* resvd */
2105                 ssc->ses_objmap[oid].encstat[2] = 0;    /* resvd */
2106                 ssc->ses_objmap[oid].encstat[3] = 0x20; /* requested on */
2107                 switch ((uint8_t)sdata[r]) {
2108                 case 0x00:      /* pws operational and on */
2109                         ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_OK;
2110                         break;
2111                 case 0x01:      /* pws operational and off */
2112                         ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_OK;
2113                         ssc->ses_objmap[oid].encstat[3] = 0x10;
2114                         ssc->ses_encstat |= SES_ENCSTAT_INFO;
2115                         break;
2116                 case 0x10:      /* pws is malfunctioning and commanded on */
2117                         ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_CRIT;
2118                         ssc->ses_objmap[oid].encstat[3] = 0x61;
2119                         ssc->ses_encstat |= SES_ENCSTAT_NONCRITICAL;
2120                         break;
2121
2122                 case 0x11:      /* pws is malfunctioning and commanded off */
2123                         ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_NONCRIT;
2124                         ssc->ses_objmap[oid].encstat[3] = 0x51;
2125                         ssc->ses_encstat |= SES_ENCSTAT_NONCRITICAL;
2126                         break;
2127                 case 0x20:      /* pws is not present */
2128                         ssc->ses_objmap[oid].encstat[0] =
2129                             SES_OBJSTAT_NOTINSTALLED;
2130                         ssc->ses_objmap[oid].encstat[3] = 0;
2131                         ssc->ses_encstat |= SES_ENCSTAT_INFO;
2132                         break;
2133                 case 0x21:      /* pws is present */
2134                         /*
2135                          * This is for enclosures that cannot tell whether the
2136                          * device is on or malfunctioning, but know that it is
2137                          * present. Just fall through.
2138                          */
2139                         /* FALLTHROUGH */
2140                 case 0x80:      /* Unknown or Not Reportable Status */
2141                         ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_UNKNOWN;
2142                         ssc->ses_objmap[oid].encstat[3] = 0;
2143                         ssc->ses_encstat |= SES_ENCSTAT_INFO;
2144                         break;
2145                 default:
2146                         SES_LOG(ssc, "unknown power supply %d status (0x%x)\n",
2147                             i, sdata[r] & 0xff);
2148                         break;
2149                 }
2150                 ssc->ses_objmap[oid++].svalid = 1;
2151                 r++;
2152         }
2153
2154         /*
2155          * Skip over Slot SCSI IDs
2156          */
2157         r += cc->Nslots;
2158
2159         /*
2160          * We always have doorlock status, no matter what,
2161          * but we only save the status if we have one.
2162          */
2163         SAFT_BAIL(r, hiwater, sdata, buflen);
2164         if (cc->DoorLock) {
2165                 /*
2166                  * 0 = Door Locked
2167                  * 1 = Door Unlocked, or no Lock Installed
2168                  * 0x80 = Unknown or Not Reportable Status
2169                  */
2170                 ssc->ses_objmap[oid].encstat[1] = 0;
2171                 ssc->ses_objmap[oid].encstat[2] = 0;
2172                 switch ((uint8_t)sdata[r]) {
2173                 case 0:
2174                         ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_OK;
2175                         ssc->ses_objmap[oid].encstat[3] = 0;
2176                         break;
2177                 case 1:
2178                         ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_OK;
2179                         ssc->ses_objmap[oid].encstat[3] = 1;
2180                         break;
2181                 case 0x80:
2182                         ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_UNKNOWN;
2183                         ssc->ses_objmap[oid].encstat[3] = 0;
2184                         ssc->ses_encstat |= SES_ENCSTAT_INFO;
2185                         break;
2186                 default:
2187                         ssc->ses_objmap[oid].encstat[0] =
2188                             SES_OBJSTAT_UNSUPPORTED;
2189                         SES_LOG(ssc, "unknown lock status 0x%x\n",
2190                             sdata[r] & 0xff);
2191                         break;
2192                 }
2193                 ssc->ses_objmap[oid++].svalid = 1;
2194         }
2195         r++;
2196
2197         /*
2198          * We always have speaker status, no matter what,
2199          * but we only save the status if we have one.
2200          */
2201         SAFT_BAIL(r, hiwater, sdata, buflen);
2202         if (cc->Nspkrs) {
2203                 ssc->ses_objmap[oid].encstat[1] = 0;
2204                 ssc->ses_objmap[oid].encstat[2] = 0;
2205                 if (sdata[r] == 1) {
2206                         /*
2207                          * We need to cache tone urgency indicators.
2208                          * Someday.
2209                          */
2210                         ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_NONCRIT;
2211                         ssc->ses_objmap[oid].encstat[3] = 0x8;
2212                         ssc->ses_encstat |= SES_ENCSTAT_NONCRITICAL;
2213                 } else if (sdata[r] == 0) {
2214                         ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_OK;
2215                         ssc->ses_objmap[oid].encstat[3] = 0;
2216                 } else {
2217                         ssc->ses_objmap[oid].encstat[0] =
2218                             SES_OBJSTAT_UNSUPPORTED;
2219                         ssc->ses_objmap[oid].encstat[3] = 0;
2220                         SES_LOG(ssc, "unknown spkr status 0x%x\n",
2221                             sdata[r] & 0xff);
2222                 }
2223                 ssc->ses_objmap[oid++].svalid = 1;
2224         }
2225         r++;
2226
2227         for (i = 0; i < cc->Ntherm; i++) {
2228                 SAFT_BAIL(r, hiwater, sdata, buflen);
2229                 /*
2230                  * Status is a range from -10 to 245 deg Celsius,
2231                  * which we need to normalize to -20 to -245 according
2232                  * to the latest SCSI spec, which makes little
2233                  * sense since this would overflow an 8bit value.
2234                  * Well, still, the base normalization is -20,
2235                  * not -10, so we have to adjust.
2236                  *
2237                  * So what's over and under temperature?
2238                  * Hmm- we'll state that 'normal' operating
2239                  * is 10 to 40 deg Celsius.
2240                  */
2241
2242                 /*
2243                  * Actually.... All of the units that people out in the world
2244                  * seem to have do not come even close to setting a value that
2245                  * complies with this spec.
2246                  *
2247                  * The closest explanation I could find was in an
2248                  * LSI-Logic manual, which seemed to indicate that
2249                  * this value would be set by whatever the I2C code
2250                  * would interpolate from the output of an LM75
2251                  * temperature sensor.
2252                  *
2253                  * This means that it is impossible to use the actual
2254                  * numeric value to predict anything. But we don't want
2255                  * to lose the value. So, we'll propagate the *uncorrected*
2256                  * value and set SES_OBJSTAT_NOTAVAIL. We'll depend on the
2257                  * temperature flags for warnings.
2258                  */
2259                 ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_NOTAVAIL;
2260                 ssc->ses_objmap[oid].encstat[1] = 0;
2261                 ssc->ses_objmap[oid].encstat[2] = sdata[r];
2262                 ssc->ses_objmap[oid].encstat[3] = 0;
2263                 ssc->ses_objmap[oid++].svalid = 1;
2264                 r++;
2265         }
2266
2267         /*
2268          * Now, for "pseudo" thermometers, we have two bytes
2269          * of information in enclosure status- 16 bits. Actually,
2270          * the MSB is a single TEMP ALERT flag indicating whether
2271          * any other bits are set, but, thanks to fuzzy thinking,
2272          * in the SAF-TE spec, this can also be set even if no
2273          * other bits are set, thus making this really another
2274          * binary temperature sensor.
2275          */
2276
2277         SAFT_BAIL(r, hiwater, sdata, buflen);
2278         tempflags = sdata[r++];
2279         SAFT_BAIL(r, hiwater, sdata, buflen);
2280         tempflags |= (tempflags << 8) | sdata[r++];
2281
2282         for (i = 0; i < NPSEUDO_THERM; i++) {
2283                 ssc->ses_objmap[oid].encstat[1] = 0;
2284                 if (tempflags & (1 << (NPSEUDO_THERM - i - 1))) {
2285                         ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_CRIT;
2286                         ssc->ses_objmap[4].encstat[2] = 0xff;
2287                         /*
2288                          * Set 'over temperature' failure.
2289                          */
2290                         ssc->ses_objmap[oid].encstat[3] = 8;
2291                         ssc->ses_encstat |= SES_ENCSTAT_CRITICAL;
2292                 } else {
2293                         /*
2294                          * We used to say 'not available' and synthesize a
2295                          * nominal 30 deg (C)- that was wrong. Actually,
2296                          * Just say 'OK', and use the reserved value of
2297                          * zero.
2298                          */
2299                         ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_OK;
2300                         ssc->ses_objmap[oid].encstat[2] = 0;
2301                         ssc->ses_objmap[oid].encstat[3] = 0;
2302                 }
2303                 ssc->ses_objmap[oid++].svalid = 1;
2304         }
2305
2306         /*
2307          * Get alarm status.
2308          */
2309         ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_OK;
2310         ssc->ses_objmap[oid].encstat[3] = ssc->ses_objmap[oid].priv;
2311         ssc->ses_objmap[oid++].svalid = 1;
2312
2313         /*
2314          * Now get drive slot status
2315          */
2316         cdb[2] = SAFTE_RD_RDDSTS;
2317         amt = buflen;
2318         err = ses_runcmd(ssc, cdb, 10, sdata, &amt);
2319         if (err) {
2320                 SES_FREE(sdata, buflen);
2321                 return (err);
2322         }
2323         hiwater = buflen - amt;
2324         for (r = i = 0; i < cc->Nslots; i++, r += 4) {
2325                 SAFT_BAIL(r+3, hiwater, sdata, buflen);
2326                 ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_UNSUPPORTED;
2327                 ssc->ses_objmap[oid].encstat[1] = (uint8_t) i;
2328                 ssc->ses_objmap[oid].encstat[2] = 0;
2329                 ssc->ses_objmap[oid].encstat[3] = 0;
2330                 status = sdata[r+3];
2331                 if ((status & 0x1) == 0) {      /* no device */
2332                         ssc->ses_objmap[oid].encstat[0] =
2333                             SES_OBJSTAT_NOTINSTALLED;
2334                 } else {
2335                         ssc->ses_objmap[oid].encstat[0] = SES_OBJSTAT_OK;
2336                 }
2337                 if (status & 0x2) {
2338                         ssc->ses_objmap[oid].encstat[2] = 0x8;
2339                 }
2340                 if ((status & 0x4) == 0) {
2341                         ssc->ses_objmap[oid].encstat[3] = 0x10;
2342                 }
2343                 ssc->ses_objmap[oid++].svalid = 1;
2344         }
2345         /* see comment below about sticky enclosure status */
2346         ssc->ses_encstat |= ENCI_SVALID | oencstat;
2347         SES_FREE(sdata, buflen);
2348         return (0);
2349 }
2350
2351 static int
2352 set_objstat_sel(ses_softc_t *ssc, ses_objstat *obp, int slp)
2353 {
2354         int idx;
2355         encobj *ep;
2356         struct scfg *cc = ssc->ses_private;
2357
2358         if (cc == NULL)
2359                 return (0);
2360
2361         idx = (int)obp->obj_id;
2362         ep = &ssc->ses_objmap[idx];
2363
2364         switch (ep->enctype) {
2365         case SESTYP_DEVICE:
2366                 if (obp->cstat[0] & SESCTL_PRDFAIL) {
2367                         ep->priv |= 0x40;
2368                 }
2369                 /* SESCTL_RSTSWAP has no correspondence in SAF-TE */
2370                 if (obp->cstat[0] & SESCTL_DISABLE) {
2371                         ep->priv |= 0x80;
2372                         /*
2373                          * Hmm. Try to set the 'No Drive' flag.
2374                          * Maybe that will count as a 'disable'.
2375                          */
2376                 }
2377                 if (ep->priv & 0xc6) {
2378                         ep->priv &= ~0x1;
2379                 } else {
2380                         ep->priv |= 0x1;        /* no errors */
2381                 }
2382                 wrslot_stat(ssc, slp);
2383                 break;
2384         case SESTYP_POWER:
2385                 /*
2386                  * Okay- the only one that makes sense here is to
2387                  * do the 'disable' for a power supply.
2388                  */
2389                 if (obp->cstat[0] & SESCTL_DISABLE) {
2390                         wrbuf16(ssc, SAFTE_WT_ACTPWS,
2391                                 idx - cc->pwroff, 0, 0, slp);
2392                 }
2393                 break;
2394         case SESTYP_FAN:
2395                 /*
2396                  * Okay- the only one that makes sense here is to
2397                  * set fan speed to zero on disable.
2398                  */
2399                 if (obp->cstat[0] & SESCTL_DISABLE) {
2400                         /* remember- fans are the first items, so idx works */
2401                         wrbuf16(ssc, SAFTE_WT_FANSPD, idx, 0, 0, slp);
2402                 }
2403                 break;
2404         case SESTYP_DOORLOCK:
2405                 /*
2406                  * Well, we can 'disable' the lock.
2407                  */
2408                 if (obp->cstat[0] & SESCTL_DISABLE) {
2409                         cc->flag2 &= ~SAFT_FLG2_LOCKDOOR;
2410                         wrbuf16(ssc, SAFTE_WT_GLOBAL, cc->flag1,
2411                                 cc->flag2, 0, slp);
2412                 }
2413                 break;
2414         case SESTYP_ALARM:
2415                 /*
2416                  * Well, we can 'disable' the alarm.
2417                  */
2418                 if (obp->cstat[0] & SESCTL_DISABLE) {
2419                         cc->flag2 &= ~SAFT_FLG1_ALARM;
2420                         ep->priv |= 0x40;       /* Muted */
2421                         wrbuf16(ssc, SAFTE_WT_GLOBAL, cc->flag1,
2422                                 cc->flag2, 0, slp);
2423                 }
2424                 break;
2425         default:
2426                 break;
2427         }
2428         ep->svalid = 0;
2429         return (0);
2430 }
2431
2432 /*
2433  * This function handles all of the 16 byte WRITE BUFFER commands.
2434  */
2435 static int
2436 wrbuf16(ses_softc_t *ssc, uint8_t op, uint8_t b1, uint8_t b2,
2437     uint8_t b3, int slp)
2438 {
2439         int err, amt;
2440         char *sdata;
2441         struct scfg *cc = ssc->ses_private;
2442         static char cdb[10] = { WRITE_BUFFER, 1, 0, 0, 0, 0, 0, 0, 16, 0 };
2443
2444         if (cc == NULL)
2445                 return (0);
2446
2447         sdata = SES_MALLOC(16);
2448         if (sdata == NULL)
2449                 return (ENOMEM);
2450
2451         SES_DLOG(ssc, "saf_wrbuf16 %x %x %x %x\n", op, b1, b2, b3);
2452
2453         sdata[0] = op;
2454         sdata[1] = b1;
2455         sdata[2] = b2;
2456         sdata[3] = b3;
2457         MEMZERO(&sdata[4], 12);
2458         amt = -16;
2459         err = ses_runcmd(ssc, cdb, 10, sdata, &amt);
2460         SES_FREE(sdata, 16);
2461         return (err);
2462 }
2463
2464 /*
2465  * This function updates the status byte for the device slot described.
2466  *
2467  * Since this is an optional SAF-TE command, there's no point in
2468  * returning an error.
2469  */
2470 static void
2471 wrslot_stat(ses_softc_t *ssc, int slp)
2472 {
2473         int i, amt;
2474         encobj *ep;
2475         char cdb[10], *sdata;
2476         struct scfg *cc = ssc->ses_private;
2477
2478         if (cc == NULL)
2479                 return;
2480
2481         SES_DLOG(ssc, "saf_wrslot\n");
2482         cdb[0] = WRITE_BUFFER;
2483         cdb[1] = 1;
2484         cdb[2] = 0;
2485         cdb[3] = 0;
2486         cdb[4] = 0;
2487         cdb[5] = 0;
2488         cdb[6] = 0;
2489         cdb[7] = 0;
2490         cdb[8] = cc->Nslots * 3 + 1;
2491         cdb[9] = 0;
2492
2493         sdata = SES_MALLOC(cc->Nslots * 3 + 1);
2494         if (sdata == NULL)
2495                 return;
2496         MEMZERO(sdata, cc->Nslots * 3 + 1);
2497
2498         sdata[0] = SAFTE_WT_DSTAT;
2499         for (i = 0; i < cc->Nslots; i++) {
2500                 ep = &ssc->ses_objmap[cc->slotoff + i];
2501                 SES_DLOG(ssc, "saf_wrslot %d <- %x\n", i, ep->priv & 0xff);
2502                 sdata[1 + (3 * i)] = ep->priv & 0xff;
2503         }
2504         amt = -(cc->Nslots * 3 + 1);
2505         ses_runcmd(ssc, cdb, 10, sdata, &amt);
2506         SES_FREE(sdata, cc->Nslots * 3 + 1);
2507 }
2508
2509 /*
2510  * This function issues the "PERFORM SLOT OPERATION" command.
2511  */
2512 static int
2513 perf_slotop(ses_softc_t *ssc, uint8_t slot, uint8_t opflag, int slp)
2514 {
2515         int err, amt;
2516         char *sdata;
2517         struct scfg *cc = ssc->ses_private;
2518         static char cdb[10] =
2519             { WRITE_BUFFER, 1, 0, 0, 0, 0, 0, 0, SAFT_SCRATCH, 0 };
2520
2521         if (cc == NULL)
2522                 return (0);
2523
2524         sdata = SES_MALLOC(SAFT_SCRATCH);
2525         if (sdata == NULL)
2526                 return (ENOMEM);
2527         MEMZERO(sdata, SAFT_SCRATCH);
2528
2529         sdata[0] = SAFTE_WT_SLTOP;
2530         sdata[1] = slot;
2531         sdata[2] = opflag;
2532         SES_DLOG(ssc, "saf_slotop slot %d op %x\n", slot, opflag);
2533         amt = -SAFT_SCRATCH;
2534         err = ses_runcmd(ssc, cdb, 10, sdata, &amt);
2535         SES_FREE(sdata, SAFT_SCRATCH);
2536         return (err);
2537 }