mirror of
https://github.com/oliverschmidt/contiki.git
synced 2024-11-03 22:06:22 +00:00
4f28289df2
- "Normalized" some Assembly code. - Implemented CFS_APPEND in pfs_open(). - Made CFS_WRITE work in VICE's virtual disk/file system.
459 lines
9.9 KiB
ArmAsm
459 lines
9.9 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>
|
|
; Author: Greg King <gregdk@users.sf.net>
|
|
;
|
|
;---------------------------------------------------------------------
|
|
.define F_IDE64 1 ; support IDE64, >= $0100 bytes only
|
|
|
|
.constructor init_pfs
|
|
.destructor done_pfs
|
|
.importzp sp, ptr1, ptr2, ptr3
|
|
.import curunit, __filetype, popax, addysp, subysp
|
|
.export pfs_rwcommon, pfs_rwsetflags, pfs_rwcommonend
|
|
.if F_IDE64
|
|
.export ide64_rwprepare, ide64_rwfinish
|
|
.endif
|
|
.export cmdc, flags
|
|
.export pfs_makename, pfs_scratch
|
|
|
|
.export _pfs_open, _pfs_read, _pfs_close
|
|
;---------------------------------------------------------------------
|
|
MAXLEN = 80 ;maximum filename length
|
|
|
|
; Flag bits
|
|
F_EOF = %10000000 ;end of file
|
|
F_NBLK = %01000000 ;block read/write not available
|
|
F_OPEN = %00100000
|
|
|
|
; Kernal variables
|
|
ST := $90 ;status
|
|
FN := $BB ;filename
|
|
FNL := $B7 ;filename length
|
|
LF := $B8 ;logical file number
|
|
|
|
OPNVec := $031A ;address vector to OPEN function's code
|
|
|
|
; IDEDOS function
|
|
READ := $DEF4
|
|
|
|
; Kernal functions
|
|
SETLFS := $FFBA
|
|
SETNAM := $FFBD
|
|
OPEN := $FFC0
|
|
CLOSE := $FFC3
|
|
CHKIN := $FFC6
|
|
CHKOUT := $FFC9
|
|
CLRCHN := $FFCC
|
|
CHRIN := $FFCF
|
|
CHROUT := $FFD2
|
|
;---------------------------------------------------------------------
|
|
.data
|
|
|
|
; illchr and sw must stay together because the comma, also, is illegal in names.
|
|
illchr: .byte "*?:=" ;illegal chars
|
|
sw: .byte ",s,w"
|
|
cmdc: .byte 0
|
|
flags: .res 10 ;(Kernal allows only ten open files)
|
|
;---------------------------------------------------------------------
|
|
.segment "ONCE"
|
|
|
|
init_pfs:
|
|
ldy #MAXLEN + 8
|
|
jsr subysp ;allocate because open2 will free it
|
|
lda #0 ;no name, file number 1
|
|
sta FNL
|
|
ldy #15 - 1 ;secondary address 15
|
|
jsr open2 ;open command channel
|
|
sta cmdc
|
|
rts
|
|
;---------------------------------------------------------------------
|
|
.code
|
|
|
|
_pfs_open:
|
|
sta ptr2 ;save open-mode flags
|
|
|
|
; Get and store name
|
|
jsr popax
|
|
jsr pfs_makename
|
|
lda FNL
|
|
beq error ;must have a filename
|
|
|
|
lda #2 - 1 ;file number
|
|
tay ;secondary address
|
|
open2: sta ptr2
|
|
sty ptr2 + 1
|
|
|
|
next: inc ptr2 ;next file number
|
|
ldx ptr2 ;file number
|
|
cpx #.sizeof(flags) + 1
|
|
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 (channel number)
|
|
jsr SETLFS
|
|
jsr OPEN ;open a pair of files (in computer and drive)
|
|
bcs oerr ;branch if could not open computer file
|
|
ldx cmdc
|
|
beq opok ;branch if error channel just was openned
|
|
jsr CHKIN
|
|
bcs error
|
|
jsr CHRIN
|
|
pha ;first digit of error code
|
|
jsr CHRIN
|
|
sta ptr1 ;second digit
|
|
@L4: jsr CHRIN ;flush status message
|
|
lda ST
|
|
beq @L4
|
|
jsr CLRCHN
|
|
pla
|
|
cmp #'2'
|
|
bcc opok ;no serious error
|
|
pha
|
|
lda ptr2
|
|
jsr CLOSE ;close computer file
|
|
pla
|
|
ldx ptr1
|
|
cmp #'7' ;no channel?
|
|
bne nnoc
|
|
cpx #'0'
|
|
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
|
|
ret0: ldx #>$0000
|
|
ret: ldy #MAXLEN + 8 ;free filename space
|
|
jmp addysp
|
|
|
|
oerr: dec ptr2 + 1
|
|
cmp #2 ;already open,
|
|
beq next ;retry with next
|
|
|
|
error: lda #<-1
|
|
tax ;failed
|
|
bne ret
|
|
|
|
nnoc: inc ptr3
|
|
bne error ;no retry
|
|
cmp #'6'
|
|
bne error ;not "file exists"
|
|
cpx #'3'
|
|
bne error
|
|
jsr pfs_scratch
|
|
bcc retr
|
|
bcs error ;branch always
|
|
|
|
pfs_scratch:
|
|
ldx cmdc
|
|
jsr CHKOUT
|
|
bcs @L5
|
|
ldy #1
|
|
lda #'s' ;scratch
|
|
@L4: jsr CHROUT
|
|
lda (FN),y
|
|
iny
|
|
cmp #','
|
|
bne @L4
|
|
lda #$0D ;carriage return
|
|
jsr CHROUT
|
|
jsr CLRCHN
|
|
clc ;carry = 0: OK
|
|
@L5: rts ;carry = 1: error
|
|
|
|
pfs_makename:
|
|
sta FN
|
|
stx FN+1 ;Kernal filename pointer
|
|
ldy #MAXLEN + 8
|
|
jsr subysp ;allocate name space
|
|
|
|
; Validate the name; and, find its length
|
|
ldy #<-1
|
|
sty ptr3
|
|
sty ptr1
|
|
@L10: iny
|
|
cpy #MAXLEN
|
|
bcs badchr ;too long
|
|
lda (FN),y
|
|
ldx #.sizeof(illchr); 4 + 1 (includes comma)
|
|
@L12: cmp illchr,x
|
|
beq badchr ;illegal char
|
|
dex
|
|
bpl @L12
|
|
cmp #'/'
|
|
bne @L11
|
|
sty ptr1 ;last slash
|
|
@L11: tax ;test for '\0'
|
|
bne @L10
|
|
cpy #0
|
|
beq badchr ;no name
|
|
|
|
tay ;zero index reg.
|
|
lda #'0' ;drive 0 or current partition
|
|
sta (sp),y
|
|
iny
|
|
inc ptr1
|
|
beq nopath
|
|
lda #'/'
|
|
@L13: sta (sp),y
|
|
iny
|
|
lda (FN,x)
|
|
inc FN
|
|
bne @L14
|
|
inc FN+1
|
|
@L14: cpy ptr1
|
|
bcc @L13
|
|
;lda #'/' ; (.A already has a slash)
|
|
sta (sp),y
|
|
iny
|
|
nopath: lda #':'
|
|
@L16: sta (sp),y
|
|
iny
|
|
lda (FN,x)
|
|
inc FN
|
|
bne @L15
|
|
inc FN+1
|
|
@L15: ora #$00 ;test for '\0'
|
|
bne @L16
|
|
lsr ptr2
|
|
bcs ro ;read-only (read-write not supported)
|
|
lda __filetype
|
|
sta sw + 1 ;set filetype
|
|
lsr ptr2
|
|
lda #'w' ;write-only
|
|
lsr ptr2
|
|
bcc write
|
|
lda #'a' ;append
|
|
write: sta sw + 3 ;set mode
|
|
ldx #$0100 - .sizeof(sw)
|
|
@L20: lda sw - ($0100 - .sizeof(sw)),x
|
|
sta (sp),y
|
|
iny
|
|
inx
|
|
bne @L20
|
|
ro: tya ;pathname length
|
|
ldx sp
|
|
ldy sp+1
|
|
namset: jmp SETNAM
|
|
|
|
badchr: lda #0
|
|
beq namset
|
|
|
|
.proc _pfs_read
|
|
jsr pfs_rwcommon ; pop params, check handle
|
|
beq error2 ; not open
|
|
|
|
bmi eof
|
|
|
|
.if F_IDE64
|
|
asl a
|
|
bmi nblk ; no block operation
|
|
|
|
jsr CHKIN
|
|
bcs error2
|
|
|
|
; check support
|
|
jsr ide64_rwprepare
|
|
bcs norm
|
|
|
|
; do a block 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
|
|
|
|
; Read the next byte
|
|
@L0: jsr CHRIN
|
|
tax ; save the input byte
|
|
|
|
lda ST ; read the file status
|
|
cmp #$01 ; save it
|
|
and #%10111111 ; check anything but the EOF 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 EOF bit
|
|
@L1: bcc @L3 ; loop if not end of file
|
|
|
|
; Set the EOF flag; and, bail out
|
|
lda #F_EOF
|
|
jsr pfs_rwsetflags
|
|
|
|
; Read done; cancel the input channel
|
|
done: jsr CLRCHN
|
|
|
|
; Return the number of chars read
|
|
eof:
|
|
; jmp pfs_rwcommonend ; (fall through)
|
|
.endproc
|
|
|
|
.proc pfs_rwcommonend
|
|
lda ptr2
|
|
sec
|
|
sbc ptr3
|
|
pha
|
|
lda ptr2+1
|
|
sbc ptr3+1
|
|
tax
|
|
pla
|
|
rts
|
|
.endproc
|
|
|
|
done_pfs:
|
|
ldx #.sizeof(flags)
|
|
@L2: ldy flags - 1,x ; file open?
|
|
beq @L1
|
|
txa
|
|
jsr close1
|
|
@L1: dex
|
|
bne @L2
|
|
rts
|
|
|
|
error5: jsr CLRCHN
|
|
|
|
; Error entry, file is not open
|
|
error2: ldx #>-1
|
|
txa
|
|
rts
|
|
|
|
_pfs_close:
|
|
cmp #.sizeof(flags) + 1
|
|
bcs close0 ; don't close if not valid file number
|
|
close1: pha
|
|
jsr CLOSE
|
|
pla
|
|
tax
|
|
lda #$00
|
|
sta flags - 1,x
|
|
close0: rts ; .X = file number
|
|
|
|
.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 #$00
|
|
; beq pfs_rwsetflags ; (fall through)
|
|
.endproc
|
|
|
|
.proc pfs_rwsetflags
|
|
ldx LF
|
|
ora flags - 1,x
|
|
sta flags - 1,x
|
|
rts
|
|
.endproc
|
|
|
|
.if F_IDE64
|
|
.proc ide64_rwprepare
|
|
sec ; assume it won't use IDEDOS
|
|
lda ptr1+1
|
|
eor #$FF ; convert -count-1 back to count
|
|
beq small ; too small, not worth it
|
|
tay
|
|
lda ptr1 ; set up registers
|
|
eor #$FF
|
|
tax
|
|
lda OPNVec+1
|
|
eor #>$DE00
|
|
bne noide ; is OPEN vector set to IDEDOS?
|
|
lda $DE60
|
|
eor #'i'
|
|
bne noide ; check identification
|
|
lda $DE61
|
|
eor #'d'
|
|
bne noide
|
|
lda $DE62
|
|
eor #'e'
|
|
bne noide
|
|
clc ; it will use IDEDOS
|
|
lda #ptr2
|
|
small: rts
|
|
|
|
noide: lda #F_NBLK
|
|
bne pfs_rwsetflags
|
|
.endproc
|
|
|
|
.proc ide64_rwfinish
|
|
txa ; push .YX
|
|
pha
|
|
tya
|
|
pha
|
|
jsr CLRCHN
|
|
pla ; pull .XA
|
|
tax
|
|
pla
|
|
rts
|
|
.endproc
|
|
.endif
|