add first WEGA commands
This commit is contained in:
Oliver Lehmann
parent
db8ef4e8df
commit
618ce9cf8e
|
|
@ -0,0 +1,52 @@
|
||||||
|
/*
|
||||||
|
|------------------------------------------------------|
|
||||||
|
| Standalone-Programm sa.shipdisk (Version 4.1) |
|
||||||
|
|------------------------------------------------------|
|
||||||
|
| Programm zum Bewegen des Schreib-Lese-Kamms |
|
||||||
|
| auf den innersten Zylinder fuer alle Laufwerke |
|
||||||
|
| Bearbeiter: F. Spielmann |
|
||||||
|
|------------------------------------------------------|
|
||||||
|
*/
|
||||||
|
|
||||||
|
char db[512];
|
||||||
|
unsigned int kc,dr,drs,cl,hd,sc,lg;
|
||||||
|
int i;
|
||||||
|
unsigned int c_c;
|
||||||
|
unsigned int rg7,rg6,rg5,rg4;
|
||||||
|
|
||||||
|
main()
|
||||||
|
{
|
||||||
|
printf("\n>>> Shipdisk 4.1 <<<\n");
|
||||||
|
|
||||||
|
/* Lesen des Parameterblocks */
|
||||||
|
kc = 0x28;
|
||||||
|
lg = 0x40;
|
||||||
|
rg_um();
|
||||||
|
c_c = wdc(rg7,rg6,rg5,rg4,&db[0]);
|
||||||
|
if (c_c != 0) c_c = wdc(rg7,rg6,rg5,rg4,&db[0]);
|
||||||
|
if (c_c != 0) {printf("Error %x\n",c_c); exit();}
|
||||||
|
|
||||||
|
/* Lesen auf dem innersten Zylinder */
|
||||||
|
drs = db[49]&0xff;
|
||||||
|
cl = (((db[24]&0xff) << 8) | (db[23]&0xff)) - 1;
|
||||||
|
kc = 0x01;
|
||||||
|
hd = 0;
|
||||||
|
sc = 1;
|
||||||
|
lg = 0x200;
|
||||||
|
/* Leseversuch auf jedem angeschlossenem Laufwerk */
|
||||||
|
for (dr=0;dr<drs;dr++)
|
||||||
|
{ rg_um();
|
||||||
|
c_c = wdc(rg7,rg6,rg5,rg4,&db[0]);
|
||||||
|
}
|
||||||
|
printf("\nShipdisk ok.\n");
|
||||||
|
exit();
|
||||||
|
}
|
||||||
|
|
||||||
|
/* UP rg_um */
|
||||||
|
rg_um()
|
||||||
|
{
|
||||||
|
rg7 = ((kc & 0x00ff) << 8) | (dr & 0x00ff);
|
||||||
|
rg6 = ((cl & 0x00ff) << 8) | ((cl & 0xff00) >> 8);
|
||||||
|
rg5 = ((hd & 0x00ff) << 8) | (sc & 0x00ff);
|
||||||
|
rg4 = ((lg & 0x00ff) << 8) | ((lg & 0xff00) >> 8);
|
||||||
|
}
|
||||||
|
|
@ -0,0 +1,265 @@
|
||||||
|
disk module
|
||||||
|
$nonsegmented
|
||||||
|
constant
|
||||||
|
!Port-Adressen!
|
||||||
|
PIOAD := %FFA1
|
||||||
|
PIOBD := %FFA3
|
||||||
|
PIOAC := %FFA5
|
||||||
|
PIOBC := %FFA7
|
||||||
|
!PIO-Programmierung!
|
||||||
|
OUTPUT := %0F
|
||||||
|
INPUT := %4F
|
||||||
|
BITMODE := %CF
|
||||||
|
INTVEC := %18
|
||||||
|
! Anschlussbelegung des Controlers am PIO des 16-Bit-Teils
|
||||||
|
Port A : 8 Bit bidirektionale Daten (D0 bis D7)
|
||||||
|
Port B : Steuerport
|
||||||
|
Bit0 : /ST0 (Statusbit 0)
|
||||||
|
Bit1 : /ST1 (Statusbit 1)
|
||||||
|
Bit2 : /ST2 (Statusbit 2)
|
||||||
|
Bit3 : frei Ausgang
|
||||||
|
Bit4 : frei Ausgang
|
||||||
|
Bit5 : RESET (WDC-Reset) Ausgang
|
||||||
|
Bit6 : TE (Richtung) Ausgang
|
||||||
|
Bit7 : TR (Anforderung) Eingang
|
||||||
|
!
|
||||||
|
! Steuerport WDC !
|
||||||
|
RDATA := %4000
|
||||||
|
WDATA := %00
|
||||||
|
|
||||||
|
! Uebergabe der Parameter an den Host-Treiber
|
||||||
|
rh7 : Kommandocode
|
||||||
|
rl7 : Laufwerksnummer
|
||||||
|
r6 : Zylindernummer
|
||||||
|
rh5 : Kopfnummer
|
||||||
|
rl5 : Sektornummer
|
||||||
|
r4 : Datenlaenge (rh4: low, rl4: high)
|
||||||
|
r3 : Host-Datenadresse (rh3: high, rl3: low)
|
||||||
|
Uebergabe der Parameter byteweise (9 Byte) an den WDC-Controler:
|
||||||
|
-- Kommandocode
|
||||||
|
-- Laufwerksnummer
|
||||||
|
-- Zyl (low)
|
||||||
|
-- Zyl (high)
|
||||||
|
-- Kopf
|
||||||
|
-- Sektor
|
||||||
|
-- Datenlaenge (low)
|
||||||
|
-- Datenlaenge (high)
|
||||||
|
-- Pruefsumme (wird nicht ausgewertet)
|
||||||
|
!
|
||||||
|
|
||||||
|
global
|
||||||
|
_wdc procedure
|
||||||
|
entry
|
||||||
|
! Initialisierung des PIO !
|
||||||
|
! und RESET an den WDC !
|
||||||
|
calr disk_in
|
||||||
|
! PIO-Programmierung Host-->WDC !
|
||||||
|
ld r0,#WDATA+OUTPUT
|
||||||
|
outb PIOBD,rh0
|
||||||
|
outb PIOAC,rl0
|
||||||
|
! Loeschen Fehlerregister !
|
||||||
|
ldk r2,#0
|
||||||
|
! Warten auf WDC-Bereitschaft !
|
||||||
|
w_st1:
|
||||||
|
inb rl0,PIOBD
|
||||||
|
andb rl0,#%7
|
||||||
|
cpb rl0,#0
|
||||||
|
jp z,stat7
|
||||||
|
cpb rl0,#%1 !Status 6: PROM-Fehler!
|
||||||
|
jp z,err_20
|
||||||
|
cpb rl0,#6
|
||||||
|
jr nz,w_st1
|
||||||
|
! Ausgabe der neun Kommandobytes an den WDC !
|
||||||
|
outb PIOAD,rh7 !Kommandocode!
|
||||||
|
outb PIOAD,rl7 !Laufwerk!
|
||||||
|
outb PIOAD,rh6 !Zylinder low!
|
||||||
|
outb PIOAD,rl6 !Zylinder high!
|
||||||
|
outb PIOAD,rh5 !Head!
|
||||||
|
outb PIOAD,rl5 !Sektor!
|
||||||
|
outb PIOAD,rh4 !Laenge low!
|
||||||
|
outb PIOAD,rl4 !Laenge high!
|
||||||
|
outb PIOAD,rh3 !Leerbyte!
|
||||||
|
ldb rh0,rh4
|
||||||
|
ldb rh4,rl4
|
||||||
|
ldb rl4,rh0
|
||||||
|
! Warten auf Status=0 !
|
||||||
|
w_st2: inb rl0,PIOBD
|
||||||
|
andb rl0,#%7
|
||||||
|
cpb rl0,#%7
|
||||||
|
jr nz,w_st2
|
||||||
|
! Warten auf Ergebnis-Status !
|
||||||
|
w_st3: inb rl0,PIOBD
|
||||||
|
andb rl0,#%7
|
||||||
|
cpb rl0,#%7
|
||||||
|
jr z,w_st3
|
||||||
|
inb rl0,PIOBD
|
||||||
|
andb rl0,#%7
|
||||||
|
cpb rl0,#0
|
||||||
|
jp z,stat7
|
||||||
|
cpb rl0,#6
|
||||||
|
jp z,stat1
|
||||||
|
cpb rl0,#5
|
||||||
|
jp z,stat2
|
||||||
|
cpb rl0,#4
|
||||||
|
jp z,stat3
|
||||||
|
jp err_0
|
||||||
|
!*******************************************!
|
||||||
|
! Auswertung Status=1 !
|
||||||
|
!*******************************************!
|
||||||
|
stat1:
|
||||||
|
cpb rh7,#%41
|
||||||
|
jp z,h_ret
|
||||||
|
cpb rh7,#%c2
|
||||||
|
jp z,h_ret
|
||||||
|
cpb rh7,#%48
|
||||||
|
jp z,h_ret
|
||||||
|
bitb rh7,#2
|
||||||
|
jp z,err_1
|
||||||
|
jp h_ret
|
||||||
|
|
||||||
|
!*******************************************!
|
||||||
|
! Auswertung Status=2 !
|
||||||
|
!*******************************************!
|
||||||
|
stat2:
|
||||||
|
cpb rh7,#%18
|
||||||
|
jp z,wdc_wt
|
||||||
|
cpb rh7,#%78 !Schreiben PAR aus Host!
|
||||||
|
jp z,wdc_wt
|
||||||
|
cpb rh7,#%68 !Schreiben BTT aus Host!
|
||||||
|
jp z,wdc_wt
|
||||||
|
bitb rh7,#1 !Schreibkommandos!
|
||||||
|
jp z,err_2
|
||||||
|
wdc_wt:
|
||||||
|
ld r1,#PIOAD
|
||||||
|
otirb @r1,@r3,r4
|
||||||
|
! Warten auf Status=0 !
|
||||||
|
w_st4:
|
||||||
|
inb rl0,PIOBD
|
||||||
|
andb rl0,#7
|
||||||
|
cpb rl0,#7
|
||||||
|
jr nz,w_st4
|
||||||
|
! Warten auf Ergebnis-Status !
|
||||||
|
w_st5:
|
||||||
|
inb rl0,PIOBD
|
||||||
|
andb rl0,#7
|
||||||
|
cpb rl0,#7
|
||||||
|
jr z,w_st5
|
||||||
|
inb rl0,PIOBD
|
||||||
|
andb rl0,#%7
|
||||||
|
cpb rl0,#0
|
||||||
|
jp z,stat7
|
||||||
|
cpb rl0,#6
|
||||||
|
jp z,h_ret
|
||||||
|
jp err_5
|
||||||
|
|
||||||
|
!*******************************************!
|
||||||
|
! Auswertung Status=3 !
|
||||||
|
!*******************************************!
|
||||||
|
stat3:
|
||||||
|
cpb rh7,#%0 !Ready-Test!
|
||||||
|
jp z,wdc_rd
|
||||||
|
cpb rh7,#%08 !Lesen WDC-RAM!
|
||||||
|
jp z,wdc_rd
|
||||||
|
cpb rh7,#%28 !Lesen WDC-Parameterblock!
|
||||||
|
jp z,wdc_rd
|
||||||
|
cpb rh7,#%38 !Lesen WDC-Fehlerstatistik!
|
||||||
|
jp z,wdc_rd
|
||||||
|
cpb rh7,#%58
|
||||||
|
jp z,wdc_rd
|
||||||
|
cpb rh7,#%24 !Formatieren mit Defektspurtabelle!
|
||||||
|
jp z,wdc_rd
|
||||||
|
bitb rh7,#0 !HD-Lesekommandos!
|
||||||
|
jp z,err_3
|
||||||
|
! PIO-Umprogrammierung !
|
||||||
|
wdc_rd:
|
||||||
|
ld r0,#RDATA+INPUT
|
||||||
|
outb PIOAC,rl0
|
||||||
|
outb PIOBD,rh0
|
||||||
|
inb rl0,PIOAD !Scheineingabe!
|
||||||
|
! Uebernahme der Bytes !
|
||||||
|
ld r1,#PIOAD
|
||||||
|
inirb @r3,@r1,r4
|
||||||
|
cpb rh7,#%24 !Formatieren mit Defektspur?!
|
||||||
|
jp nz,w_stat
|
||||||
|
ld r2,#%21
|
||||||
|
jp w_stat
|
||||||
|
|
||||||
|
!*******************************************!
|
||||||
|
! Auswertung Status=7 !
|
||||||
|
!*******************************************!
|
||||||
|
stat7:
|
||||||
|
! PIO-Umprogrammierung !
|
||||||
|
ld r0,#RDATA+INPUT
|
||||||
|
outb PIOAC,rl0
|
||||||
|
outb PIOBD,rh0
|
||||||
|
inb rl0,PIOAD !Scheineingabe!
|
||||||
|
! Uebernahme des Fehlerbytes!
|
||||||
|
inb rl2,PIOAD
|
||||||
|
|
||||||
|
w_stat:
|
||||||
|
! Warten auf Ergebnis-Status !
|
||||||
|
inb rl0,PIOBD
|
||||||
|
andb rl0,#7
|
||||||
|
cpb rl0,#7
|
||||||
|
jr nz,w_stat
|
||||||
|
w_stat1:
|
||||||
|
inb rl0,PIOBD
|
||||||
|
andb rl0,#%7
|
||||||
|
cpb rl0,#%7
|
||||||
|
jr z,w_stat1
|
||||||
|
inb rl0,PIOBD
|
||||||
|
andb rl0,#%7
|
||||||
|
cpb rl0,#6
|
||||||
|
jp nz,err_4
|
||||||
|
h_ret:
|
||||||
|
ret
|
||||||
|
|
||||||
|
! Fehlerbehandlung !
|
||||||
|
err_0:
|
||||||
|
ldb rl2,#%c0
|
||||||
|
jr err_rt
|
||||||
|
err_1:
|
||||||
|
ldb rl2,#%c1
|
||||||
|
jr err_rt
|
||||||
|
err_2:
|
||||||
|
ldb rl2,#%c2
|
||||||
|
jr err_rt
|
||||||
|
err_3:
|
||||||
|
ldb rl2,#%c3
|
||||||
|
jr err_rt
|
||||||
|
err_4:
|
||||||
|
ldb rl2,#%c4
|
||||||
|
jr err_rt
|
||||||
|
err_5:
|
||||||
|
ldb rl2,#%c5
|
||||||
|
jr err_rt
|
||||||
|
err_20: ldb rl2,#%20
|
||||||
|
err_rt:
|
||||||
|
jp h_ret
|
||||||
|
end _wdc
|
||||||
|
|
||||||
|
internal
|
||||||
|
! Initialisierung des PIO und des WDC !
|
||||||
|
init array [* byte] := [
|
||||||
|
PIOBC, INTVEC,
|
||||||
|
PIOBD, WDATA,
|
||||||
|
PIOBC, BITMODE,
|
||||||
|
PIOBC, %87,
|
||||||
|
]
|
||||||
|
|
||||||
|
disk_in procedure
|
||||||
|
entry
|
||||||
|
ld r2,#PIOBD
|
||||||
|
inb rl1,@r2
|
||||||
|
bitb rl1,#5 !Reset weggenommen ?!
|
||||||
|
ret z
|
||||||
|
lda r1,init
|
||||||
|
ldk r0,#4 !Anzahl der Ausgaben!
|
||||||
|
iloop: ldb rl2,@r1 !Portadresse!
|
||||||
|
inc r1,#1
|
||||||
|
outib @r2,@r1,r0
|
||||||
|
jr nov,iloop
|
||||||
|
ret
|
||||||
|
end disk_in
|
||||||
|
end disk
|
||||||
|
|
||||||
Loading…
Reference in New Issue