+# define RP6CYL 815 /* no. RP06 cylinders/pack */
+# define RP6TRK 19 /* no. tracks/cyl */
+# define RP6SEC 22 /* no. sectors/track */
+# define RP6ST (rptrk*rpsec) /* no. sectors/cyl */
+# define MAXSEC (rpcyl*rptrk*rpsec) /* sectors/pack */
+# define M0 0x20010000 /* phys addr MBA 0 */
+# define M_st 2 /* offset for MBA status reg */
+# define M0_cr (M0+4) /* MBA 0 control reg addr */
+# define M0_map (M0+0x800) /* start MBA 0 map reg's */
+# define M0_var (M0+0xc) /* MBA 0 virt addr reg */
+# define M0_bc (M0+0x10) /* MBA 0 byte count reg */
+# define MBAinit 01 /* MBA init bit */
+# define M_DTC 0x2000 /* Data Transfer Complete */
+/* */
+# define RP (M0+0x400) /* base for RP06 reg's, drive 0 */
+/* */
+# define RP_cr 0 /* RP06 control reg offset, longword */
+# define RP_sr 1 /* RP06 status reg offset */
+# define RP_er1 2 /* RP06 error reg 1 */
+# define RP_stk 5 /* RP06 sector/track reg offset */
+# define RP_typ 06 /* disk type reg */
+# define RP_off 011 /* RP offset reg */
+# define RP_cyl 10 /* RP06 cylinder reg offset */
+# define RP_Epos 016 /* RP ECC position reg */
+# define RP_Epat 017 /* RP ECC pattern reg */
+/* */
+# define RP_GO 1 /* go bit */
+# define RP_RD 070 /* RP06 read function code */
+# define RP_WR 060 /* RP06 write function code */
+# define RP_DC 010 /* drive clear function code */
+# define RP_FMT 0x1000 /* format bit in RP offset reg */
+# define RP_RIP 020 /* Read-in Preset function code */
+# define RP_MOL 0x1000 /* medium online bit in status */
+# define RP_DRY 0200 /* drive ready, status reg */
+# define RP_ERR 040000 /* composite error, status reg */
+# define RP_DCK 0x8000 /* Data Check Error in ERR1 reg */
+# define RP_ECH 0x40 /* ECC hard error */
+/* */
+# define RXCS 32 /* receiver control/staus */
+# define RXDB 33 /* receiver data */
+# define TXCS 34 /* transmitter control/status */
+# define TXDB 35 /* transmitter data */
+# define RXCS_DONE 0x80 /* receiver done */
+# define TXCS_RDY 0x80 /* transmitter ready */
+/* */
+# define BLKSIZ 512
+# define NB 128 /* max. byte transfer = 64K bytes */
+# define BUFSIZ (NB*BLKSIZ)
+# define MAXUNI 1
+# define MAXERR 10 /* max. no. i/o errors allowed */
+# define NL 012
+# define CR 015
+# define CDEL 0x23
+# define LDEL 0x40
+/* */
+# define RM3CYL 823 /* RM03 */
+# define RM3TRK 5
+# define RM3SEC 32
+# define RP6typ 022
+# define RM3typ 024
+
+struct { int reg ; } ;
+int dinoff , douoff , dblks , count , ecount , daterr ;
+char *bufptr ;
+unsigned int page ;
+int *RPin , *RPout ;
+int rpsec,rptrk,rpcyl;
+char input[132] ;
+
+main() {
+/*
+* Stand-alone program to copy rp06/RM03 disk to rp06/RM03 disk, same or
+* different drives. User specifies input and output disk, no.
+* of 512-byte blocks, and disk offsets.
+*/
+register int i , error ;
+
+putlin("d2dcpy : Disk-to-Disk Copy") ;
+putnl() ;
+
+d1u :
+
+putstr("input disk unit : ") ;
+getcon(input) ;
+i = a2l(input) ;
+if (i < 0) goto fini ;
+if (i > MAXUNI) goto d1u ;
+RPin = RP + (i * 32 * 4) ;
+
+dof1 :
+
+putstr("offset : ") ;
+getcon(input) ;
+dinoff = a2l(input) ;
+
+d2u :
+
+putstr("output disk unit : ") ;
+getcon(input) ;
+i = a2l(input) ;
+if ((i > MAXUNI) || (i < 0)) goto d2u ;
+RPout = RP + (i * 32 * 4) ;
+
+dof2 :
+
+putstr("offset : ") ;
+getcon(input) ;
+douoff = a2l(input) ;
+
+gknt :
+
+putstr("no. 512-byte blocks : ") ;
+getcon(input) ;
+count = a2l(input) ;
+
+error = 0 ;
+
+if (init()) {
+ putlin("init error") ;
+ goto d1u ;
+ }
+
+if ((dinoff < 0) || (dinoff > MAXSEC-1)) goto dof1 ;
+if ((douoff < 0) || (douoff > MAXSEC-1)) goto dof2 ;
+if (count < 0) goto gknt ;
+if (count == 0) count = MAXSEC ;
+
+ecount = daterr = 0 ;
+while ((error == 0) && (count>0)) {
+ if (dread()) {
+ dioerr :
+ putlin("disc i/o error") ;
+ error++ ;
+ continue ;
+ }
+ if (dwrite()) goto dioerr ;
+ count -= dblks ;/* dec no. blocks read */
+ }
+
+fini :
+
+putstr("# Data Check Errors : ") ;
+l2x(daterr,input) ;
+putlin(input) ;
+putstr("# Other errors : ") ;
+l2x(ecount,input) ;
+putlin(input) ;
+
+return(0) ;
+}
+
+/* */
+
+putstr(csp)
+register char *csp ;
+{
+if (putcon(csp)) return(-1) ;
+return(0) ;
+}
+
+/* */
+
+putlin(sptr)
+register char *sptr ;
+{
+if (putcon(sptr)) return(-1) ;
+if (putnl()) return(-1) ;
+return(0) ;
+}
+
+/* */
+
+putnl()
+{
+if (putcon("\r\n")) return(-1) ;
+return(0) ;
+}
+
+/* */
+
+putcon(csp)
+register char *csp ;
+{
+/*
+* Function to output null-terminated string pointed to
+* by 'csp' to the VAX LSI terminal.
+*/
+register c ;
+
+c = 0 ;
+while (c = (*csp++)) putc(c) ;
+return(0) ;
+}
+
+/* */
+
+putc(c)
+{
+/* wait for LSI printer to be ready */
+while ((mfpr(TXCS) & TXCS_RDY) == 0) ;
+/* output character */
+mtpr(TXDB,c&0177) ;
+}
+
+/* */
+
+getcon(cs)
+register char *cs ;
+{
+/*
+* Function to return char's from VAX LSI keyboard to
+* char array 'cs' - input stops when CR or LF received -
+* null char appended to end of input
+*/
+register int c , c2 ;
+int getc() ;
+char *ocs;
+
+ ocs=cs;
+inloop :
+ c = getc() ; /* get 1 char from terminal */
+ putc(c) ; /* echo char */
+ if (c==CDEL) { --cs; goto inloop; }
+ if (c==LDEL){ putc(NL);putc(0);putc(CR);cs=ocs;goto inloop;}
+ if ((c == NL) || (c == CR)) {
+ putc(CR) ;
+ putc(0) ;
+ putc(NL) ;
+ (*cs++) = '\0' ;
+ return(0) ;
+ }
+ else {
+ (*cs++) = c ;
+ goto inloop ;
+ }
+}
+
+/* */
+
+getc()
+{
+/*
+* Return char from VAX LSI terminal char buffer
+*/
+int mfpr() ;
+
+/* Wait for receiver done (user entered char)
+*/
+while ((mfpr(RXCS) & RXCS_DONE) == 0) ;
+return (mfpr(RXDB) & 0177) ; /* return char from receiver buffer */
+}
+
+/* */
+
+mtpr(regno,value)
+{
+ asm(" mtpr 8(ap),4(ap)") ;
+}
+
+/* */
+
+mfpr(regno)
+{
+ asm(" mfpr 4(ap),r0") ;
+}
+
+/* */
+
+a2l(as)
+register char *as ;
+{
+/*
+* Convert null-terminated ascii string to binary
+* and return value.
+* 1st char in string :
+* 0 -> octal
+* x -> hex
+* else decimal
+*/
+register value , base , sign , digit ;
+
+digit = value = sign = 0 ;
+base = 10 ; /* default base */
+
+aloop :
+if ((digit = (*as++)) == 0) return(value) ; /* null */
+
+if (digit == '-') {
+ sign++ ;
+ goto aloop ;
+ }
+
+if (digit == '0') base = 8 ; /* octal base */
+else { if (digit == 'x') base = 16 ; /* hex base */
+ else value = (digit-060) ; /* 060 = '0' */
+ }
+
+while (digit = (*as++)) {
+ if (digit < '0') return(0) ;
+ switch (base) {
+ case 8 : {
+ if (digit > '7') return(0) ;
+ digit -= 060 ;
+ break ;
+ }
+ case 10 : {
+ if (digit > '9') return(0) ;
+ digit -= 060 ;
+ break ;
+ }
+ case 16 : {
+ if (digit <= '9') {
+ digit -= 060 ;
+ break ;
+ }
+ if ((digit >= 'A') && (digit <= 'F')) {
+ digit = (digit - 0101 + 10) ;
+ break ;
+ }
+ if ((digit >= 'a') && (digit <= 'f')) {
+ digit = digit - 0141 + 10 ;
+ break ;
+ }
+ return(0) ;
+ break ;
+ }
+ }
+ value = (value * base) + digit ;
+ }
+return (sign ? -value : value) ;
+}
+
+/* */
+
+init() {
+/*
+* Initialization.
+* Initialize MBA 0 for disk i/o.
+* Set up MBA 0 map registers to map a max.
+* transfer of 'BUFSIZ' bytes.
+*/
+register int *mp0 , i ;
+extern char *end ;
+
+M0_cr->reg = MBAinit ;
+dblks = BUFSIZ/BLKSIZ ; /* no. of disk blocks / input buffer */
+
+if ((*(RPin+RP_sr) & RP_MOL) == 0) {
+ putlin("input unit not online") ;
+ return(-1) ;
+ }
+
+*(RPin+RP_cr) = RP_RIP | RP_GO ; /* preset */
+*(RPin+RP_off) = RP_FMT ; /* set format bit */
+
+if (RPin != RPout) {
+ if ((*(RPout + RP_sr) & RP_MOL) == 0) {
+ putlin("output unit not online") ;
+ return(-1) ;
+ }
+ *(RPout+RP_cr) = RP_RIP | RP_GO ;
+ *(RPout+RP_off) = RP_FMT ;
+ }
+
+i = *(RPout+RP_typ)&0777 ; /* get disk type */
+if (i==RP6typ) { /* RP06 */
+ rpsec=RP6SEC; rpcyl=RP6CYL; rptrk=RP6TRK;
+ }
+else {
+ if (i==RM3typ) {
+ rpsec=RM3SEC; rpcyl=RM3CYL; rptrk=RM3TRK;
+ }
+ else return(-1);
+ }
+
+bufptr = (int)(&end + 511) & 017777777000 ;
+page = (int)((int)bufptr>>9) & 017777777 ;
+mp0 = M0_map ; /* phys addr of MBA 0 map reg base */
+
+i = NB ;
+
+while (i--)
+ (*mp0++)= 0x80000000 | page++ ; /* map entry */
+
+return(0);
+}
+
+/* */
+
+dread()
+{
+/*
+* Function to read 'BUFSIZ' bytes (512 multiple) from disc
+* to buffer .
+*/
+register int i , j ;
+
+*(RPin+RP_cyl) = dinoff/RP6ST ; /* cylinder no. */
+i = dinoff%RP6ST ;
+j = (i/rpsec)<<8 ; /* track */
+*(RPin+RP_stk) = j | (i%rpsec) ; /* sector : track */
+dinoff += dblks ; /* point to next disc sector */
+M0_bc->reg = (count<dblks?-(count*512):(-BUFSIZ)) ; /* byte count */
+M0_var->reg = 0 ; /* virt addr reg = map no. + byte off */
+rbit :
+*(RPin+RP_cr) = RP_DC | RP_GO ; /* drive clear */
+dwait(RPin) ;
+*(RPin+RP_cr) = RP_RD | RP_GO ; /* read */
+
+dwait(RPin) ; /* wait for i/o to finish */
+if (i = mbaerr(M0)) {
+ /* don't abort on MBA errors - 'mbaerr()' has cleared
+ MBA status reg */
+ }
+
+if (i = derror(RPin)) { /* error */
+ putlin("- - - - - -") ;
+ putstr("read error") ;
+ stmes(i) ;
+ dadmes(RPin) ;
+ if (i & RP_DCK) { /* Data Check Error */
+ daterr++ ;
+ putlin("Data Check") ;
+ if (i & RP_ECH) { /* ECC Hard Error */
+ putlin("ECC non-recov") ;
+ ecount++ ;
+ }
+ else { /* ECC Recoverable */
+ ECCrcv(RPin) ;
+ }
+ if (M0_bc->reg) { /* more i-o to finish ? */
+ j = (*(RPin+RP_stk));
+ i = (j>>8) & 0x1f;
+ j = j & 0x1f;
+ if (j>=rpsec) /*sector */
+ j = 0;
+ if (i>=rptrk) /* track */
+ i = 0;
+ *(RPin+RP_stk) = (i<<8) | j;
+ goto rbit ; /* staus reg cleared by 'Drive Clear' */
+ }
+ else {
+ *(RPin+RP_cr) = RP_DC | RP_GO;
+ mbaerr(M0);
+ }
+ }
+ else { /* non-Data Check error */
+ ecount++ ;
+ }
+ if (ecount > MAXERR) return(-1) ;
+ }
+return(0) ; /* normal return */
+}
+
+/* */
+
+dwrite()
+{
+/*
+* Function to write 'BUFSIZ' bytes (512 multiple) to disc
+* from buffer .
+*/
+register int i , j ;
+
+*(RPout+RP_cr) = RP_DC | RP_GO ;
+*(RPout+RP_cyl) = douoff/RP6ST;
+i = douoff%RP6ST ;
+j = (i/rpsec)<<8 ; /* track */
+*(RPout+RP_stk) = j | (i%rpsec) ; /* sector : track */
+M0_bc->reg = (count<dblks?-(count*512):(-BUFSIZ)) ; /* byte count */
+M0_var->reg = 0 ; /* virt addr reg = map no. + byte off */
+*(RPout+RP_cr) = RP_WR | RP_GO ; /* write */
+
+douoff += dblks ; /* point to next disc sector */
+dwait(RPout) ; /* wait for i/o to finish */
+if (i = mbaerr(M0)) {
+ return(-1) ;
+ }
+if (i = derror(RPout)) {
+ putstr("write error") ;
+ stmes(i) ;
+ dadmes(RPout) ;
+ if (++ecount > MAXERR) return(-1) ;
+ }
+return(0) ; /* normal return */
+}
+
+/* */
+
+dwait(dptr)
+register int *dptr ;
+{
+/*
+* Function to wait MBA 0 RP06 disc unit to be ready.
+*/
+while ((*(dptr+RP_sr)&RP_DRY) == 0) ;
+}
+
+/* */
+
+derror(dptr)
+register int *dptr ;
+{
+/*
+* Function to check for MBA 0 RP06 error.
+*/
+if (*(dptr+RP_sr) & RP_ERR) return(*(dptr+RP_er1) & 0177777) ;
+return(0) ;
+}
+
+/* */
+
+halt()
+{
+asm(" halt") ;
+}
+
+/* */
+
+stmes(code)
+int code ;
+{
+putstr(" : err reg : ") ;
+RPE_print(code) ;
+}
+
+/* */
+
+dadmes(dptr)
+register int *dptr ;
+{
+register char *mesp ;
+register int i ;
+
+mesp = " cyl trk sec " ;
+i = l2x(*(dptr+RP_cyl) & 01777,&mesp[5]) ;
+blnkit(&mesp[5+i],4-i) ;
+
+i = l2x((*(dptr+RP_stk)>>8) & 037 , &mesp[13]) ;
+blnkit(&mesp[13+i],3-i) ;
+
+i = l2x(*(dptr+RP_stk)&037,&mesp[21]) ;
+blnkit(&mesp[21+i],3-i) ;
+
+putlin(mesp) ;
+}
+
+/* */
+
+blnkit(mp,cc)
+register char *mp ;
+register int cc ;
+{
+
+while (cc--)
+ (*mp++) = ' ' ;
+}
+
+/* */
+
+mbaerr(mba)
+register int *mba ;
+{
+register int i ;
+
+if ((i = (*(mba+M_st))) != M_DTC) {
+ putlin("- - - - - -") ;
+ putstr("MBA error : status reg = ") ;
+ MBAS_print(i) ;
+ *(mba+M_st) = (-1) ;
+ return(i) ;
+ }
+return(0) ;
+}
+
+/* */
+
+l2x(val,rptr)
+register int val ;
+register char *rptr ;
+{
+register int i , j ;
+register char *tp ;
+int knt ;
+char tmp[20] , sign ;
+
+knt = sign = 0 ;
+if (val < 0) {
+ sign++ ;
+ val = (-val) ;
+ }
+
+tp = tmp ;
+loop :
+ knt++ ;
+ i = val/16 ; /* quotient & base 16 */
+ j = val%16 ;
+ (*tp++) = j + (j<10?0x30:0x57) ;
+ val = i ;
+ if (val == 0) {
+ /* done dividing */
+ if (sign) { knt++ ; (*tp++) = '-' ; }
+ for (i = knt ; i ; i--)
+ (*rptr++) = tmp[i-1] ;
+ (*rptr++) = '\0' ;
+ return(knt) ;
+ }
+ else goto loop ;
+}
+
+/* */
+
+ECCrcv(dptr)
+register int *dptr ;
+{
+/*
+* Do ECC error recovery on disk whose register set is pointed
+* to by 'dptr'.
+* 'mbaerr()' has cleared MBA status reg.
+* With ECC enabled, disk read has stopped after sector with bad
+* data. After correction of data, return to 'dread()' which will
+* continue read of track if more sectors to do.
+* Return 0.
+*/
+register unsigned int pos , pat ;
+register unsigned short *wordp ;
+unsigned int ll ;
+struct { short wlo , whi ; } ;
+char tmp[50] ;
+
+pat = (*(dptr+RP_Epat)) & 0xffff ; /* ECC pattern reg */
+pos = (*(dptr+RP_Epos)) & 0xffff ; /* ECC position reg */
+putstr("pat : ") ;
+ul2x(pat,tmp) ;
+putlin(tmp) ;
+putstr("pos : ") ;
+ul2x(pos,tmp) ;
+putlin(tmp) ;
+wordp = bufptr ; /* ptr to buffer */
+
+/*
+* 'BUFSIZ' bytes are read on each read into buffer pointed to
+* by 'bufptr'. MBA byte count reg has neg. no. of bytes remaining
+* in read if this read error was not in the last sector to be
+* read.
+*/
+/* calculate buffer location of faulty data */
+wordp = (char *)wordp + (BUFSIZ + ((M0_bc->reg)>>16) - BLKSIZ) ; /* sector in buffer */
+wordp = wordp + ((pos-1)>>4) ; /* word within sector */
+
+/* burst pattern may be across word boundary */
+ll = (*wordp) + ((*(wordp+1))<<16) ;
+putstr("bad data : ") ;
+ul2x(ll,tmp) ;
+putlin(tmp) ;
+pat = pat<<((pos%16)-1) ;
+ll = ll^pat ; /* correction */
+putstr("good data : ") ;
+ul2x(ll,tmp) ;
+putlin(tmp) ;
+
+/* put good data back in buffer */
+*wordp = ll.wlo ;
+*(wordp+1) = ll.whi ;
+
+return(0) ;
+}
+
+/* */
+
+ul2x(val,rptr)
+register unsigned int val ;
+register char *rptr ;
+{
+register unsigned int i , j ;
+register char *tp ;
+int knt ;
+char tmp[20] ;
+unsigned int udiv() , urem() ;
+
+knt = 0 ;
+
+tp = tmp ;
+loop :
+ knt++ ;
+ /* use unsigned integer divide & remainder routines */
+ i = udiv(val,16) ; /* quotient & base 16 */
+ j = urem(val,16) ;
+ (*tp++) = j + (j<10?0x30:0x57) ;
+ val = i ;
+ if (val == 0) {
+ /* done dividing */
+ for (i = knt ; i ; i--)
+ (*rptr++) = tmp[i-1] ;
+ (*rptr++) = '\0' ;
+ return(knt) ;
+ }
+ else goto loop ;
+}