/*
* Written by grefen@?????
* Based on scsi drivers by Julian Elischer (julian@tfs.com)
*
* $Id: ch.c,v 1.20 1995/05/11 19:26:46 rgrimes Exp $
*/
#include <sys/types.h>
#include <ch.h>
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/errno.h>
#include <sys/ioctl.h>
#include <sys/buf.h>
#include <sys/proc.h>
#include <sys/user.h>
#include <sys/chio.h>
#include <sys/malloc.h>
#include <scsi/scsi_all.h>
#include <scsi/scsi_changer.h>
#include <scsi/scsiconf.h>
#include <sys/devconf.h>
errval ch_getelem __P((u_int32 unit, short *stat, int type, u_int32 from,
void *data, u_int32 flags));
errval ch_move __P((u_int32 unit, short *stat, u_int32 chm, u_int32 from,
u_int32 to, u_int32 flags));
static errval ch_mode_sense __P((u_int32 unit, u_int32 flags));
errval ch_position __P((u_int32 unit, short *stat, u_int32 chm, u_int32 to,
u_int32 flags));
#define CHRETRIES 2
#define CHUNIT(DEV) ((minor(DEV)&0xF0) >> 4) /* 4 bit unit. */
#define CHSETUNIT(DEV, U) makedev(major(DEV), ((U) << 4))
#define MODE(z) ( (minor(z) & 0x0F) )
#define ESUCCESS 0
struct scsi_data {
u_int32 flags;
u_int16 chmo; /* Offset of first CHM */
u_int16 chms; /* No. of CHM */
u_int16 slots; /* No. of Storage Elements */
u_int16 sloto; /* Offset of first SE */
u_int16 imexs; /* No. of Import/Export Slots */
u_int16 imexo; /* Offset of first IM/EX */
u_int16 drives; /* No. of CTS */
u_int16 driveo; /* Offset of first CTS */
u_int16 rot; /* CHM can rotate */
u_long op_matrix; /* possible opertaions */
u_int16 lsterr; /* details of lasterror */
u_char stor; /* posible Storage locations */
};
static int chunit(dev_t dev) { return CHUNIT(dev); }
static dev_t chsetunit(dev_t dev, int unit) { return CHSETUNIT(dev, unit); }
errval ch_open(dev_t dev, int flags, int fmt, struct proc *p,
struct scsi_link *sc_link);
errval ch_ioctl(dev_t dev, int cmd, caddr_t addr, int flag,
struct proc *p, struct scsi_link *sc_link);
errval ch_close(dev_t dev, int flag, int fmt, struct proc *p,
struct scsi_link *sc_link);
SCSI_DEVICE_ENTRIES(ch)
struct scsi_device ch_switch =
{
NULL,
NULL,
NULL,
NULL,
"ch",
0,
{0, 0},
0, /* Link flags */
chattach,
"Medium-Changer",
chopen,
sizeof(struct scsi_data),
T_CHANGER,
chunit,
chsetunit,
ch_open,
ch_ioctl,
ch_close,
0,
};
#define CH_OPEN 0x01
static int
ch_externalize(struct proc *p, struct kern_devconf *kdc, void *userp,
size_t len)
{
return scsi_externalize(SCSI_LINK(&ch_switch, kdc->kdc_unit),
userp, &len);
}
static struct kern_devconf kdc_ch_template = {
0, 0, 0, /* filled in by dev_attach */
"ch", 0, MDDC_SCSI,
ch_externalize, 0, scsi_goaway, SCSI_EXTERNALLEN,
&kdc_scbus0, /* parent */
0, /* parentdata */
DC_UNKNOWN, /* not supported */
};
static inline void
ch_registerdev(int unit)
{
struct kern_devconf *kdc;
MALLOC(kdc, struct kern_devconf *, sizeof *kdc, M_TEMP, M_NOWAIT);
if(!kdc) return;
*kdc = kdc_ch_template;
kdc->kdc_unit = unit;
kdc->kdc_description = ch_switch.desc;
dev_attach(kdc);
}
/*
* The routine called by the low level scsi routine when it discovers
* a device suitable for this driver.
*/
errval
chattach(struct scsi_link *sc_link)
{
u_int32 unit;
struct scsi_data *ch = sc_link->sd;
unit = sc_link->dev_unit;
/*
* Use the subdriver to request information regarding
* the drive. We cannot use interrupts yet, so the
* request must specify this.
*/
if ((ch_mode_sense(unit, SCSI_NOSLEEP | SCSI_NOMASK /*| SCSI_SILENT */ ))) {
printf("offline");
} else {
printf("%d slot(s) %d drive(s) %d arm(s) %d i/e-slot(s)",
ch->slots, ch->drives, ch->chms, ch->imexs);
}
ch_registerdev(unit);
return 0;
}
/*
* open the device.
*/
errval
ch_open(dev_t dev, int flags, int fmt, struct proc *p,
struct scsi_link *sc_link)
{
errval errcode = 0;
u_int32 unit, mode;
struct scsi_data *cd;
unit = CHUNIT(dev);
mode = MODE(dev);
cd = sc_link->sd;
/*
* Only allow one at a time
*/
if (cd->flags & CH_OPEN) {
printf("ch%ld: already open\n", unit);
return EBUSY;
}
/*
* Catch any unit attention errors.
*/
scsi_test_unit_ready(sc_link, SCSI_SILENT);
sc_link->flags |= SDEV_OPEN;
/*
* Check that it is still responding and ok.
*/
if ( (errcode = (scsi_test_unit_ready(sc_link, 0))) ) {
printf("ch%ld: not ready\n", unit);
sc_link->flags &= ~SDEV_OPEN;
return errcode;
}
/*
* Make sure data is loaded
*/
if ( (errcode = (ch_mode_sense(unit, SCSI_NOSLEEP | SCSI_NOMASK))) ) {
printf("ch%ld: scsi changer :- offline\n", unit);
sc_link->flags &= ~SDEV_OPEN;
return (errcode);
}
cd->flags = CH_OPEN;
return 0;
}
/*
* close the device.. only called if we are the LAST
* occurence of an open device
*/
errval
ch_close(dev_t dev, int flag, int fmt, struct proc *p,
struct scsi_link *sc_link)
{
sc_link->sd->flags = 0;
sc_link->flags &= ~SDEV_OPEN;
return (0);
}
/*
* Perform special action on behalf of the user
* Knows about the internals of this device
*/
errval
ch_ioctl(dev_t dev, int cmd, caddr_t arg, int mode,
struct proc *p, struct scsi_link *sc_link)
{
/* struct ch_cmd_buf *args; */
unsigned char unit;
u_int32 flags;
errval ret;
struct scsi_data *cd;
/*
* Find the device that the user is talking about
*/
flags = 0; /* give error messages, act on errors etc. */
unit = CHUNIT(dev);
cd = sc_link->sd;
switch ((int)cmd) {
case CHIOOP:{
struct chop *ch = (struct chop *) arg;
SC_DEBUG(sc_link, SDEV_DB2,
("[chtape_chop: %x]\n", ch->ch_op));
switch ((short) (ch->ch_op)) {
case CHGETPARAM:
ch->u.getparam.chmo = cd->chmo;
ch->u.getparam.chms = cd->chms;
ch->u.getparam.sloto = cd->sloto;
ch->u.getparam.slots = cd->slots;
ch->u.getparam.imexo = cd->imexo;
ch->u.getparam.imexs = cd->imexs;
ch->u.getparam.driveo = cd->driveo;
ch->u.getparam.drives = cd->drives;
ch->u.getparam.rot = cd->rot;
ch->result = 0;
return 0;
break;
case CHPOSITION:
return ch_position(unit, &ch->result, ch->u.position.chm,
ch->u.position.to,
flags);
case CHMOVE:
return ch_move(unit, &ch->result, ch->u.position.chm,
ch->u.move.from, ch->u.move.to,
flags);
case CHGETELEM:
return ch_getelem(unit, &ch->result, ch->u.get_elem_stat.type,
ch->u.get_elem_stat.from, &ch->u.get_elem_stat.elem_data,
flags);
default:
return EINVAL;
}
}
default:
return scsi_do_ioctl(dev, cmd, arg, mode, p, sc_link);
}
return (ret ? ESUCCESS : EIO);
}
errval
ch_getelem(unit, stat, type, from, data, flags)
u_int32 unit, from, flags;
int type;
short *stat;
void *data; /* XXX `struct untagged *' - see chio.h */
{
struct scsi_read_element_status scsi_cmd;
char elbuf[32];
errval ret;
struct scsi_link *sc_link;
if ((sc_link = SCSI_LINK(&ch_switch, unit)) == 0)
return ENXIO;
bzero(&scsi_cmd, sizeof(scsi_cmd));
scsi_cmd.op_code = READ_ELEMENT_STATUS;
scsi_cmd.byte2 = type;
scsi_cmd.starting_element_addr[0] = (from >> 8) & 0xff;
scsi_cmd.starting_element_addr[1] = from & 0xff;
scsi_cmd.number_of_elements[1] = 1;
scsi_cmd.allocation_length[2] = 32;
if ((ret = scsi_scsi_cmd(sc_link,
(struct scsi_generic *) &scsi_cmd,
sizeof(scsi_cmd),
(u_char *) elbuf,
32,
CHRETRIES,
100000,
NULL,
SCSI_DATA_IN | flags) != ESUCCESS)) {
*stat = sc_link->sd->lsterr;
bcopy(elbuf + 16, data, 16);
return ret;
}
bcopy(elbuf + 16, data, 16); /*Just a hack sh */
return ret;
}
errval
ch_move(unit, stat, chm, from, to, flags)
u_int32 unit, chm, from, to, flags;
short *stat;
{
struct scsi_move_medium scsi_cmd;
errval ret;
struct scsi_link *sc_link;
if ((sc_link = SCSI_LINK(&ch_switch, unit)) == 0)
return ENXIO;
bzero(&scsi_cmd, sizeof(scsi_cmd));
scsi_cmd.op_code = MOVE_MEDIUM;
scsi_cmd.transport_element_address[0] = (chm >> 8) & 0xff;
scsi_cmd.transport_element_address[1] = chm & 0xff;
scsi_cmd.source_address[0] = (from >> 8) & 0xff;
scsi_cmd.source_address[1] = from & 0xff;
scsi_cmd.destination_address[0] = (to >> 8) & 0xff;
scsi_cmd.destination_address[1] = to & 0xff;
scsi_cmd.invert = (chm & CH_INVERT) ? 1 : 0;
if ((ret = scsi_scsi_cmd(sc_link,
(struct scsi_generic *) &scsi_cmd,
sizeof(scsi_cmd),
NULL,
0,
CHRETRIES,
100000,
NULL,
flags) != ESUCCESS)) {
*stat = sc_link->sd->lsterr;
return ret;
}
return ret;
}
errval
ch_position(unit, stat, chm, to, flags)
u_int32 unit, chm, to, flags;
short *stat;
{
struct scsi_position_to_element scsi_cmd;
errval ret;
struct scsi_link *sc_link;
if ((sc_link = SCSI_LINK(&ch_switch, unit)) == 0)
return ENXIO;
bzero(&scsi_cmd, sizeof(scsi_cmd));
scsi_cmd.op_code = POSITION_TO_ELEMENT;
scsi_cmd.transport_element_address[0] = (chm >> 8) & 0xff;
scsi_cmd.transport_element_address[1] = chm & 0xff;
scsi_cmd.source_address[0] = (to >> 8) & 0xff;
scsi_cmd.source_address[1] = to & 0xff;
scsi_cmd.invert = (chm & CH_INVERT) ? 1 : 0;
if ((ret = scsi_scsi_cmd(sc_link,
(struct scsi_generic *) &scsi_cmd,
sizeof(scsi_cmd),
NULL,
0,
CHRETRIES,
100000,
NULL,
flags) != ESUCCESS)) {
*stat = sc_link->sd->lsterr;
return ret;
}
return ret;
}
#ifdef __STDC__
#define b2tol(a) (((unsigned)(a##_1) << 8) + (unsigned)a##_0 )
#else
#define b2tol(a) (((unsigned)(a/**/_1) << 8) + (unsigned)a/**/_0 )
#endif
/*
* Get the scsi driver to send a full inquiry to the
* device and use the results to fill out the global
* parameter structure.
*/
static errval
ch_mode_sense(unit, flags)
u_int32 unit, flags;
{
struct scsi_mode_sense scsi_cmd;
u_char scsi_sense[128]; /* Can't use scsi_mode_sense_data because of
* missing block descriptor
*/
u_char *b;
int32 i, l;
errval errcode;
struct scsi_data *cd;
struct scsi_link *sc_link;
if ((sc_link = SCSI_LINK(&ch_switch, unit)) == 0)
return ENXIO;
cd = sc_link->sd;
/*
* First check if we have it all loaded
*/
if (sc_link->flags & SDEV_MEDIA_LOADED)
return 0;
/*
* First do a mode sense
*/
/* sc_link->flags &= ~SDEV_MEDIA_LOADED; *//*XXX */
bzero(&scsi_cmd, sizeof(scsi_cmd));
scsi_cmd.op_code = MODE_SENSE;
scsi_cmd.byte2 = SMS_DBD;
scsi_cmd.page = 0x3f; /* All Pages */
scsi_cmd.length = sizeof(scsi_sense);
/*
* Read in the pages
*/
if ( (errcode = scsi_scsi_cmd(sc_link,
(struct scsi_generic *) &scsi_cmd,
sizeof(struct scsi_mode_sense),
(u_char *) & scsi_sense,
sizeof (scsi_sense),
CHRETRIES,
5000,
NULL,
flags | SCSI_DATA_IN) != 0) ) {
if (!(flags & SCSI_SILENT))
printf("ch%ld: could not mode sense\n", unit);
return (errcode);
}
sc_link->flags |= SDEV_MEDIA_LOADED;
l = scsi_sense[0] - 3;
b = &scsi_sense[4];
/*
* To avoid alignment problems
*/
/* XXX - FIX THIS FOR MSB */
#define p2copy(valp) (valp[1]+ (valp[0]<<8));valp+=2
#define p4copy(valp) (valp[3]+ (valp[2]<<8) + (valp[1]<<16) + (valp[0]<<24));valp+=4
#if 0
printf("\nmode_sense %d\n", l);
for (i = 0; i < l + 4; i++) {
printf("%x%c", scsi_sense[i], i % 8 == 7 ? '\n' : ':');
} printf("\n");
#endif
for (i = 0; i < l;) {
u_int32 pc = (*b++) & 0x3f;
u_int32 pl = *b++;
u_char *bb = b;
switch ((int)pc) {
case 0x1d:
cd->chmo = p2copy(bb);
cd->chms = p2copy(bb);
cd->sloto = p2copy(bb);
cd->slots = p2copy(bb);
cd->imexo = p2copy(bb);
cd->imexs = p2copy(bb);
cd->driveo = p2copy(bb);
cd->drives = p2copy(bb);
break;
case 0x1e:
cd->rot = (*b) & 1;
break;
case 0x1f:
cd->stor = *b & 0xf;
bb += 2;
cd->stor = p4copy(bb);
break;
default:
break;
}
b += pl;
i += pl + 2;
}
SC_DEBUG(sc_link, SDEV_DB2,
(" cht(%d-%d)slot(%d-%d)imex(%d-%d)cts(%d-%d) %s rotate\n",
cd->chmo, cd->chms,
cd->sloto, cd->slots,
cd->imexo, cd->imexs,
cd->driveo, cd->drives,
cd->rot ? "can" : "can't"));
return (0);
}
