mirror of
https://github.com/oliverschmidt/contiki.git
synced 2024-11-19 03:05:14 +00:00
436 lines
8.5 KiB
ArmAsm
436 lines
8.5 KiB
ArmAsm
;
|
|
; Copyright (c) 2010, Kajtar Zsolt <soci@c64.rulez.org>
|
|
; 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. Neither the name of the Institute nor the names of its contributors
|
|
; may be used to endorse or promote products derived from this software
|
|
; without specific prior written permission.
|
|
;
|
|
; THIS SOFTWARE IS PROVIDED BY THE INSTITUTE AND CONTRIBUTORS ``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 INSTITUTE OR CONTRIBUTORS 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.
|
|
;
|
|
; This file is part of the Contiki operating system.
|
|
;
|
|
; Author: Kajtar Zsolt <soci@c64.rulez.org>
|
|
;
|
|
;---------------------------------------------------------------------
|
|
.define F_IDE64 0 ; support IDE64, not on C128
|
|
|
|
.constructor init_pfs
|
|
.destructor done_pfs
|
|
.importzp ptr1, ptr2, ptr3, sp
|
|
.import curunit, __filetype, popax, addysp, subysp
|
|
.export pfs_rwcommon, pfs_rwsetflags, pfs_rwcommonend
|
|
.if F_IDE64
|
|
.export ide64_rwprepare, ide64_rwfinish
|
|
.endif
|
|
.export _pfs_open, _pfs_read, _pfs_close
|
|
;---------------------------------------------------------------------
|
|
F_EOF = $80
|
|
F_NBLK = $40
|
|
F_OPEN = $20
|
|
F_MAXLEN = 80 ;max filename length
|
|
ST = $90 ;status
|
|
FN = $BB ;filename
|
|
FNL = $B7 ;filenamelength
|
|
LF = $B8 ;logical file number
|
|
SA = $B9 ;secondary address
|
|
OPEN = $FFC0
|
|
CLOSE = $FFC3
|
|
CHKIN = $FFC6
|
|
CHKOUT = $FFC9
|
|
CLRCHN = $FFCC
|
|
CHRIN = $FFCF
|
|
CHROUT = $FFD2
|
|
SETLFS = $FFBA
|
|
SETNAM = $FFBD
|
|
CLALL = $FFE7
|
|
WRITE = $DEF1
|
|
READ = $DEF4
|
|
;---------------------------------------------------------------------
|
|
.data
|
|
|
|
illchr: .byte $3A, $2A, $3F, $3D ;illegal chars
|
|
pw: .byte $2C, $50, $2C, $57 ;,p,w
|
|
cmdc: .byte 0
|
|
flags: .res 10
|
|
;---------------------------------------------------------------------
|
|
.segment "ONCE"
|
|
|
|
init_pfs:
|
|
ldy #F_MAXLEN+8
|
|
jsr subysp ;allocate
|
|
lda #0
|
|
sta FNL ;no name
|
|
ldy #15-1
|
|
jsr open2 ;open command channel
|
|
sta cmdc
|
|
rts
|
|
;---------------------------------------------------------------------
|
|
.code
|
|
|
|
error3: jmp error
|
|
|
|
_pfs_open:
|
|
sta ptr2
|
|
; Pop and store name
|
|
jsr popax
|
|
sta FN
|
|
stx FN+1 ;filename (kernal)
|
|
ldy #F_MAXLEN+8
|
|
jsr subysp ;allocate name
|
|
ldy #255
|
|
sty ptr3
|
|
sty ptr1
|
|
@L10: iny
|
|
cpy #F_MAXLEN
|
|
bcs error3 ;too long...
|
|
ldx #4 ;4+1 (comma)
|
|
@L12: cmp illchr,x
|
|
beq error3 ;illegal char?
|
|
dex
|
|
bpl @L12
|
|
cmp #$2F
|
|
bne @L11
|
|
sty ptr1 ;last slash
|
|
@L11: lda (FN),y
|
|
bne @L10
|
|
sty FNL
|
|
|
|
tay
|
|
tax
|
|
lda #$30 ;this partition
|
|
sta (sp),y
|
|
iny
|
|
inc ptr1
|
|
beq nopath
|
|
lda #$2F
|
|
@L13: sta (sp),y
|
|
iny
|
|
lda (FN,x)
|
|
inc FN
|
|
bne @L14
|
|
inc FN+1
|
|
@L14: cpy ptr1
|
|
bcc @L13
|
|
lda #$2F
|
|
sta (sp),y
|
|
iny
|
|
nopath: lda #$3A
|
|
@L16: sta (sp),y
|
|
iny
|
|
lda (FN,x)
|
|
inc FN
|
|
bne @L15
|
|
inc FN+1
|
|
@L15: ora #0
|
|
bne @L16
|
|
lsr ptr2
|
|
bcs ro ;read only
|
|
lda __filetype
|
|
sta pw+1 ;set filetype
|
|
ldx #252
|
|
@L20: lda pw-252,x
|
|
sta (sp),y ;write
|
|
iny
|
|
inx
|
|
bne @L20
|
|
ro: tya ;name length (kernal)
|
|
ldx sp
|
|
ldy sp+1
|
|
jsr SETNAM
|
|
|
|
lda #0 ;file number
|
|
tay ;secondary address
|
|
open2: sta ptr2
|
|
sty ptr2+1
|
|
|
|
next: inc ptr2 ;next file number
|
|
ldx ptr2 ;file number
|
|
cpx #11
|
|
bcs error ;no more files
|
|
lda flags-1,x
|
|
bne next ;already used
|
|
lda ptr2+1
|
|
bne nextsa
|
|
inx
|
|
stx ptr2+1
|
|
nextsa: inc ptr2+1 ;next channel
|
|
retr: lda ptr2 ;file number
|
|
ldx curunit
|
|
ldy ptr2+1 ;secondary address
|
|
jsr SETLFS
|
|
jsr OPEN ;open
|
|
bcs oerr
|
|
ldx cmdc
|
|
beq opok ;error channel open
|
|
jsr CHKIN
|
|
bcs error
|
|
jsr CHRIN
|
|
pha
|
|
jsr CHRIN
|
|
sta ptr1
|
|
@L4: jsr CHRIN
|
|
lda ST
|
|
beq @L4
|
|
jsr CLRCHN
|
|
pla
|
|
tax
|
|
lsr
|
|
cmp #$18 ;no serious error
|
|
beq opok
|
|
txa
|
|
pha
|
|
lda ptr2
|
|
jsr CLOSE ;close
|
|
pla
|
|
ldx ptr1
|
|
cmp #$37 ;no channel?
|
|
bne nnoc
|
|
cpx #$30
|
|
bne error ;not no channel
|
|
lda ptr2+1
|
|
cmp #14
|
|
bcc nextsa ;try next channel
|
|
bcs error ;give up
|
|
|
|
opok: ldx ptr2
|
|
lda #F_OPEN
|
|
sta flags-1,x
|
|
txa ;ok, return file number
|
|
ldx #0
|
|
ret: ldy #F_MAXLEN+8 ; free filename
|
|
jmp addysp
|
|
|
|
oerr: dec ptr2+1
|
|
cmp #2 ;already open,
|
|
beq next ;retry with next
|
|
|
|
error: lda #$FF
|
|
tax ;failed
|
|
bne ret
|
|
|
|
nnoc: inc ptr3
|
|
bne error ;no retry
|
|
cmp #$36
|
|
bne error ;no exists
|
|
cpx #$33
|
|
bne error
|
|
ldx cmdc
|
|
jsr CHKOUT
|
|
bcs error
|
|
lda FNL
|
|
sec
|
|
sbc #5
|
|
tax
|
|
lda #$53 ;scratch
|
|
jsr CHROUT
|
|
ldy #1
|
|
@L4: lda (FN),y
|
|
iny
|
|
jsr CHROUT
|
|
dex
|
|
bne @L4
|
|
lda #$3D
|
|
jsr CHROUT
|
|
iny
|
|
lda (FN),y
|
|
jsr CHROUT
|
|
lda #$0d
|
|
jsr CHROUT
|
|
jsr CLRCHN
|
|
jmp retr
|
|
|
|
.proc _pfs_read
|
|
jsr pfs_rwcommon ; pop params, check handle
|
|
beq error2 ; not open
|
|
|
|
bmi eof
|
|
.if F_IDE64
|
|
asl
|
|
bmi nblk ; no block operation
|
|
|
|
jsr CHKIN
|
|
bcs error2
|
|
|
|
; check support
|
|
jsr ide64_rwprepare
|
|
bcs norm
|
|
|
|
; read
|
|
jsr READ
|
|
bcs nosup
|
|
jmp ide64_rwfinish
|
|
|
|
nosup: lda #F_NBLK
|
|
jsr pfs_rwsetflags
|
|
.endif
|
|
|
|
; Valid lfn. Make it the input file
|
|
nblk: jsr CHKIN
|
|
bcs error2
|
|
|
|
; Decrement the count
|
|
norm: ldy #0
|
|
@L3: inc ptr1
|
|
bne @L0
|
|
inc ptr1+1
|
|
beq done ; branch always
|
|
|
|
; Read the next byte
|
|
@L0: jsr CHRIN
|
|
tax ; save the input byte
|
|
|
|
lda ST ; read the IEEE status
|
|
cmp #1 ; save it
|
|
and #%10111111 ; check anything but the EOI bit
|
|
bne error5 ; assume device not present
|
|
|
|
; Store the byte just read
|
|
txa
|
|
sta (ptr2),y
|
|
inc ptr2
|
|
bne @L1
|
|
inc ptr2+1 ; *buf++ = A;
|
|
|
|
; Get the status again and check the EOI bit
|
|
@L1: bcc @L3 ; loop if no end of file
|
|
|
|
; Set the EOI flag and bail out
|
|
lda #F_EOF
|
|
jsr pfs_rwsetflags
|
|
|
|
; Read done, close the input channel
|
|
done: jsr CLRCHN ; clrchn
|
|
|
|
; Return the number of chars read
|
|
eof: jmp pfs_rwcommonend
|
|
.endproc
|
|
|
|
; Error entry, file is not open
|
|
done_pfs:
|
|
ldx #10
|
|
@L2: ldy flags-1,x ; file open?
|
|
beq @L1
|
|
txa
|
|
jsr _pfs_close
|
|
@L1: dex
|
|
bne @L2
|
|
rts
|
|
|
|
error5: jsr CLRCHN ; clrchn
|
|
|
|
error2: ldx #255
|
|
txa
|
|
rts
|
|
|
|
_pfs_close:
|
|
pha
|
|
jsr CLOSE ;close
|
|
pla
|
|
tax
|
|
lda #0
|
|
sta flags-1,x
|
|
rts
|
|
|
|
.proc pfs_rwcommon
|
|
eor #$FF
|
|
sta ptr1
|
|
txa
|
|
eor #$FF
|
|
sta ptr1+1 ; remember -count-1
|
|
|
|
jsr popax ; get buf
|
|
sta ptr2
|
|
stx ptr2+1
|
|
|
|
sta ptr3
|
|
stx ptr3+1 ; for length
|
|
|
|
jsr popax ; get the handle
|
|
sta LF
|
|
lda #0
|
|
beq pfs_rwsetflags
|
|
.endproc
|
|
|
|
.if F_IDE64
|
|
.proc ide64_rwprepare
|
|
sec
|
|
lda ptr1+1
|
|
eor #255
|
|
beq small ; too small, not worth it
|
|
tay
|
|
lda ptr1 ; setup registers
|
|
eor #255
|
|
tax
|
|
lda $031B
|
|
eor #$DE
|
|
bne noide ; open vector set?
|
|
lda $DE60
|
|
eor #$49
|
|
bne noide ; check identification
|
|
lda $DE61
|
|
eor #$44
|
|
bne noide
|
|
lda $DE62
|
|
eor #$45
|
|
bne noide
|
|
clc
|
|
lda #ptr2
|
|
small: rts
|
|
|
|
noide: lda #F_NBLK
|
|
bne pfs_rwsetflags
|
|
.endproc
|
|
.endif
|
|
|
|
.proc pfs_rwsetflags
|
|
ldx LF
|
|
ora flags-1,x
|
|
sta flags-1,x
|
|
rts
|
|
.endproc
|
|
|
|
.if F_IDE64
|
|
.proc ide64_rwfinish
|
|
txa
|
|
pha
|
|
tya
|
|
pha
|
|
jsr CLRCHN
|
|
pla
|
|
tax
|
|
pla
|
|
rts
|
|
.endproc
|
|
.endif
|
|
|
|
.proc pfs_rwcommonend
|
|
lda ptr2
|
|
sec
|
|
sbc ptr3
|
|
pha
|
|
lda ptr2+1
|
|
sbc ptr3+1
|
|
tax
|
|
pla
|
|
rts
|
|
.endproc
|