mirror of https://github.com/wwarthen/RomWBW.git
Wayne Warthen
4 years ago
18 changed files with 1330 additions and 912 deletions
File diff suppressed because it is too large
@ -0,0 +1,999 @@ |
|||
; PIO driver sets up the parallel port as a subtype of Serial/Char device. |
|||
; |
|||
; |
|||
; HBIOS initializes driver by: |
|||
; |
|||
; 1) Calling Pre-initialization |
|||
; |
|||
; This involves setting up all the data structures describing the devices. |
|||
; If possible, do a hardware test to verify it is available for adding to available devices. |
|||
; |
|||
; 2) Calling device initialization. |
|||
; |
|||
; Hardware initialization. |
|||
; Configure to initial state or to a new state. |
|||
; |
|||
; Implementation limitations: |
|||
; |
|||
; The fully functionality of the Z80 PIO can only be realized by using Z80 interrupt mode 2. |
|||
; Registers cannot be interrogated for interrupts status and the originating interrupt |
|||
; device cannot be determine. |
|||
; |
|||
; Full implementation of IM2 functionality for an ECB-ZP and ECB-4P board would require the |
|||
; allocation of an interrupt handler for each chip channel. Thus, 12 interrupt handlers |
|||
; would be required to support this configuration. As the HBIOS only has an allocation of |
|||
; 16, a full implmentation is impractical. |
|||
; |
|||
; The compromise solution is to allow 4 interrupts for the PIO driver. All remaining PIO's |
|||
; are limited to Bit mode or blind read and write to the input/output ports. |
|||
; |
|||
; Zilog PIO reset state: |
|||
; |
|||
; Both port mask registers are reset to inhibit All port data bits. |
|||
; Port data bus lines are set to a high-impedance state and the Ready "handshake" |
|||
; Mode 1 (output) is automatically selected. |
|||
; The vector address registers are not reset. |
|||
; Both port interrupt enable flip-flops are reset. |
|||
; Both port output registers are reset. |
|||
; |
|||
; Register addressing example for ECB-ZP and ECB-4P assuming base address 90h and 88h respectively. |
|||
; |
|||
; PIO ----ZP---- ----4P---- |
|||
; 0 DATA 0 90h DATA 0 B8h |
|||
; 0 DATA 1 91h DATA 1 B9h |
|||
; 0 CMD 0 92h CMD 0 BAh |
|||
; 0 CMD 1 93h CMD 1 BBh |
|||
; 1 DATA 0 94h DATA 0 BCh |
|||
; 1 DATA 1 95h DATA 1 BDh |
|||
; 1 CMD 0 96h CMD 0 BEh |
|||
; 1 CMD 1 97h CMD 1 BFh |
|||
; 2 DATA 0 C0h |
|||
; 2 DATA 1 C1h |
|||
; 2 CMD 0 C2h |
|||
; 2 CMD 1 C3h |
|||
; 3 DATA 0 C4h |
|||
; 3 DATA 1 C5h |
|||
; 3 CMD 0 C6h |
|||
; 3 CMD 1 C7h |
|||
; |
|||
PIODEBUG .EQU 1 |
|||
; |
|||
M_Output .EQU $00 << 6 |
|||
M_Input .EQU $01 << 6 |
|||
M_Bidir .EQU $02 << 6 |
|||
M_BitCtrl .EQU $03 << 6 |
|||
M_BitAllIn .EQU $FF |
|||
M_BitAllOut .EQU $00 |
|||
; |
|||
PIO_NONE .EQU 0 |
|||
PIO_ZPIO .EQU 1 |
|||
PIO_8255 .EQU 2 |
|||
PIO_PORT .EQU 3 |
|||
|
|||
; SET MAXIMUM NUMBER OF INTERRUPTS AVAILABLE FOR ALL |
|||
; ENSURE INTERRUPTS ARE NOT TURNED ON IF IM2 IS NOT SET. |
|||
|
|||
INT_ALLOC .DB 0 |
|||
INT_N .EQU 00000000B |
|||
#IF (INTMODE == 2) |
|||
INT_Y .EQU 00000100B |
|||
INT_ALLOW .EQU 4 |
|||
#ELSE |
|||
INT_Y .EQU INT_N |
|||
INT_ALLOW .EQU 0 |
|||
#ENDIF |
|||
; |
|||
INT0 .EQU 00000000B |
|||
INT1 .EQU 00000001B |
|||
INT2 .EQU 00000010B |
|||
INT3 .EQU 00000011B |
|||
|
|||
; |
|||
; SETUP THE DISPATCH TABLE ENTRIES |
|||
; |
|||
; PIO_CNT HOLDS THE NUMBER OF DEVICED CALCULATED FROM THE NUMBER OF DEFPIO MACROS |
|||
; PIO_CNT SHOULD INCREASE BY 2 FOR EVERY PIO CHIP ADDED. |
|||
; |
|||
; PIO_PREINIT WILL READ THROUGH ALL PIOCFG TABLES AND CONFIGURE EACH TABLE. |
|||
; IT WITH THEN CALL PIO_INITUNIT TO INITIALIZE EACH DEVICE TO ITS DEFAULT STATE |
|||
; |
|||
; EXPECTS NOTHING ON ENTRY |
|||
; |
|||
PIO_PREINIT: |
|||
CALL NEWLINE ;D |
|||
LD B,PIO_CNT ; LOOP CONTROL |
|||
LD C,0 ; PHYSICAL UNIT INDEX |
|||
XOR A ; ZERO TO ACCUM |
|||
; LD (PIO_DEV),A ; CURRENT DEVICE NUMBER |
|||
LD (INT_ALLOC),A ; START WITH NO INTERRUPTS ALLOCATED |
|||
PIO_PREINIT0: |
|||
PUSH BC ; SAVE LOOP CONTROL |
|||
; LD A,C ; INITIALIZE THE UNIT |
|||
|
|||
; PUSH AF ;D |
|||
; LD A,'u' ;D |
|||
; CALL COUT ;D |
|||
; POP AF ;D |
|||
; CALL PRTHEXBYTE ;D UNIT |
|||
; CALL PC_SPACE ;D |
|||
|
|||
; RLCA ; MULTIPLY BY CFG TABLE ENTRY SIZE (32 BYTES) |
|||
; RLCA ; ... |
|||
; RLCA ; ... TO GET OFFSET INTO CFG TABLE |
|||
; RLCA |
|||
;; RLCA |
|||
; LD HL,PIO_CFG ; POINT TO START OF CFG TABLE |
|||
; PUSH AF |
|||
; CALL ADDHLA ; HL := ENTRY ADDRESS |
|||
; POP AF |
|||
; CALL ADDHLA ; HL := ENTRY ADDRESS |
|||
; PUSH HL ; SAVE IT |
|||
; POP IY ; ... TO IY |
|||
|
|||
CALL IDXCFG |
|||
|
|||
LD (HL),C |
|||
|
|||
PUSH AF ;D |
|||
LD A,'c' ;D |
|||
CALL COUT ;D |
|||
POP AF ;D |
|||
PUSH BC ;D |
|||
PUSH HL ;D |
|||
POP BC ;D |
|||
CALL PRTHEXWORD ;D CONFIG TABLE |
|||
CALL PC_SPACE ;D |
|||
POP BC ;D |
|||
|
|||
LD A,(IY+1) ; GET THE PIO TYPE DETECTED |
|||
CP PIO_PORT ; SET FLAGS |
|||
|
|||
PUSH AF ;D |
|||
LD A,'t' ;D |
|||
CALL COUT ;D |
|||
POP AF ;D |
|||
CALL PRTHEXBYTE ;D TYPE |
|||
CALL PC_SPACE ;D |
|||
|
|||
; JR Z,BADINIT |
|||
|
|||
; PUSH BC ; SAVE LOOP CONTROL |
|||
; LD BC,PIO_FNTBL ; BC := FUNCTION TABLE ADDRESS |
|||
; DEC A |
|||
; JR Z,TYPFND ; SKIP IT IF NOTHING FOUND |
|||
; LD BC,PPI_FNTBL ; BC := FUNCTION TABLE ADDRESS |
|||
; DEC A |
|||
; JR Z,TYPFND ; ADD ENTRY IF PIO FOUND, BC:DE |
|||
; LD BC,PRT_FNTBL |
|||
; DEC A |
|||
; JR Z,TYPFND |
|||
; POP BC |
|||
; JR BADINIT |
|||
|
|||
PUSH HL |
|||
LD DE,-1 ; INITIALIZE THIS DEVICE WITH |
|||
CALL PIO_INITDEV ; DEFAULT VALUES |
|||
POP HL |
|||
|
|||
; JR NZ,SKPINIT |
|||
|
|||
; AT THIS POINT WE KNOW WE |
|||
; HAVE A VALID DEVICE SO ADD IT |
|||
|
|||
LD A,8 ; CALCULATE THE FUNCTION TABLE |
|||
CALL ADDHLA ; POSITION WHICH FOLLOWS THE |
|||
PUSH HL ; CONFIGURATION TABLE OF EACH |
|||
POP BC ; DEVICE |
|||
|
|||
TYPFND: PUSH AF ;D |
|||
LD A,'f' ;D |
|||
CALL COUT ;D |
|||
POP AF ;D |
|||
PUSH BC ;D |
|||
CALL PRTHEXWORD ;D FUNCTION TABLE |
|||
POP BC ;D |
|||
CALL NEWLINE ;D |
|||
|
|||
PUSH IY ; ADD ENTRY IF PIO FOUND, BC:DE |
|||
POP DE ; BC: DRIVER FUNCTION TABLE |
|||
CALL CIO_ADDENT ; DE: ADDRESS OF UNIT INSTANCE DATA |
|||
|
|||
BADINIT:POP BC ; RESTORE LOOP CONTROL |
|||
|
|||
INC C ; NEXT PHYSICAL UNIT |
|||
SKPINIT:DJNZ PIO_PREINIT0 ; LOOP UNTIL DONE |
|||
|
|||
PUSH AF ;D |
|||
PRTS("INTS=$") ;D |
|||
LD A,(INT_ALLOC) ;D |
|||
CALL PRTHEXBYTE ;D |
|||
POP AF ;D |
|||
PUSH DE ;D |
|||
LD DE,CIO_TBL-3 ;D |
|||
CALL DUMP_BUFFER ;D |
|||
POP DE ;D |
|||
XOR A ; SIGNAL SUCCESS |
|||
RET ; AND RETURN |
|||
; |
|||
; INDEX INTO THE CONFIG TABLE |
|||
; ON ENTRY C = UNIT NUMBER |
|||
; ON EXIT IY = CONFIG DATA POINTER |
|||
; ON EXIT DE = CONFIG TABLE START |
|||
; |
|||
; EACH CONFIG TABLE IS 24 BYTES LONG |
|||
; |
|||
CFG_SIZ .EQU 24 |
|||
; |
|||
IDXCFG: LD A,C |
|||
RLCA ; X 2 |
|||
RLCA ; X 4 |
|||
RLCA ; X 8 |
|||
LD H,0 |
|||
LD L,A ; HL = X 8 |
|||
PUSH HL |
|||
ADD HL,HL ; HL = X 16 |
|||
POP DE |
|||
ADD HL,DE ; HL = X 24 |
|||
LD DE,PIO_CFG |
|||
ADD HL,DE |
|||
PUSH HL ; COPY CFG DATA PTR |
|||
POP IY ; ... TO IY |
|||
RET |
|||
|
|||
; PIO_INITDEV - INITIALIZE DEVICE |
|||
; |
|||
; IF DE = FFFF THEN THE SETUP PARAMETER WORD WILL BE READ FROM THE DEVICE CONFIGURATION |
|||
; TABLE POINTED TO BY IY AND THE PIO PORT WILL BE PROGRAMMED BASED ON THAT CONFIGURATION. |
|||
; |
|||
; OTHERWISE THE PIO PORT WILL BE PROGRAMMED BY THE SETUP PARAMETER WORD IN DE AND THIS |
|||
; WILL BE SAVED IN THE DEVICE CONFIGURATION TABLE POINTED TO BY IY. |
|||
; |
|||
; ALL OTHER CONFIGURATION OF THE DEVICE CONFIGURATION TABLE IS DONE UPSTEAM BY PIO_PREINIT |
|||
|
|||
PIO_INITDEV: |
|||
; TEST FOR -1 (FFFF) WHICH MEANS USE CURRENT CONFIG (JUST REINIT) |
|||
LD A,D ; TEST DE FOR |
|||
AND E ; ... VALUE OF -1 |
|||
INC A ; ... SO Z SET IF -1 |
|||
JR NZ,PIO_INITDEV1 ; IF DE == -1, REINIT CURRENT CONFIG |
|||
PIO_INITDEV0: |
|||
; LOAD EXISTING CONFIG (DCW) TO REINIT |
|||
LD E,(IY+4) ; LOW BYTE |
|||
LD D,(IY+5) ; HIGH BYTE |
|||
; |
|||
PIO_INITDEV1: ; WHICH DEVICE TYPE? |
|||
LD A,(IY+1) |
|||
CP PIO_ZPIO |
|||
JR Z,SETPIO0 |
|||
CP PIO_8255 |
|||
JP Z,SET_8255 |
|||
CP PIO_PORT |
|||
JP Z,SET_PORT |
|||
BAD_SET:OR $FF ; UNKNOWN DEVICE |
|||
RET |
|||
|
|||
SETPIO0:LD A,E ; GET MODE |
|||
AND 11000000B ; BITS (B7B6) |
|||
CP 10000000B ; IS IT BIDIR? |
|||
JR NZ,SETPIO1 |
|||
LD A,(IY+2) ; GET CHANNEL |
|||
OR A |
|||
JR NZ,BAD_SET ; CAN'T DO ON CH1 |
|||
|
|||
; VALIDATE INTERRUPT REQUEST |
|||
; GRANT INTERRUPT IF THERE IS A FREE INTERRUPT |
|||
; GRANT INTERRUPT IF AN INTERRUPT IS ALREADY ALLOCATED TO THIS UNIT |
|||
|
|||
SETPIO1:PUSH AF ;D |
|||
LD A,'[' ;D |
|||
CALL COUT ;D |
|||
LD A,(IY) ;D |
|||
CALL PRTHEXBYTE ;D |
|||
LD A,']' ;D |
|||
CALL COUT ;D |
|||
POP AF ;D |
|||
|
|||
BIT 2,E ; SKIP IF WE ARE NOT REQUESTING |
|||
JP Z,SETPIO2 ; AN INTERRUPT |
|||
|
|||
PRTS("[INTREQ]$") ;D |
|||
|
|||
; LD A,(IY+4) ; GET CURRENT INTERRUPT SETTING |
|||
; BIT 2,A ; SKIP IF IT IS ALREADY |
|||
; JP NZ,SETPIO2 ; ALLOCATED TO THIS UNIT |
|||
|
|||
LD A,(INT_ALLOC) ; WE NEED TO ALLOCATE AN |
|||
CP INT_ALLOW ; INTERRUPT. DO WE HAVE |
|||
JR NC,BAD_SET ; ONE FREE? |
|||
|
|||
PRTS("[ALLOCINT]$") ;D |
|||
|
|||
; WHICH INTERRUPT IS FREE ? |
|||
; SCAN THROUGH THE CFG TABLES |
|||
; AND FIND A FREE ONE |
|||
|
|||
PUSH AF ; NESTED LOOP |
|||
LD DE,CFG_SIZ ; OUTSIDE LOOP IS INTERRUPT |
|||
LD B,INT_ALLOW ; INSIDE LOOP IS DEVICE |
|||
SETPIOP: LD C,B |
|||
DEC C |
|||
PUSH BC |
|||
LD B,PIO_CNT |
|||
LD HL,PIO_CFG+4 |
|||
SETPIOX: LD A,(HL) |
|||
BIT 2,A ; JUMP TO NEXT DEVICE |
|||
JR Z,SETPIOY ; IF NO INTERRUPT ON |
|||
AND 00000011B ; THIS DEVICE |
|||
|
|||
CP C ; IF WE MATCH AN INTERRUPT HERE THEN IT IS NOT FREE. |
|||
JR NZ,SETPIOY ; SO EXIT INSIDE LOOP AND TRY NEXT INTERRUPT |
|||
|
|||
XOR A ; WE MATCH INT 0 - IF WE ARE CHECKING FOR IT THEN |
|||
OR C ; WE REGARD IS AS FREE. |
|||
JR NZ,SETPIOZ |
|||
|
|||
SETPIOY: ADD HL,DE |
|||
DJNZ SETPIOX |
|||
|
|||
JR SETPIOQ ; WE GET HERE IF THE CURRENT INTERRUPT |
|||
; WAS NOT MATCHED SO IT IS FREE |
|||
SETPIOZ: POP BC |
|||
DJNZ SETPIOP |
|||
POP AF |
|||
|
|||
PRTS("[NONEFREE]$") |
|||
RET |
|||
|
|||
SETPIOQ:PUSH AF ; AVAILABLE INTERRUPT IS IN C |
|||
PRTS("[FREE]=$") |
|||
LD A,C |
|||
CALL PRTHEXBYTE |
|||
POP AF |
|||
|
|||
POP AF |
|||
POP AF |
|||
|
|||
SETPIOR:LD HL,INT_ALLOC ; INCREASE THE COUNT |
|||
INC (HL) ; OF USED INTERRUPTS |
|||
LD A,(HL) |
|||
|
|||
; LD A,(IY) ; IS THIS UNIT |
|||
; INC A ; UNITIALIZED? |
|||
; JR Z,SETPIO6 |
|||
|
|||
LD A,(IY+4) ; IT IS UNITIALIZED SO |
|||
OR C ; SAVE THE ALLOCATES |
|||
LD (IY+4),A ; INTERRUPT |
|||
; |
|||
; FOR THIS DEVICE AND INTERRUPT, UPDATE THE CONFIG TABLE FOR THIS DEVICE. |
|||
; PIO_IN, PIO_OUT, PIO_IST, PIO_OST ENTRIES NEED TO BE REDIRECTED. |
|||
; INTERRUPT VECTOR NEEDS TO BE UPDATED |
|||
; |
|||
LD A,(IY+0) |
|||
LD HL,0 |
|||
; SETUP PIO INTERRUPT VECTOR IN IVT |
|||
LD HL,HBX_IV09+1 |
|||
|
|||
; CALL SPK_BEEP |
|||
; |
|||
SETPIO6:RET |
|||
|
|||
; EXIT WITH FREE INTERRUPT IN C |
|||
|
|||
LD A,C |
|||
LD (INT_ALLOC),A |
|||
|
|||
LD A,E |
|||
AND 11000000B |
|||
OR 00000100B |
|||
OR C |
|||
LD E,A |
|||
LD (IY+5),A |
|||
; |
|||
; TODO: DEALLOCATE AN INTERRUPT |
|||
; |
|||
; LD A,(INT_ALLOC) |
|||
; DEC A |
|||
; LD (INT_ALLOC),A |
|||
; |
|||
SETPIO2: |
|||
|
|||
; DE CONTAINS THE MODE IF INTERRUPT ROUTINE SKIPPED |
|||
|
|||
PRTS("[NOINTREQ]$") ;D |
|||
|
|||
; LD A,(IY+4) |
|||
LD A,E ; GET MODE AND CREATE COMMAND |
|||
AND 11000000B ; $B0 |
|||
OR 00001111B ; $0F |
|||
|
|||
LD C,(IY+3) ; GET DATA PORT |
|||
INC C ; POINT TO CMD |
|||
INC C ; PORT |
|||
OUT (C),A ; SET MODE |
|||
CP (M_BitCtrl | $0F) ; IF MODE 3 |
|||
JR NZ,SETPIO3 |
|||
LD A,(IY+5) ; SET I/O DIRECTION |
|||
OUT (C),A ; FOR MODE 3 |
|||
|
|||
SETPIO3:; INTERUPT HANDLING |
|||
|
|||
JP SETPIO4 |
|||
|
|||
; SETUP THE INTERRUPT VECTOR |
|||
|
|||
LD A,E |
|||
AND 00000011B |
|||
; DEC A ; INDEX INTO THE |
|||
ADD A,A ; THE VECTOR TABLE |
|||
ADD A,A ; |
|||
LD C,A |
|||
LD B,0 |
|||
LD HL,HBX_IV09+1 |
|||
ADD HL,BC ; GET THE ADDRESS OF |
|||
PUSH DE |
|||
LD D,(HL) ; THAT INTERRUPT |
|||
INC HL ; HANDLER |
|||
LD E,(HL) |
|||
LD HL,0 ;HBX_IVT+IVT_PIO0 ; POPULATE THE |
|||
LD A,L ; GET LOW BYTE OF IVT ADDRESS |
|||
ADD HL,BC ; INTERRUPT TABLE |
|||
LD (HL),D ; WITH THE INTERRUPT |
|||
INC HL ; HANDLER ADDRESS FOR |
|||
LD (HL),E ; THIS UNIT |
|||
POP DE |
|||
LD HL,INT_ALLOC |
|||
LD C,(HL) |
|||
LD B,0 |
|||
LD HL,PRTTAB-1 ; SAVE THE DATA |
|||
ADD HL,BC ; PORT FOR EACH INTERRUPT |
|||
LD C,(IY+3) |
|||
LD (HL),C |
|||
|
|||
INC C ; POINT TO CMD PORT |
|||
INC C |
|||
DI ; SET THE VECTOR ADDRESS |
|||
OUT (C),A |
|||
|
|||
; LD A,10000011B ; ENABLE INTERRUPTS ON |
|||
OUT (C),A ; THIS UNIT |
|||
EI |
|||
; JR GUD_SET |
|||
; |
|||
SETPIO4:LD A,00000111B ; $07 |
|||
OUT (C),A ; NO INTERRUPTS |
|||
; |
|||
; SUCCESSFULL SO SAVE DEVICE CONFIGURATION WORD (DCW) |
|||
; |
|||
GUD_SET:LD (IY+4),E ; LOW BYTE |
|||
LD (IY+5),D ; HIGH BYTE |
|||
; |
|||
; UPDATE THE DEVICE TABLE WITH THE ADDRESSES FOR THE CORRECT ROUTINE. |
|||
; |
|||
LD A,E |
|||
AND 00000111B |
|||
LD HL,INTMATRIX ; POINT TO EITHER THE INTERRUPT |
|||
JR NZ, USEIM |
|||
LD HL,POLMATRIX ; MATRIX OR THE POLLED MATRIX |
|||
USEIM: PUSH HL |
|||
|
|||
PUSH IY ; CALCULATE THE DESTINATION |
|||
POP HL ; ADDRESS IN THE PIO_CFG TABLE |
|||
LD BC,8 ; FOR THE FOUR ADDESSES TO BE |
|||
ADD HL,BC ; COPIED TO |
|||
|
|||
; LD B,0 ; 00000000 CALCULATE THE SOURCE ADDRESS |
|||
LD C,E ; XX?????? FROM THE MATRIX. EACH ENTRY |
|||
SRL C ; 0XX????? IN THE MATRIX IS 8 BYTES SO |
|||
SRL C ; 00XX???? SOURCE = MATRIX BASE + (8 * MODE) |
|||
SRL C ; 000XX??? |
|||
POP DE ; LOAD THE MATRIX BASE |
|||
; LD DE,POLMATRIX |
|||
EX DE,HL |
|||
ADD HL,BC ; HL = SOURCE |
|||
|
|||
LD C,8 ; COPY 8 BYTES |
|||
LDIR |
|||
|
|||
; PUSH IY |
|||
; POP DE |
|||
; CALL DUMP_BUFFER |
|||
|
|||
XOR A |
|||
RET |
|||
|
|||
PRTTAB: .DB 0 |
|||
.DB 0 |
|||
.DB 0 |
|||
.DB 0 |
|||
; |
|||
;----------------------------------------------------------------------------- |
|||
; |
|||
; INPUT INTERRUPT VECTOR MACRO AND DEFINITION FOR FOUR PORTS |
|||
; |
|||
#DEFINE PIOMIVT(PIOIN,PIOIST,PIOPRT) \ |
|||
#DEFCONT ;\ |
|||
#DEFCONT ; RETURN WITH ERROR IF THERE IS \ |
|||
#DEFCONT ; ALREADY A CHARACTER IN BUFFER \ |
|||
#DEFCONT ;\ |
|||
#DEFCONT ; OTHERWISE CHANGE THE STATUS TO \ |
|||
#DEFCONT ; SHOW THERE IS ONE CHARACTER IN \ |
|||
#DEFCONT ; THE BUFFER AND READ IT IN AND \ |
|||
#DEFCONT ; AND STORE IT.RETURN GOOD STATUS.\ |
|||
#DEFCONT ;\ |
|||
#DEFCONT \ LD A,(_CIST) |
|||
#DEFCONT \ OR A |
|||
#DEFCONT \ JR NZ,_OVFL |
|||
#DEFCONT \ LD A,(PIOPRT) |
|||
#DEFCONT \ LD C,A |
|||
#DEFCONT \ LD A,1 |
|||
#DEFCONT \ LD (_CIST),A |
|||
#DEFCONT \ IN A,(C) |
|||
#DEFCONT \ LD (_CICH),A |
|||
#DEFCONT \ OR $FF |
|||
#DEFCONT \ RET |
|||
#DEFCONT \_OVFL:XOR A |
|||
#DEFCONT \ RET |
|||
#DEFCONT ;\ |
|||
#DEFCONT ;\ |
|||
#DEFCONT ;\ |
|||
#DEFCONT ;\ |
|||
#DEFCONT ;\ |
|||
#DEFCONT ;\ |
|||
#DEFCONT \PIOIN:CALL PIOIST |
|||
#DEFCONT \ JR Z,PIOIN |
|||
#DEFCONT \ LD A,(_CICH) |
|||
#DEFCONT \ LD E,A |
|||
#DEFCONT \ XOR A |
|||
#DEFCONT \ LD (_CIST),A |
|||
#DEFCONT \ RET |
|||
#DEFCONT ;\ |
|||
#DEFCONT ; If THERE A CHARACTER \ |
|||
#DEFCONT ; AVAILABLE? RETURN NUMBER \ |
|||
#DEFCONT ; IN A - 0 OR 1 \ |
|||
#DEFCONT ;\ |
|||
#DEFCONT \PIOIST:LD A,(_CIST) |
|||
#DEFCONT \ AND 00000001B |
|||
#DEFCONT \ RET |
|||
#DEFCONT ;\ |
|||
#DEFCONT ; CIST : 01 = CHARACTER READY ELSE NOT READY \ |
|||
#DEFCONT ; CISH : CHARACTER STORED BY INTERRUPT \ |
|||
#DEFCONT ;\ |
|||
#DEFCONT \_CIST .DB 00 |
|||
#DEFCONT \_CICH .DB 00 |
|||
; |
|||
PIOIVT0:.MODULE PIOIVT0 |
|||
PIOMIVT(PIO0IN,PI0_IST,PRTTAB+0) |
|||
PIOIVT1:.MODULE PIOIVT1 |
|||
PIOMIVT(PIO1IN,PI1_IST,PRTTAB+1) |
|||
PIOIVT2:.MODULE PIOIVT2 |
|||
PIOMIVT(PIO2IN,PI2_IST,PRTTAB+2) |
|||
PIOIVT3:.MODULE PIOIVT3 |
|||
PIOMIVT(PIO3IN,PI3_IST,PRTTAB+3) |
|||
; |
|||
;----------------------------------------------------------------------------- |
|||
; |
|||
; OUTPUT INTERRUPT VECTOR MACRO AND DEFINITION FOR FOUR PORTS |
|||
; |
|||
; AN INTERRUPT IS GENERATED WHEN THE RECEIVING DEVICE CAN ACCEPT A CHARACTER |
|||
; |
|||
#DEFINE PIOMOVT(PIOOUT,PIOOST,PIOPRT) \ |
|||
#DEFCONT ;\ |
|||
#DEFCONT ; RETURN IF WE ARE WAITING FOR A \ |
|||
#DEFCONT ; CHARACTER (COST = 00) \ |
|||
#DEFCONT ;\ |
|||
#DEFCONT ; IF ZERO CHARACTERS READY |
|||
#DEFCONT ; (COST = 01) CHANGE STATUS TO \ |
|||
#DEFCONT ; WAITING FOR CHARACTER (COST 00) \ |
|||
#DEFCONT ;\ |
|||
#DEFCONT ; IF A CHARACTER IS READY THEN \ |
|||
#DEFCONT ; OUTPUT AND CHANGE STATUS TO \ |
|||
#DEFCONT ; ZERO CHARACTERS READY \ |
|||
#DEFCONT ;\ |
|||
#DEFCONT \ LD A,(_COST) |
|||
#DEFCONT \ DEC A |
|||
#DEFCONT \ RET M |
|||
#DEFCONT \ JR Z,_WFC |
|||
#DEFCONT \ LD A,(_COCH) |
|||
#DEFCONT \ LD E,A |
|||
#DEFCONT \_ONOW:LD A,(PIOPRT) |
|||
#DEFCONT \ LD C,A |
|||
#DEFCONT \ OUT (C),E |
|||
#DEFCONT \ LD A,1 |
|||
#DEFCONT \_WFC: LD (_COST),A |
|||
#DEFCONT \ RET |
|||
#DEFCONT ;\ |
|||
#DEFCONT ; WAIT FOR SPACE FOR THE CHARACTER\ |
|||
#DEFCONT ; IF WE ARE WAITING FOR A \ |
|||
#DEFCONT ; CHARACTRE THEN OUTPUT IT NOW \ |
|||
#DEFCONT ; OTHERWISE STORE IT UNTIL THE \ |
|||
#DEFCONT ; INTERRUPT CALLS FOR IT \ |
|||
#DEFCONT ;\ |
|||
#DEFCONT \PIOOUT:LD A,(_COST) |
|||
#DEFCONT \ CP 2 |
|||
#DEFCONT \ JR C,_ONOW |
|||
#DEFCONT \ LD A,E |
|||
#DEFCONT \ LD (_COCH),A |
|||
#DEFCONT \ LD A,2 |
|||
#DEFCONT \ LD (_COST),A |
|||
#DEFCONT \ JR PIOOUT |
|||
#DEFCONT ;\ |
|||
#DEFCONT ; RETURN WITH NUMBER OF \ |
|||
#DEFCONT ; CHARACTERS AVAILABLE 0 or 1 \ |
|||
#DEFCONT ;\ |
|||
#DEFCONT \PIOOST:LD A,(_COST) |
|||
#DEFCONT \ DEC A |
|||
#DEFCONT \ DEC A |
|||
#DEFCONT \ RET Z |
|||
#DEFCONT \ LD A,1 |
|||
#DEFCONT \ RET |
|||
#DEFCONT ;\ |
|||
#DEFCONT ; COST : 00 WAITING FOR CHARACTER\ |
|||
#DEFCONT ; 01 ZERO CHARACTERS READY\ |
|||
#DEFCONT ; 02 ONE CHARACTER READY \ |
|||
#DEFCONT ; COCH : CHARACTER TO OUTPUT \ |
|||
#DEFCONT ;\ |
|||
#DEFCONT \_COST .DB 01 |
|||
#DEFCONT \_COCH .DB 00 |
|||
; |
|||
PIOOVT0:.MODULE PIOOVT0 |
|||
PIOMOVT(PIO0OUT,PI0_OST,PRTTAB+0) |
|||
PIOOVT1:.MODULE PIOOVT1 |
|||
PIOMOVT(PIO1OUT,PI1_OST,PRTTAB+1) |
|||
PIOOVT2:.MODULE PIOOVT2 |
|||
PIOMOVT(PIO2OUT,PI2_OST,PRTTAB+2) |
|||
PIOOVT3:.MODULE PIOOVT3 |
|||
PIOMOVT(PIO3OUT,PI3_OST,PRTTAB+3) |
|||
; |
|||
;----------------------------------------------------------------------------- |
|||
; |
|||
; NON INTERRUPT OUTPUT ROUTINE - SHARED |
|||
; |
|||
; INPUT WILL ALWAYS RETURN ERROR, CHARACTER RETURNED IS UNDEFINED. |
|||
; OUTPUT WILL ALWAYS RETURN SUCCESS |
|||
; INPUT-STATUS WILL ALWAYS RETURN 0 CHARACTERS IN BUFFER. |
|||
; OUTPUT-STATUS WILL ALWAYS RETURN 1 CHARACTER SPACE IN BUFFER. |
|||
|
|||
PIOSHO_IN: |
|||
LD A,1 |
|||
RET |
|||
; |
|||
PIOSHO_OUT: |
|||
LD C,(IY+3) |
|||
OUT (C),E |
|||
XOR A |
|||
RET |
|||
; |
|||
PIOSHO_IST: XOR A |
|||
RET |
|||
; |
|||
PIOSH_OST: |
|||
LD A,1 |
|||
RET |
|||
; |
|||
;----------------------------------------------------------------------------- |
|||
; |
|||
; NON INTERRUPT INPUT ROUTINE - SHARED |
|||
; |
|||
; INPUT WILL ALWAYS A CHARACTER AND SUCCESS. |
|||
; OUTPUT WILL ALWAYS RETURN FAILURE |
|||
; INPUT STATUS WILL ALWAYS RETURN 1 CHARACTER IN BUFFER. |
|||
;OUTPUT-STATUS WILL ALWAYS RETURN 0 CHARACTER SPACE IN BUFFER. |
|||
; |
|||
PIOSHI_IN: |
|||
LD C,(IY+3) |
|||
IN A,(C) |
|||
LD E,A |
|||
XOR A |
|||
RET |
|||
; |
|||
PIOSHI_OUT: |
|||
LD A,1 |
|||
RET |
|||
; |
|||
PIOSH_IST: |
|||
LD A,1 |
|||
RET |
|||
; |
|||
PIOSHI_OST: |
|||
XOR A |
|||
RET |
|||
; |
|||
;----------------------------------------------------------------------------- |
|||
; |
|||
; ON ENTRY IY POINTS TO THE DEVICE RECORD. GET AND RETURN THE CONFIGURATION WORD IN DE |
|||
; |
|||
PIO_QUERY: |
|||
PPI_QUERY: |
|||
LD E,(IY+4) ; FIRST CONFIG BYTE TO E |
|||
LD D,(IY+5) ; SECOND CONFIG BYTE TO D |
|||
XOR A ; SIGNAL SUCCESS |
|||
RET |
|||
; |
|||
;----------------------------------------------------------------------------- |
|||
; |
|||
; ON ENTRY IY POINTS TO THE DEVICE RECORD. FOR CHARACTER DEVICES BIT 6 OF ATTRIBUTE |
|||
; INDICATES PARALLEL PORT IF 1 SO WE SET IT. COMMON TO ALL PORTS |
|||
; |
|||
PIO_DEVICE: |
|||
PPI_DEVICE: |
|||
LD D,CIODEV_PIO ; D := DEVICE TYPE |
|||
LD E,(IY) ; E := PHYSICAL UNIT |
|||
LD C,$40 ; C := ATTRIBUTE |
|||
LD H,0 ; H := 0, DRIVER HAS NO MODES |
|||
LD L,(IY+3) ; L := BASE I/O ADDRESS |
|||
XOR A ; SIGNAL SUCCESS |
|||
RET |
|||
; |
|||
INTMATRIX: |
|||
.DW PIO0IN, PIO0OUT, PI0_IST, PI0_OST |
|||
.DW PIO1IN, PIO1OUT, PI1_IST, PI1_OST |
|||
.DW PIO2IN, PIO2OUT, PI2_IST, PI2_OST |
|||
.DW PIO3IN, PIO3OUT, PI3_IST, PI3_OST |
|||
POLMATRIX: |
|||
.DW PIOSHO_IN, PIOSHO_OUT, PIOSHO_IST, PIOSH_OST ; OUTPUT |
|||
.DW PIOSHI_IN, PIOSHI_OUT, PIOSH_IST, PIOSHI_OST ; INPUT |
|||
.DW 0,0,0,0 ; BIDIR |
|||
.DW 0,0,0,0 ; BIT MODE |
|||
|
|||
SET_8255: |
|||
RET |
|||
; |
|||
SET_BYE: |
|||
XOR A ; SIGNAL SUCCESS |
|||
RET |
|||
; |
|||
; ------------------------------------ |
|||
; i8255 FUNCTION TABLE ROUTINES |
|||
;------------------------------------- |
|||
|
|||
PPI_IN: |
|||
XOR A ; SIGNAL SUCCESS |
|||
RET |
|||
; |
|||
PPI_OUT: |
|||
XOR A ; SIGNAL SUCCESS |
|||
RET |
|||
; |
|||
PPI_IST: |
|||
RET |
|||
; |
|||
PPI_OST: |
|||
RET |
|||
; |
|||
; PIO_INITDEV - Configure device. |
|||
; If DE = FFFF then extract the configuration information from the table of devices and program the device using those settings. |
|||
; Otherwise use the configuration information in DE to program those settings and save them in the device table |
|||
|
|||
PPI_INITDEV: |
|||
XOR A ; SIGNAL SUCCESS |
|||
RET |
|||
PPI_INT:OR $FF ; NZ SET TO INDICATE INT HANDLED |
|||
RET |
|||
; |
|||
PIO_PRTCFG: |
|||
; ANNOUNCE PORT |
|||
CALL NEWLINE ; FORMATTING |
|||
PRTS("PIO$") ; FORMATTING |
|||
LD A,(IY) ; DEVICE NUM |
|||
CALL PRTDECB ; PRINT DEVICE NUM |
|||
PRTS(": IO=0x$") ; FORMATTING |
|||
LD A,(IY+3) ; GET BASE PORT |
|||
CALL PRTHEXBYTE ; PRINT BASE PORT |
|||
; |
|||
; PRINT THE PIO TYPE |
|||
CALL PC_SPACE ; FORMATTING |
|||
LD A,(IY+1) ; GET PIO TYPE BYTE |
|||
LD DE,PIO_TYPE_STR ; POINT HL TO TYPE MAP TABLE |
|||
CALL PRTIDXDEA |
|||
|
|||
; ALL DONE IF NO PIO WAS DETECTED |
|||
LD A,(IY+1) ; GET PIO TYPE BYTE |
|||
OR A ; SET FLAGS |
|||
RET Z ; IF ZERO, NOT PRESENT |
|||
; |
|||
PRTS(" MODE=$") ; FORMATTING |
|||
LD E,(IY+4) ; LOAD CONFIG |
|||
LD D,(IY+5) ; ... WORD TO DE |
|||
CALL PS_PRTPC0 ; PRINT CONFIG |
|||
; |
|||
LD A,(IY+4) ; PRINT |
|||
BIT 2,A ; ALLOCATED |
|||
JR Z,NOINT ; INTERRUPT |
|||
PRTS("/i$") |
|||
LD A,(IY+4) |
|||
AND 00000011B |
|||
CALL PRTDECB |
|||
NOINT: XOR A |
|||
RET |
|||
; |
|||
; WORKING VARIABLES |
|||
; |
|||
PIO_DEV .DB 0 ; DEVICE NUM USED DURING INIT |
|||
; |
|||
; DESCRIPTION OF DIFFERENT PORT TYPES |
|||
; |
|||
PIO_TYPE_STR: |
|||
.TEXT "<NOT PRESENT>$" ; IDX 0 |
|||
.TEXT "Zilog PIO$" ; IDX 1 |
|||
.TEXT "i8255 PPI$" ; IDX 2 |
|||
.TEXT "IO Port$" ; IDX 3 |
|||
; |
|||
; Z80 PIO PORT TABLE - EACH ENTRY IS FOR 1 CHIP I.E. TWO PORTS |
|||
; |
|||
; 32 BYTE DATA STRUCTURE FOR EACH PORT |
|||
; |
|||
; .DB 0 ; IY+0 CIO DEVICE NUMBER (SET DURING PRE-INIT, THEN FIXED) |
|||
; .DB 0 ; IY+1 PIO TYPE (SET AT ASSEMBLY, FIXED) |
|||
; .DB 0 ; IY+2 PIO CHANNEL (SET AT ASSEMBLY, FIXED) |
|||
; .DB PIOBASE+2 ; IY+3 BASE DATA PORT (SET AT ASSEMBLY, FIXED) |
|||
; .DB 0 ; IY+4 SPW - MODE 3 I/O DIRECTION BYTE (SET AT ASSEMBLE, SET WITH INIT) |
|||
; .DB 0 ; IY+5 SPW - MODE, INTERRUPT (SET AT ASSEMBLY, SET WITH INIT) |
|||
; .DW 0 ; IY+6/7 FUNCTION TABLE (SET AT ASSEMBLY, SET DURING PRE-INIT AND AT INIT) |
|||
; .DW PIO_IN ; IY+8 ADDR FOR DEVICE INPUT (SET WITH INIT) |
|||
; .DW PIO_OUT ; IY+10 ADDR FOR DEVICE OUTPUT (SET WITH INIT) |
|||
; .DW PIO_IST ; IY+12 ADDR FOR DEVICE INPUT STATUS (SET WITH INIT) |
|||
; .DW PIO_OST ; IY+14 ADDR FOR DEVICE OUTPUT STATUS (SET WITH INIT) |
|||
; .DW PIO_INITDEV ; IY+16 ADDR FOR INITIALIZE DEVICE ROUTINE (SET AT ASSEMBLY, FIXED) |
|||
; .DW PIO_QUERY ; IY+18 ADDR FOR QUERY DEVICE RECORD ROUTINE (SET AT ASSEMBLY, FIXED) |
|||
; .DW PIO_DEVICE ; IY+20 ADDR FOR DEVICE TYPE ROUTINE (SET AT ASSEMBLY, FIXED) |
|||
; .FILL 10 |
|||
; |
|||
; SETUP PARAMETER WORD: |
|||
; |
|||
; +-------------------------------+ +-------+-----------+---+-------+ |
|||
; | BIT CONTROL | | MODE | | A | INT | |
|||
; +-------------------------------+ --------------------+-----------+ |
|||
; F E D C B A 9 8 7 6 5 4 3 2 1 0 |
|||
; -- MSB (D REGISTER) -- -- LSB (E REGISTER) -- |
|||
; |
|||
; |
|||
; MSB = BIT CONTROL MAP USE IN MODE 3 |
|||
; |
|||
; MODE B7 B6 = 00 Mode 0 Output |
|||
; 01 Mode 1 Input |
|||
; 10 Mode 2 Bidir |
|||
; 11 Mode 3 Bit Mode |
|||
; |
|||
; INTERRUPT ALLOCATED B2 = 0 NOT ALLOCATED |
|||
; = 1 IS ALLOCATED |
|||
; |
|||
; WHICH IVT IS ALLOCATES B1 B0 00 IVT_PIO0 |
|||
; 01 IVT_PIO1 |
|||
; 10 IVT_PIO2 |
|||
; 11 IVT_PIO3 |
|||
; |
|||
#DEFINE DEFPIO(MPIOBASE,MPIOCH0,MPIOCH1,MPIOCH0X,MPIOCH1X,MPIOIN0,MPIOIN1) \ |
|||
#DEFCONT \ .DB 0 |
|||
#DEFCONT \ .DB PIO_ZPIO |
|||
#DEFCONT \ .DB 0 |
|||
#DEFCONT \ .DB MPIOBASE |
|||
#DEFCONT \ .DB (MPIOCH0|MPIOIN0) |
|||
#DEFCONT \ .DB MPIOCH0X |
|||
#DEFCONT \ .DW 0 |
|||
#DEFCONT \ .DW 0,0,0,0, PIO_INITDEV,PIO_QUERY,PIO_DEVICE |
|||
#DEFCONT \ .FILL 2 |
|||
#DEFCONT \ .DB 0 |
|||
#DEFCONT \ .DB PIO_ZPIO |
|||
#DEFCONT \ .DB 1 |
|||
#DEFCONT \ .DB MPIOBASE+1 |
|||
#DEFCONT \ .DB (MPIOCH1|MPIOIN1) |
|||
#DEFCONT \ .DB MPIOCH1X |
|||
#DEFCONT \ .DW 0 |
|||
#DEFCONT \ .DW 0,0,0,0, PIO_INITDEV,PIO_QUERY,PIO_DEVICE |
|||
#DEFCONT \ .FILL 2 |
|||
; |
|||
; i8255 PORT TABLE - EACH ENTRY IS FOR 1 CHIP I.E. THREE PORTS |
|||
; |
|||
#DEFINE DEFPPI(MPPIBASE,MPPICH1,MPPICH2,MPPICH3,MPPICH1X,MPPICH2X,MPPICH3X) \ |
|||
#DEFCONT \ .DB 0 |
|||
#DEFCONT \ .DB PIO_8255 |
|||
#DEFCONT \ .DB 0 |
|||
#DEFCONT \ .DB MPPIBASE |
|||
#DEFCONT \ .DB (MPPICH1|00001000B) |
|||
#DEFCONT \ .DB MPPICH1X |
|||
#DEFCONT \ .DW 0 |
|||
#DEFCONT \ .DW PPI_IN,PPI_OUT,PPI_IST,PPI_OST,PPI_INITDEV,PPI_QUERY,PPI_DEVICE |
|||
#DEFCONT \ .FILL 2 |
|||
#DEFCONT \ .DB 0 |
|||
#DEFCONT \ .DB PIO_8255 |
|||
#DEFCONT \ .DB 1 |
|||
#DEFCONT \ .DB MPPIBASE+2 |
|||
#DEFCONT \ .DB (MPPICH2|00010000B) |
|||
#DEFCONT \ .DB MPPICH2X |
|||
#DEFCONT \ .DW 0 |
|||
#DEFCONT \ .DW PPI_IN,PPI_OUT,PPI_IST,PPI_OST,PPI_INITDEV,PPI_QUERY,PPI_DEVICE |
|||
#DEFCONT \ .FILL 2 |
|||
#DEFCONT \ .DB 0 |
|||
#DEFCONT \ .DB PIO_8255 |
|||
#DEFCONT \ .DB 2 |
|||
#DEFCONT \ .DB MPPIBASE+4 |
|||
#DEFCONT \ .DB (MPPICH3|00100000B) |
|||
#DEFCONT \ .DB MPPICH3X |
|||
#DEFCONT \ .DW 0 |
|||
#DEFCONT \ .DW PPI_IN,PPI_OUT,PPI_IST,PPI_OST,PPI_INITDEV,PPI_QUERY,PPI_DEVICE |
|||
#DEFCONT \ .FILL 2 |
|||
; |
|||
; HERE WE ACTUALLY DEFINE THE HARDWARE THAT THE HBIOS CAN ACCESS |
|||
; THE INIT ROUTINES READ AND SET THE INITIAL MODES FROM THIS INFO |
|||
; |
|||
PIO_CFG: |
|||
; |
|||
#IF PIO_4P |
|||
DEFPIO(PIO4BASE+0,M_Output,M_Input,M_BitAllOut,M_BitAllOut,INT_N,INT_N) |
|||
DEFPIO(PIO4BASE+4,M_Input,M_Input,M_BitAllOut,M_BitAllOut,INT_N,INT_N) |
|||
DEFPIO(PIO4BASE+8,M_Output,M_Output,M_BitAllOut,M_BitAllOut,INT_N,INT_N) |
|||
DEFPIO(PIO4BASE+12,M_Output,M_Output,M_BitAllOut,M_Output,INT_N,INT_N) |
|||
#ENDIF |
|||
#IF PIO_ZP |
|||
DEFPIO(PIOZBASE+0,M_Input,M_Input,M_BitAllOut,M_BitAllOut,INT_N,INT_N) |
|||
DEFPIO(PIOZBASE+4,M_Output,M_Output,M_BitAllOut,M_BitAllOut,INT_N,INT_N) |
|||
#ENDIF |
|||
; PIO_SBC & (PLATFORM == PLT_SBC) & (PPIDEMODE != PPIDEMODE_SBC)) |
|||
|
|||
#IF PIO_SBC |
|||
DEFPPI(PIOSBASE,M_Output,M_Output,M_Output,M_BitAllOut,M_BitAllOut,M_BitAllOut) |
|||
#ENDIF |
|||
; |
|||
PIO_CNT .EQU ($ - PIO_CFG) / CFG_SIZ |
|||
; |
|||
;------------------------------------------------------------------- |
|||
; WHEN WE GET HERE IY POINTS TO THE PIO_CFG TABLE WE ARE WORKING ON. |
|||
; C IS THE UNIT NUMBER |
|||
;------------------------------------------------------------------- |
|||
; |
|||
;PIO_INITUNIT: |
|||
; LD A,C ; SET THE UNIT NUMBER |
|||
; LD (IY),A |
|||
; |
|||
; LD DE,-1 ; LEAVE CONFIG ALONE |
|||
; CALL PIO_INITDEV ; IMPLEMENT IT AND RETURN |
|||
; XOR A ; SIGNAL SUCCESS |
|||
; RET ; AND RETURN |
|||
; |
|||
PIO_INIT: |
|||
; CALL SPK_BEEP |
|||
LD B,PIO_CNT ; COUNT OF POSSIBLE PIO UNITS |
|||
LD C,0 ; INDEX INTO PIO CONFIG TABLE |
|||
PIO_INIT1: |
|||
PUSH BC ; SAVE LOOP CONTROL |
|||
|
|||
; LD A,C ; PHYSICAL UNIT TO A |
|||
; RLCA ; MULTIPLY BY CFG TABLE ENTRY SIZE (32 BYTES) |
|||
; RLCA ; ... |
|||
; RLCA ; ... TO GET OFFSET INTO CFG TABLE |
|||
; RLCA |
|||
;; RLCA |
|||
; LD HL,PIO_CFG ; POINT TO START OF CFG TABLE |
|||
; PUSH AF |
|||
; CALL ADDHLA ; HL := ENTRY ADDRESS |
|||
; POP AF |
|||
; CALL ADDHLA ; HL := ENTRY ADDRESS |
|||
; PUSH HL ; COPY CFG DATA PTR |
|||
; POP IY ; ... TO IY |
|||
; POP IY ; ... TO IY |
|||
|
|||
CALL IDXCFG |
|||
|
|||
LD A,(IY+1) ; GET PIO TYPE |
|||
OR A ; SET FLAGS |
|||
CALL NZ,PIO_PRTCFG ; PRINT IF NOT ZERO |
|||
|
|||
; PUSH DE |
|||
; LD DE,$FFFF ; INITIALIZE DEVICE/CHANNEL |
|||
; CALL PIO_INITDEV ; BASED ON DPW |
|||
; POP DE |
|||
|
|||
POP BC ; RESTORE LOOP CONTROL |
|||
INC C ; NEXT UNIT |
|||
DJNZ PIO_INIT1 ; LOOP TILL DONE |
|||
; |
|||
XOR A ; SIGNAL SUCCESS |
|||
RET ; DONE |
|||
; |
|||
SET_PORT: |
|||
; DEVICE TYPE IS I/O PORT SO JUST WRITE $00 TO IT |
|||
LD C,(IY+3) |
|||
OUT (C),A |
|||
XOR A |
|||
RET |
|||
Loading…
Reference in new issue