diff options
Diffstat (limited to 'sys/arch/hp300/stand/rd.c')
| -rw-r--r-- | sys/arch/hp300/stand/rd.c | 409 |
1 files changed, 409 insertions, 0 deletions
diff --git a/sys/arch/hp300/stand/rd.c b/sys/arch/hp300/stand/rd.c new file mode 100644 index 00000000000..e1680a8ebb5 --- /dev/null +++ b/sys/arch/hp300/stand/rd.c @@ -0,0 +1,409 @@ +/* $NetBSD: rd.c,v 1.10 1995/09/23 17:19:59 thorpej Exp $ */ + +/* + * Copyright (c) 1988 University of Utah. + * Copyright (c) 1982, 1990, 1993 + * The Regents of the University of California. All rights reserved. + * + * This code is derived from software contributed to Berkeley by + * the Systems Programming Group of the University of Utah Computer + * Science Department. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. All advertising materials mentioning features or use of this software + * must display the following acknowledgement: + * This product includes software developed by the University of + * California, Berkeley and its contributors. + * 4. Neither the name of the University nor the names of its contributors + * may be used to endorse or promote products derived from this software + * without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + * + * from: Utah Hdr: rd.c 1.20 92/12/21 + * + * @(#)rd.c 8.1 (Berkeley) 7/15/93 + */ + +/* + * CS80/SS80 disk driver + */ +#include <sys/param.h> +#include <sys/disklabel.h> +#include "stand.h" +#include "samachdep.h" + +#include <hp300/dev/rdreg.h> + +struct rd_iocmd rd_ioc; +struct rd_rscmd rd_rsc; +struct rd_stat rd_stat; +struct rd_ssmcmd rd_ssmc; + +struct disklabel rdlabel; + +struct rdminilabel { + u_short npart; + u_long offset[MAXPARTITIONS]; +}; + +struct rd_softc { + int sc_ctlr; + int sc_unit; + int sc_part; + char sc_retry; + char sc_alive; + short sc_type; + struct rdminilabel sc_pinfo; +} rd_softc[NHPIB][NRD]; + +#define RDRETRY 5 + +struct rdidentinfo { + short ri_hwid; + short ri_maxunum; + int ri_nblocks; +} rdidentinfo[] = { + { RD7946AID, 0, 108416 }, + { RD9134DID, 1, 29088 }, + { RD9134LID, 1, 1232 }, + { RD7912PID, 0, 128128 }, + { RD7914PID, 0, 258048 }, + { RD7958AID, 0, 255276 }, + { RD7957AID, 0, 159544 }, + { RD7933HID, 0, 789958 }, + { RD9134LID, 1, 77840 }, + { RD7936HID, 0, 600978 }, + { RD7937HID, 0, 1116102 }, + { RD7914CTID, 0, 258048 }, + { RD7946AID, 0, 108416 }, + { RD9134LID, 1, 1232 }, + { RD7957BID, 0, 159894 }, + { RD7958BID, 0, 297108 }, + { RD7959BID, 0, 594216 }, + { RD2200AID, 0, 654948 }, + { RD2203AID, 0, 1309896 } +}; +int numrdidentinfo = sizeof(rdidentinfo) / sizeof(rdidentinfo[0]); + +rdinit(ctlr, unit) + int ctlr, unit; +{ + register struct rd_softc *rs = &rd_softc[ctlr][unit]; + u_char stat; + + rs->sc_type = rdident(ctlr, unit); + if (rs->sc_type < 0) + return (0); + rs->sc_alive = 1; + return (1); +} + +rdreset(ctlr, unit) + register int ctlr, unit; +{ + u_char stat; + + rd_ssmc.c_unit = C_SUNIT(0); + rd_ssmc.c_cmd = C_SSM; + rd_ssmc.c_refm = REF_MASK; + rd_ssmc.c_fefm = FEF_MASK; + rd_ssmc.c_aefm = AEF_MASK; + rd_ssmc.c_iefm = IEF_MASK; + hpibsend(ctlr, unit, C_CMD, &rd_ssmc, sizeof(rd_ssmc)); + hpibswait(ctlr, unit); + hpibrecv(ctlr, unit, C_QSTAT, &stat, 1); +} + +rdident(ctlr, unit) + register int ctlr, unit; +{ + struct rd_describe desc; + u_char stat, cmd[3]; + char name[7]; + register int id, i; + + id = hpibid(ctlr, unit); + if ((id & 0x200) == 0) + return(-1); + for (i = 0; i < numrdidentinfo; i++) + if (id == rdidentinfo[i].ri_hwid) + break; + if (i == numrdidentinfo) + return(-1); + id = i; + rdreset(ctlr, unit); + cmd[0] = C_SUNIT(0); + cmd[1] = C_SVOL(0); + cmd[2] = C_DESC; + hpibsend(ctlr, unit, C_CMD, cmd, sizeof(cmd)); + hpibrecv(ctlr, unit, C_EXEC, &desc, 37); + hpibrecv(ctlr, unit, C_QSTAT, &stat, sizeof(stat)); + bzero(name, sizeof(name)); + if (!stat) { + register int n = desc.d_name; + for (i = 5; i >= 0; i--) { + name[i] = (n & 0xf) + '0'; + n >>= 4; + } + } + /* + * Take care of a couple of anomolies: + * 1. 7945A and 7946A both return same HW id + * 2. 9122S and 9134D both return same HW id + * 3. 9122D and 9134L both return same HW id + */ + switch (rdidentinfo[id].ri_hwid) { + case RD7946AID: + if (bcmp(name, "079450", 6) == 0) + id = RD7945A; + else + id = RD7946A; + break; + + case RD9134LID: + if (bcmp(name, "091340", 6) == 0) + id = RD9134L; + else + id = RD9122D; + break; + + case RD9134DID: + if (bcmp(name, "091220", 6) == 0) + id = RD9122S; + else + id = RD9134D; + break; + } + return(id); +} + +#ifdef COMPAT_NOLABEL +int rdcyloff[][8] = { + { 1, 143, 0, 143, 0, 0, 323, 503, }, /* 7945A */ + { 1, 167, 0, 0, 0, 0, 0, 0, }, /* 9134D */ + { 0, 0, 0, 0, 0, 0, 0, 0, }, /* 9122S */ + { 0, 71, 0, 221, 292, 542, 221, 0, }, /* 7912P */ + { 1, 72, 0, 72, 362, 802, 252, 362, }, /* 7914P */ + { 1, 28, 0, 140, 167, 444, 140, 721, }, /* 7933H */ + { 1, 200, 0, 200, 0, 0, 450, 600, }, /* 9134L */ + { 1, 105, 0, 105, 380, 736, 265, 380, }, /* 7957A */ + { 1, 65, 0, 65, 257, 657, 193, 257, }, /* 7958A */ + { 1, 128, 0, 128, 518, 918, 388, 518, }, /* 7957B */ + { 1, 44, 0, 44, 174, 496, 131, 174, }, /* 7958B */ + { 1, 44, 0, 44, 218, 1022,174, 218, }, /* 7959B */ + { 1, 37, 0, 37, 183, 857, 147, 183, }, /* 2200A */ + { 1, 19, 0, 94, 112, 450, 94, 788, }, /* 2203A */ + { 1, 20, 0, 98, 117, 256, 98, 397, }, /* 7936H */ + { 1, 11, 0, 53, 63, 217, 53, 371, }, /* 7937H */ +}; + +struct rdcompatinfo { + int nbpc; + int *cyloff; +} rdcompatinfo[] = { + NRD7945ABPT*NRD7945ATRK, rdcyloff[0], + NRD9134DBPT*NRD9134DTRK, rdcyloff[1], + NRD9122SBPT*NRD9122STRK, rdcyloff[2], + NRD7912PBPT*NRD7912PTRK, rdcyloff[3], + NRD7914PBPT*NRD7914PTRK, rdcyloff[4], + NRD7958ABPT*NRD7958ATRK, rdcyloff[8], + NRD7957ABPT*NRD7957ATRK, rdcyloff[7], + NRD7933HBPT*NRD7933HTRK, rdcyloff[5], + NRD9134LBPT*NRD9134LTRK, rdcyloff[6], + NRD7936HBPT*NRD7936HTRK, rdcyloff[14], + NRD7937HBPT*NRD7937HTRK, rdcyloff[15], + NRD7914PBPT*NRD7914PTRK, rdcyloff[4], + NRD7945ABPT*NRD7945ATRK, rdcyloff[0], + NRD9122SBPT*NRD9122STRK, rdcyloff[2], + NRD7957BBPT*NRD7957BTRK, rdcyloff[9], + NRD7958BBPT*NRD7958BTRK, rdcyloff[10], + NRD7959BBPT*NRD7959BTRK, rdcyloff[11], + NRD2200ABPT*NRD2200ATRK, rdcyloff[12], + NRD2203ABPT*NRD2203ATRK, rdcyloff[13], +}; +int nrdcompatinfo = sizeof(rdcompatinfo) / sizeof(rdcompatinfo[0]); +#endif + +char io_buf[MAXBSIZE]; + +rdgetinfo(rs) + register struct rd_softc *rs; +{ + register struct rdminilabel *pi = &rs->sc_pinfo; + register struct disklabel *lp = &rdlabel; + char *msg, *getdisklabel(); + int rdstrategy(), err; + size_t i; + + bzero((caddr_t)lp, sizeof *lp); + lp->d_secsize = DEV_BSIZE; + if (err = rdstrategy(rs, F_READ, + LABELSECTOR, + lp->d_secsize ? lp->d_secsize : DEV_BSIZE, + io_buf, &i) < 0) { + printf("rdgetinfo: rdstrategy error %d\n", err); + return(0); + } + + msg = getdisklabel(io_buf, lp); + if (msg) { + printf("rd(%d,%d,%d): WARNING: %s, ", + rs->sc_ctlr, rs->sc_unit, rs->sc_part, msg); +#ifdef COMPAT_NOLABEL + { + register struct rdcompatinfo *ci; + + printf("using old default partitioning\n"); + ci = &rdcompatinfo[rs->sc_type]; + pi->npart = 8; + for (i = 0; i < pi->npart; i++) + pi->offset[i] = ci->cyloff[i] * ci->nbpc; + } +#else + printf("defining `c' partition as entire disk\n"); + pi->npart = 3; + pi->offset[0] = pi->offset[1] = -1; + pi->offset[2] = 0; +#endif + } else { + pi->npart = lp->d_npartitions; + for (i = 0; i < pi->npart; i++) + pi->offset[i] = lp->d_partitions[i].p_size == 0 ? + -1 : lp->d_partitions[i].p_offset; + } + return(1); +} + +rdopen(f, ctlr, unit, part) + struct open_file *f; + int ctlr, unit, part; +{ + register struct rd_softc *rs; + struct rdinfo *ri; + + if (ctlr >= NHPIB || hpibalive(ctlr) == 0) + return (EADAPT); + if (unit >= NRD) + return (ECTLR); + rs = &rd_softc[ctlr][unit]; + rs->sc_part = part; + rs->sc_unit = unit; + rs->sc_ctlr = ctlr; + if (rs->sc_alive == 0) { + if (rdinit(ctlr, unit) == 0) + return (ENXIO); + if (rdgetinfo(rs) == 0) + return (ERDLAB); + } + if (part >= rs->sc_pinfo.npart || rs->sc_pinfo.offset[part] == -1) + return (EPART); + f->f_devdata = (void *)rs; + return (0); +} + +rdclose(f) + struct open_file *f; +{ + struct rd_softc *rs = f->f_devdata; + + /* + * Mark the disk `not alive' so that the disklabel + * will be re-loaded at next open. + */ + bzero(rs, sizeof(struct rd_softc)); + f->f_devdata = NULL; + + return (0); +} + +rdstrategy(devdata, func, dblk, size, v_buf, rsize) + void *devdata; + int func; + daddr_t dblk; + size_t size; + void *v_buf; + size_t *rsize; +{ + char *buf = v_buf; + struct rd_softc *rs = devdata; + register int ctlr = rs->sc_ctlr; + register int unit = rs->sc_unit; + daddr_t blk = (dblk + rs->sc_pinfo.offset[rs->sc_part]); + char stat; + + if (size == 0) + return(0); + + rs->sc_retry = 0; + rd_ioc.c_unit = C_SUNIT(0); + rd_ioc.c_volume = C_SVOL(0); + rd_ioc.c_saddr = C_SADDR; + rd_ioc.c_hiaddr = 0; + rd_ioc.c_addr = RDBTOS(blk); + rd_ioc.c_nop2 = C_NOP; + rd_ioc.c_slen = C_SLEN; + rd_ioc.c_len = size; + rd_ioc.c_cmd = func == F_READ ? C_READ : C_WRITE; +retry: + hpibsend(ctlr, unit, C_CMD, &rd_ioc.c_unit, sizeof(rd_ioc)-2); + hpibswait(ctlr, unit); + hpibgo(ctlr, unit, C_EXEC, buf, size, func); + hpibswait(ctlr, unit); + hpibrecv(ctlr, unit, C_QSTAT, &stat, 1); + if (stat) { + if (rderror(ctlr, unit, rs->sc_part) == 0) + return(-1); + if (++rs->sc_retry > RDRETRY) + return(-1); + goto retry; + } + *rsize = size; + + return(0); +} + +rderror(ctlr, unit, part) + register int ctlr, unit; + int part; +{ + register struct rd_softc *rd = &rd_softc[ctlr][unit]; + char stat; + + rd_rsc.c_unit = C_SUNIT(0); + rd_rsc.c_sram = C_SRAM; + rd_rsc.c_ram = C_RAM; + rd_rsc.c_cmd = C_STATUS; + hpibsend(ctlr, unit, C_CMD, &rd_rsc, sizeof(rd_rsc)); + hpibrecv(ctlr, unit, C_EXEC, &rd_stat, sizeof(rd_stat)); + hpibrecv(ctlr, unit, C_QSTAT, &stat, 1); + if (stat) { + printf("rd(%d,%d,0,%d): request status fail %d\n", + ctlr, unit, part, stat); + return(0); + } + printf("rd(%d,%d,0,%d) err: vu 0x%x", + ctlr, unit, part, rd_stat.c_vu); + if ((rd_stat.c_aef & AEF_UD) || (rd_stat.c_ief & (IEF_MD|IEF_RD))) + printf(", block %d", rd_stat.c_blk); + printf(", R0x%x F0x%x A0x%x I0x%x\n", + rd_stat.c_ref, rd_stat.c_fef, rd_stat.c_aef, rd_stat.c_ief); + return(1); +} |