232 lines
6.3 KiB
C
232 lines
6.3 KiB
C
/* $NetBSD: ra.c,v 1.6 1998/10/09 06:15:33 matt Exp $ */
|
|
/*
|
|
* Copyright (c) 1995 Ludd, University of Lule}, Sweden.
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 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 at Ludd, University of Lule}.
|
|
* 4. The name of the author may not be used to endorse or promote products
|
|
* derived from this software without specific prior written permission
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
|
* IN NO EVENT SHALL THE AUTHOR 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.
|
|
*/
|
|
|
|
/* All bugs are subject to removal without further notice */
|
|
|
|
#define NRSP 1 /* Kludge */
|
|
#define NCMD 1 /* Kludge */
|
|
|
|
#include "sys/param.h"
|
|
#include "sys/disklabel.h"
|
|
|
|
#include "lib/libsa/stand.h"
|
|
|
|
#include "../include/pte.h"
|
|
/*#include "../include/macros.h"*/
|
|
#include "../include/sid.h"
|
|
|
|
#include "../uba/ubareg.h"
|
|
#include "../uba/udareg.h"
|
|
|
|
#include "../mscp/mscp.h"
|
|
#include "../mscp/mscpreg.h"
|
|
|
|
#include "../bi/bireg.h"
|
|
#include "../bi/kdbreg.h"
|
|
|
|
#include "vaxstand.h"
|
|
|
|
static command(int);
|
|
|
|
/*
|
|
* These routines for RA disk standalone boot is wery simple,
|
|
* assuming a lots of thing like that we only working at one ra disk
|
|
* a time, no separate routines for uba driver etc..
|
|
* This code is foolish and should need a cleanup.
|
|
* But it works :)
|
|
*/
|
|
|
|
struct ra_softc {
|
|
int udaddr;
|
|
int ubaddr;
|
|
int part;
|
|
int unit;
|
|
unsigned short *ra_ip;
|
|
unsigned short *ra_sa;
|
|
unsigned short *ra_sw;
|
|
};
|
|
|
|
volatile struct uda {
|
|
struct mscp_1ca uda_ca; /* communications area */
|
|
struct mscp uda_rsp; /* response packets */
|
|
struct mscp uda_cmd; /* command packets */
|
|
} uda;
|
|
|
|
volatile struct uda *ubauda;
|
|
volatile struct udadevice *udacsr;
|
|
struct disklabel ralabel;
|
|
struct ra_softc ra_softc;
|
|
char io_buf[MAXBSIZE];
|
|
|
|
raopen(f, adapt, ctlr, unit, part)
|
|
struct open_file *f;
|
|
int ctlr, unit, part;
|
|
{
|
|
char *msg;
|
|
struct disklabel *lp = &ralabel;
|
|
volatile struct ra_softc *ra = &ra_softc;
|
|
volatile struct uba_regs *mr = (void *)ubaaddr[adapt];
|
|
volatile u_int *nisse;
|
|
unsigned short johan, johan2;
|
|
int i,err;
|
|
|
|
bzero(lp, sizeof(struct disklabel));
|
|
ra->unit = unit;
|
|
ra->part = part;
|
|
if (vax_cputype != VAX_8200) {
|
|
if (adapt > nuba)
|
|
return(EADAPT);
|
|
if (ctlr > nuda)
|
|
return(ECTLR);
|
|
nisse = (u_int *)&mr->uba_map[0];
|
|
nisse[494] = PG_V | (((u_int)&uda) >> 9);
|
|
nisse[495] = nisse[494] + 1;
|
|
udacsr = (void*)uioaddr[adapt] + udaaddr[ctlr];
|
|
ubauda = (void*)0x3dc00 + (((u_int)(&uda))&0x1ff);
|
|
johan = (((u_int)ubauda) & 0xffff) + 8;
|
|
johan2 = 3;
|
|
ra->ra_ip = (short *)&udacsr->udaip;
|
|
ra->ra_sa = ra->ra_sw = (short *)&udacsr->udasa;
|
|
ra->udaddr = uioaddr[adapt] + udaaddr[ctlr];
|
|
ra->ubaddr = (int)mr;
|
|
*ra->ra_ip = 0; /* Start init */
|
|
} else {
|
|
struct bi_node *bi = (void *)biaddr[adapt];
|
|
struct kdb_regs *kb = (void *)&bi[ctlr];
|
|
volatile int i = 10000;
|
|
|
|
ra->ra_ip = &kb->kdb_ip;
|
|
ra->ra_sa = &kb->kdb_sa;
|
|
ra->ra_sw = &kb->kdb_sw;
|
|
johan = ((u_int)&uda.uda_ca.ca_rspdsc) & 0xffff;
|
|
johan2 = (((u_int)&uda.uda_ca.ca_rspdsc) & 0xffff0000) >> 16;
|
|
kb->kdb_bi.bi_csr |= BICSR_NRST;
|
|
while (i--) /* Need delay??? */
|
|
;
|
|
kb->kdb_bi.bi_ber = ~(BIBER_MBZ|BIBER_NMR|BIBER_UPEN);/* ??? */
|
|
ubauda = &uda;
|
|
}
|
|
|
|
/* Init of this uda */
|
|
while ((*ra->ra_sa & MP_STEP1) == 0)
|
|
;
|
|
|
|
*ra->ra_sw = 0x8000;
|
|
while ((*ra->ra_sa & MP_STEP2) == 0)
|
|
;
|
|
|
|
*ra->ra_sw = johan;
|
|
while ((*ra->ra_sa & MP_STEP3) == 0)
|
|
;
|
|
|
|
*ra->ra_sw = johan2;
|
|
while ((*ra->ra_sa & MP_STEP4) == 0)
|
|
;
|
|
|
|
*ra->ra_sw = 0x0001;
|
|
uda.uda_ca.ca_rspdsc = (int)&ubauda->uda_rsp.mscp_cmdref;
|
|
uda.uda_ca.ca_cmddsc = (int)&ubauda->uda_cmd.mscp_cmdref;
|
|
|
|
command(M_OP_SETCTLRC);
|
|
uda.uda_cmd.mscp_unit = ra->unit;
|
|
command(M_OP_ONLINE);
|
|
|
|
err = rastrategy(ra,F_READ, LABELSECTOR, DEV_BSIZE, io_buf, &i);
|
|
if(err){
|
|
printf("reading disklabel: %s\n",strerror(err));
|
|
return 0;
|
|
}
|
|
|
|
msg = getdisklabel(io_buf+LABELOFFSET, lp);
|
|
if (msg)
|
|
printf("getdisklabel: %s\n", msg);
|
|
f->f_devdata = (void *)ra;
|
|
return(0);
|
|
}
|
|
|
|
static
|
|
command(cmd)
|
|
{
|
|
volatile int hej;
|
|
|
|
uda.uda_cmd.mscp_opcode = cmd;
|
|
uda.uda_cmd.mscp_msglen = MSCP_MSGLEN;
|
|
uda.uda_rsp.mscp_msglen = MSCP_MSGLEN;
|
|
uda.uda_ca.ca_rspdsc |= MSCP_OWN|MSCP_INT;
|
|
uda.uda_ca.ca_cmddsc |= MSCP_OWN|MSCP_INT;
|
|
hej = *ra_softc.ra_ip;
|
|
while(uda.uda_ca.ca_rspdsc<0)
|
|
;
|
|
|
|
}
|
|
|
|
rastrategy(ra, func, dblk, size, buf, rsize)
|
|
struct ra_softc *ra;
|
|
int func;
|
|
daddr_t dblk;
|
|
char *buf;
|
|
u_int size, *rsize;
|
|
{
|
|
volatile struct uba_regs *ur;
|
|
volatile struct udadevice *udadev;
|
|
volatile u_int *ptmapp;
|
|
struct disklabel *lp;
|
|
u_int i, j, pfnum, mapnr, nsize;
|
|
volatile int hej;
|
|
|
|
|
|
if (vax_cputype != VAX_8200) {
|
|
ur = (void *)ra->ubaddr;
|
|
udadev = (void*)ra->udaddr;
|
|
ptmapp = (u_int *)&ur->uba_map[0];
|
|
|
|
pfnum = (u_int)buf >> PGSHIFT;
|
|
|
|
for(mapnr = 0, nsize = size; (nsize + NBPG) > 0; nsize -= NBPG)
|
|
ptmapp[mapnr++] = PG_V | pfnum++;
|
|
uda.uda_cmd.mscp_seq.seq_buffer = ((u_int)buf) & 0x1ff;
|
|
} else
|
|
uda.uda_cmd.mscp_seq.seq_buffer = ((u_int)buf);
|
|
|
|
lp = &ralabel;
|
|
uda.uda_cmd.mscp_seq.seq_lbn =
|
|
dblk + lp->d_partitions[ra->part].p_offset;
|
|
uda.uda_cmd.mscp_seq.seq_bytecount = size;
|
|
uda.uda_cmd.mscp_unit = ra->unit;
|
|
if (func == F_WRITE)
|
|
command(M_OP_WRITE);
|
|
else
|
|
command(M_OP_READ);
|
|
|
|
*rsize = size;
|
|
return 0;
|
|
}
|