gno/kern/drivers/port.asm

841 lines
13 KiB
NASM

* $Id: port.asm,v 1.1 1998/02/02 08:18:01 taubert Exp $
*
* 12/15/94 - select code added - Derek Taubert
*
case on
mcopy port.mac
copy ../gno/inc/tty.inc
copy equates
SerialHeader START
dtty ENTRY
ds t_open
* Line Discipline entry points
dc i4'DInit'
dc i4'DDeInit'
dc i4'DIOCTL'
dc i4'0' ; ttread and ttwrite must be
dc i4'0' ; set up by InstallDriver
dc i4'D_mutex'
dc i4'D_demutex'
dc i4'D_out_enq'
dc i4'D_in_enq'
dc i4'D_out_deq'
dc i4'D_in_deq'
dc i4'D_size_inq'
dc i4'D_size_outq'
ds t_signalIO-editInd
dc i4'nullfunc' ; t_signalIO
dc i2'$FFFF' ; t_select_proc
dc i4'D_select' ; t_select
dc i4'0' ; t_selwakeup jmp set up during install
END
D_in_enq START
rtl
END
D_mutex START
rtl
END
D_demutex START
rtl
END
D_select START
res equ 0
subroutine (2:ttyn,2:which,2:pid),2
jsl IncBusyFlag
lda #1
sta res
lda which ; which I/O to check?
cmp #SEL_READ
bne trywrite
jsl D_size_inq ; # bytes in in q
cmp #0
bne done
willwait anop
* record that the process wants to do I/O
lda >dtty+t_select_proc ; see if someone's here already
cmp #$FFFF ; nope
beq nocollision
cmp pid ; is it us?
beq nocollision
lda >dtty+privFlags
ora #TS_RCOLL
sta >dtty+privFlags
bra none
nocollision anop
lda pid ; set select_proc field to
sta >dtty+t_select_proc ; current process ID
bra none
trywrite cmp #SEL_WRITE
bne doexcept
bra done ; we can always write
; jsl D_left_outq ; # bytes avail in out q
; cmp #0
; bne done
; bra willwait
doexcept anop ; there are no exceptions
none lda #0 ; no data, return 0
sta res
done jsl DecBusyFlag
return 2:res
END
D_in_deq START
using SerialData
phb
phk
plb
phd
lda >SerialDP
tcd
jsr lowRead
pld
plb
rtl
END
D_out_deq START
rtl
END
nullfunc START
lda 2,s
sta 4,s
lda 1,s
sta 3,s
pla
rtl
END
D_size_inq START
using SerialData
phd
lda >SerialDP
tcd
lda <ibuf_mark
pld
rtl
END
D_size_outq START
using SerialData
phd
lda >SerialDP
tcd
lda <obuf_mark
pld
rtl
END
;D_left_outq START
; using SerialData
;
; phd
; lda >SerialDP
; tcd
; lda <obuf_size
; sec
; sbc <obuf_mark
; pld
; rtl
; END
* out_enq(int char)
D_out_enq START
using SerialData
phb
phk
plb
phd
lda >SerialDP
tcd
lda 7,s
jsr WriteBuffer
pld
plb
lda 2,s
sta 4,s
lda 1,s
sta 3,s
pla
rtl
END
lowRead START
; php need to turn off interrupts to
; sei prevent the driver from hanging
WaitMore anop
* Check for data in the buffer
lda <ibuf_mark if a single char comes through
bne GotIt while we're trying to sleep
* block process (will be unblocked by Read intr. completion routine)
jsl dtty+t_GetProcInd ; get pointer to process entry
sta procPtr
stx procPtr+2
; php
; sei
ldy #2 ; set it to blocked state
lda #pBlocked
sta [procPtr],y
; lda tmpProcID ; tell the intr handler which process
lda #1 ; tell intr handler a process is asleep
sta blockProc ; to awaken
ldy #84 ; index of waitDone field
lda #0
sta [procPtr],y ; set to zero, moron
cop $7F
; plp
ldy #84
lda [procPtr],y
beq WaitMore ; thar's a character
cmp #1
beq WaitMore
lda #-1
sta blockProc
lda #$7E43 ; abort the transfer
bra intr
GotIt anop
; plp restore interrupts
lda #-1
sta blockProc
jsr ReadBuffer
intr anop
rts
END
DInit START
using SerialData
hand equ 0
ptr equ 4
result equ 12
bufHand equ 14
subroutine (2:devNum),18
stz result
* ph4 #nhInit
* _ErrWriteString
ph4 #0
ph4 #256
ph2 dtty+t_userid
ph2 #$C005
ph4 #0
_NewHandle
cmp #0
beq noerr
memErr lda #$54 ; GS/OS out of memory
sta result
jmp goaway
noerr pla
sta hand
sta DPHandle
pla
sta hand+2
sta DPHandle+2
lda [hand]
sta ptr
sta SerialDP
ldy #2
lda [hand],y
sta ptr+2
pha
pha
ph4 #BUF_SIZE*2
ph2 dtty+t_userid
pea $C008 ; anywhere in memory
pea 0 ; no special location
pea 0
_NewHandle
pla
sta bufHand
sta |bufHandle
pla
sta bufHand+2
sta |bufHandle+2
ora bufHand
bne didAlloc
ph4 >DPHandle
_DisposeHandle
bra memErr
didAlloc lda [bufHand]
tax
ldy #2
lda [bufHand],y
sta bufHand+2
stx bufHand
; lda #$20 ; use CTS sighupping by default
lda #$00 ; use no sighupping by default
sta >DHUP
lda SerialDP
phd
tcd
; mv4 >dtermioPtr,dTermioPtr
ld4 dtty,dTermioPtr
* Initialize default values for terminal settings
ldy #4
lda #CRMOD+ECHO
sta [dTermioPtr],y
lda #0
short m
* default baud rate either comes from the Control panel, or
* from a previous stty command. doing stty 0 on the port
* will force a reset to the control panel next time the port is opened
* sta [dTermioPtr] ; ispeed
* ldy #1
* sta [dTermioPtr],y ; ospeed
ldy #t_intrc
lda #3
sta [dTermioPtr],y ; t_intrc
ldy #t_suspc
lda #'Z'-64
sta [dTermioPtr],y
ldy #t_quitc
lda #'\'-64
sta [dTermioPtr],y
ldy #t_startc
lda #'Q'-64
sta [dTermioPtr],y
ldy #t_stopc
lda #'S'-64
sta [dTermioPtr],y
ldy #t_eofc
lda #'D'-64
sta [dTermioPtr],y
ldy #t_brkc
lda #-1
sta [dTermioPtr],y
* lda #11
* ldy #t_ispeed
* sta [dTermioPtr],y
long m
* Initialize the port and parameters
ldy #privFlags
lda #0
sta [dTermioPtr],y
ldy #ws_row
sta [dTermioPtr],y
iny2
sta [dTermioPtr],y
iny2
sta [dTermioPtr],y
iny2
sta [dTermioPtr],y
jsr ComInit set the initial baud rate
pld
pea 0
pei (ptr)
pei (bufHand+2)
pei (bufHand)
lda bufHand
clc
adc #BUF_SIZE
tax
lda bufHand+2
adc #0
pha
phx
jsl StartSerial
sta result
cmp #0 error in startup?
beq goaway Nope
cmp #7
bcs unknownErr
asl a map SIM error to a reasonable
tax GS/OS driver error code
lda ErrorMap,x
sta result
ph4 >DPHandle
_DisposeHandle
ph4 >bufHandle
_DisposeHandle
goaway return 2:result
unknownErr sta result assume some other error
bra goaway
nhErr str 'Modem:NewHandle failed'
nhInit str 'Modem:Init'
ErrorMap anop
dc i2'0'
dc i2'$29' SIMAlreadyInst
dc i2'$27' SIMInvalidAddr
dc i2'$29' SIMATalkActive
dc i2'$27' SIMNotInstalled
dc i2'$22' SIMInvalidPort
dc i2'$26' SIMNotFound
END
DDeInit START
using SerialData
subroutine (2:devNum),0
* ph4 #detxt
* _ErrWriteString
jsl EndSerial
ph4 >DPHandle
_DisposeHandle
ph4 >bufHandle
_DisposeHandle
return
detxt str 'DeInit Modem'
END
DIOCTL START
using SerialData
retval equ 0
dpPtr equ 2
subroutine (4:tioc,4:dataPtr,2:devNum),6
lda SerialDP
sta dpPtr
stz dpPtr+2
lda tioc
and #$FF00
xba
cmp #'f'
beq chkfile
cmp #'t'
beq tioctl
err lda #-1
sta retval
bra goaway
* FIONREAD
chkfile lda tioc
and #$7F
cmp #127
bne err
ldy #ibuf_mark
lda [dpPtr],y how many bytes in input buffer?
sta [dataPtr] lda is an atomic operation :-)
stz retval
bra goaway
tioctl anop
lda tioc
and #$7F
cmp #23
bcc okay2
and #$7F
eor #$7F
cmp #26
bcc okay1
jmp invalid
okay1 anop
asl a
asl a
inc a
inc a
tax
jmp (tNTable,x)
okay2 anop
asl a
asl a
inc a
inc a
tax
jmp (tPTable,x)
goaway return 2:retval
tPTable anop
dc i2'0',a2'TIOCGETD'
dc i2'1',a2'TIOCSETD'
dc i2'2',a2'invalid'
dc i2'3',a2'invalid'
dc i2'4',a2'invalid'
dc i2'-1',a2'invalid'
dc i2'-1',a2'invalid'
dc i2'-1',a2'invalid'
dc i2'8',a2'TIOCGETP'
dc i2'9',a2'TIOCSETP'
dc i2'10',a2'TIOCSETN'
dc i2'-1',a2'invalid'
dc i2'-1',a2'invalid'
dc i2'-1',a2'invalid'
dc i2'-1',a2'invalid'
dc i2'-1',a2'invalid'
dc i2'16',a2'TIOCFLUSH'
dc i2'-1',a2'invalid'
dc i2'-1',a2'invalid'
dc i2'-1',a2'invalid'
dc i2'-1',a2'invalid'
dc i2'21',a2'TIOCSHUP'
dc i2'22',a2'TIOCGHUP'
tNTable anop
dc i2'127',a2'invalid'
dc i2'126',a2'invalid'
dc i2'125',a2'invalid'
dc i2'124',a2'invalid'
dc i2'123',a2'TIOCSBRK'
dc i2'122',a2'TIOCCBRK'
dc i2'121',a2'TIOCSDTR'
dc i2'120',a2'TIOCCDTR'
dc i2'119',a2'invalid'
dc i2'118',a2'invalid'
dc i2'117',a2'invalid'
dc i2'116',a2'invalid'
dc i2'115',a2'TIOCOUTQ'
dc i2'114',a2'TIOCSTI'
dc i2'113',a2'invalid'
dc i2'-1',a2'invalid'
dc i2'111',a2'TIOCSTOP'
dc i2'110',a2'TIOCSTART'
dc i2'109',a2'invalid'
dc i2'108',a2'invalid'
dc i2'107',a2'invalid'
dc i2'106',a2'invalid'
dc i2'-1',a2'invalid'
dc i2'104',a2'invalid'
dc i2'103',a2'invalid'
invalid lda #-1
sta retval
jmp goaway
*****************************************************
TIOCSHUP anop
lda [dataPtr]
sta >DHUP
; jsr InstComplete
stz retval
jmp goaway
TIOCGHUP anop
lda >DHUP
sta [dataPtr]
stz retval
jmp goaway
TIOCGETD anop
TIOCSETD anop
TIOCSETN anop
TIOCGETP stz retval
jmp goaway
TIOCSETP anop
phd
lda >SerialDP
tcd
jsr SetWord $$$ SETWORD SET BAUD RATE
pld
stz retval
jmp goaway
TIOCFLUSH anop
php
sei
lda dataPtr
ora dataPtr+2
bne notNull
ldx #0
notNull lda [dataPtr] get the type of operation
tax
cpx #2
beq clrOutQ
lda #0 zero out the buffer information
ldy #ibuf_head
sta [dpPtr],y
ldy #ibuf_tail
sta [dpPtr],y
ldy #ibuf_mark
sta [dpPtr],y
clrOutQ cpx #1
beq doneFLUSH
lda #0 zero out the buffer information
ldy #obuf_head
sta [dpPtr],y
ldy #obuf_tail
sta [dpPtr],y
ldy #obuf_mark
sta [dpPtr],y
doneFLUSH plp
stz retval
jmp goaway
TIOCOUTQ ldy #obuf_mark
lda [dpPtr],y
sta [dataPtr]
stz retval
jmp goaway
TIOCSTOP anop
TIOCSTART anop
lda #-1
sta retval
jmp goaway ; we don't support these
TIOCSDTR jsr DTRON ; these don't need DP
jmp goaway
TIOCCDTR jsr DTROFF
jmp goaway
TIOCSBRK jsr BRKON
stz retval
jmp goaway
TIOCCBRK jsr BRKOFF
stz retval
jmp goaway
* simulate terminal input (this code is borrowed from INOUT.ASM/OurADB
TIOCSTI anop
; this chunk stores the byte in the buffer
lda [dataPtr]
tax
php
sei
phd
lda >SerialDP
tcd
ldy <ibuf_head
txa
short m
sta [in_buf],y
long m
iny
sty <ibuf_head
cpy <ibuf_size
bcc stok
ldy #0
stok sty <ibuf_head
inc <ibuf_mark
; this chunk unblocks any process that was waiting on keyboard input
lda blockProc
cmp #-1
beq check4select
ldy #2
lda [procPtr],y
cmp #pBlocked ; is it still blocked?
bne done ; nope, leave it alone
lda #pReady
sta [procPtr],y ; restart the process
; this was in the console code but not here
lda #-1
sta blockProc
;
; check for select here.
check4select anop
lda >dtty+t_select_proc
cmp #$FFFF
beq done
* someone is selecting on us, so call selwakeup with the process ID
* and our collision flag
pha
lda >dtty+privFlags
and #TS_RCOLL
pha
jsl dtty+t_selwakeup
lda >dtty+privFlags
and #TS_RCOLL.EOR.$FFFF
sta >dtty+privFlags
lda #$FFFF
sta >dtty+t_select_proc
done anop
pld
plp
stz retval
jmp goaway
END
checkIntr START
using SerialData
php
long ai
and #$7f
pha
short m
ldy #sg_flags
lda [dTermioPtr],y
bit #$20 ; RAW mode?
beq x9 ; yep, no character checking
brl notty
x9 ldy #t_quitc
lda [dTermioPtr],y
cmp #-1
beq x0
cmp 1,s
beq gotQQ
x0 ldy #t_suspc
lda [dTermioPtr],y
cmp #-1
beq x1
cmp 1,s
beq gotZ
x1 ldy #t_intrc
lda [dTermioPtr],y
cmp #-1
beq notty
cmp 1,s
beq gotC
*x2 lda >OutStopped
* bne x3
* ldy #t_stopc
* lda [dTermioPtr],y
* cmp #-1
* beq x3
* cmp 1,s
* beq gotS
*x3 ldy #t_startc
* lda [dTermioPtr],y
* cmp #-1
* beq notty
* cmp 1,s
* beq gotQ
bra notty
*gotS long m
* pla
* lda #1
* sta >OutStopped
* plp
* sec
* rts
*gotQ long m
* pla
* lda >OutStopped
* beq notQ
* lda #0
* sta >OutStopped
* plp
* sec
* rts
*notQ anop ;oops!
* plp
* clc
* rts
gotQQ long m
lda #3
bra gotSIG
gotZ long m
lda #18
bra gotSIG
gotC long m
lda #2
gotSIG anop
phx
phy
pha
lda <ibuf_head
dec a
bpl notNeg
lda <ibuf_size
dec a
notNeg sta <ibuf_head ; remove the character
dec <ibuf_mark
lda 1,s
pha ; push signal number
ph2 >dtty+t_devNum ; push our device number
jsl dtty+t_sendSignal
pla ; prolly don't need to, but what
ply ; the hell...
plx
pla ; the character
plp ; ready? Let's go!
sec
rts
notty anop
long m
pla
plp
clc
rts
END
SerialData DATA
SerialDP dc i2'0'
DPHandle dc i4'0'
bufHandle dc i4'0'
DHUP dc i2'$00'
ourSerFlag dc i2'0'
CurBaud dc i2'0'
baudTbl dc i2'0' 0 - no baud! (hangup)
dc i2'$08FE' 1 - 50 baud
dc i2'$05FE' 2 - 75 baud
dc i2'$0415' 3 - 110 baud
dc i2'$035B' 4 - 134.5 baud
dc i2'$02FE' 5 - 150 baud
dc i2'$0000' 6 - 200 baud ($23E) or 57600
dc i2'$017E' 7 - 300 baud
dc i2'$00BE' 8 - 600 baud
dc i2'$005E' 9 - 1200 baud
dc i2'$003E' 10 - 1800 baud
dc i2'$002E' 11 - 2400 baud
dc i2'$0016' 12 - 4800 baud
dc i2'$000A' 13 - 9600 baud
dc i2'$0004' 14 - 19200 baud
dc i2'$0001' 15 - 38400 baud
* Firmware to UNIX baud-rate number conversion
RevBDTab dc i2'1' 50
dc i2'2' 75
dc i2'3' 110
dc i2'4' 134.5
dc i2'5' 150
dc i2'7' 300
dc i2'8' 600
dc i2'9' 1200
dc i2'10' 1800
dc i2'11' 2400
dc i2'0' 3600
dc i2'12' 4800
dc i2'0' 7200
dc i2'13' 9600
dc i2'14' 19200
END