Added code to the driver to use also banks 2 and 3 if present. Contributed by
Marco van den Heuvel. git-svn-id: svn://svn.cc65.org/cc65/trunk@4569 b7a2c559-68d2-44c3-8de9-860c34a00d81
This commit is contained in:
uz
@@ -1,8 +1,11 @@
|
|||||||
;
|
;
|
||||||
; Extended memory driver for the C128 RAM in bank #1. Driver works without
|
; Extended memory driver for the C128 RAM in banks #1, #2 and #3. Driver works without
|
||||||
; problems when statically linked.
|
; problems when statically linked.
|
||||||
;
|
;
|
||||||
; Ullrich von Bassewitz, 2002-12-04
|
; Ullrich von Bassewitz, 2002-12-04
|
||||||
|
;
|
||||||
|
; Updated to use banks 2 and 3 as well by
|
||||||
|
; Marco van den Heuvel, 2010-01-21
|
||||||
;
|
;
|
||||||
|
|
||||||
.include "zeropage.inc"
|
.include "zeropage.inc"
|
||||||
@@ -40,17 +43,19 @@
|
|||||||
; Constants
|
; Constants
|
||||||
|
|
||||||
BASE = $400
|
BASE = $400
|
||||||
TOPMEM = $FF00
|
|
||||||
PAGES = (TOPMEM - BASE) / 256
|
|
||||||
|
|
||||||
; ------------------------------------------------------------------------
|
; ------------------------------------------------------------------------
|
||||||
; Data.
|
; Data.
|
||||||
|
|
||||||
.bss
|
.bss
|
||||||
curpage: .res 1 ; Current page number
|
curpage: .res 2 ; Current page number
|
||||||
|
curbank: .res 1 ; Current bank number
|
||||||
|
copybank: .res 2 ; temp bank number
|
||||||
|
|
||||||
window: .res 256 ; Memory "window"
|
window: .res 256 ; Memory "window"
|
||||||
|
|
||||||
|
pagecount: .res 2 ; Number of available pages
|
||||||
|
|
||||||
.code
|
.code
|
||||||
|
|
||||||
; ------------------------------------------------------------------------
|
; ------------------------------------------------------------------------
|
||||||
@@ -61,12 +66,46 @@ window: .res 256 ; Memory "window"
|
|||||||
;
|
;
|
||||||
|
|
||||||
INSTALL:
|
INSTALL:
|
||||||
|
ldx #0
|
||||||
|
stx ptr1
|
||||||
|
ldx #4
|
||||||
|
stx ptr1+1
|
||||||
|
ldx #<ptr1
|
||||||
|
stx FETVEC
|
||||||
|
stx STAVEC
|
||||||
|
ldy #0
|
||||||
|
ldx #MMU_CFG_RAM1
|
||||||
|
jsr FETCH
|
||||||
|
sta tmp1
|
||||||
|
ldx #MMU_CFG_RAM3
|
||||||
|
jsr FETCH
|
||||||
|
cmp tmp1
|
||||||
|
bne @has_4_banks
|
||||||
|
tax
|
||||||
|
inx
|
||||||
|
txa
|
||||||
|
ldx #MMU_CFG_RAM1
|
||||||
|
jsr STASH
|
||||||
|
ldx #MMU_CFG_RAM3
|
||||||
|
jsr FETCH
|
||||||
|
cmp tmp1
|
||||||
|
beq @has_4_banks
|
||||||
|
ldx #0
|
||||||
|
lda #251
|
||||||
|
bne @setok
|
||||||
|
|
||||||
|
@has_4_banks:
|
||||||
|
ldx #2
|
||||||
|
lda #241
|
||||||
|
@setok:
|
||||||
|
sta pagecount
|
||||||
|
stx pagecount+1
|
||||||
ldx #$FF
|
ldx #$FF
|
||||||
stx curpage
|
stx curpage
|
||||||
stx curpage+1 ; Invalidate the current page
|
stx curpage+1 ; Invalidate the current page
|
||||||
inx
|
inx
|
||||||
txa ; A = X = EM_ERR_OK
|
txa ; A = X = EM_ERR_OK
|
||||||
rts
|
; rts ; Run into UNINSTALL instead
|
||||||
|
|
||||||
; ------------------------------------------------------------------------
|
; ------------------------------------------------------------------------
|
||||||
; UNINSTALL routine. Is called before the driver is removed from memory.
|
; UNINSTALL routine. Is called before the driver is removed from memory.
|
||||||
@@ -82,8 +121,8 @@ UNINSTALL:
|
|||||||
;
|
;
|
||||||
|
|
||||||
PAGECOUNT:
|
PAGECOUNT:
|
||||||
lda #<PAGES
|
lda pagecount
|
||||||
ldx #>PAGES
|
ldx pagecount+1
|
||||||
rts
|
rts
|
||||||
|
|
||||||
; ------------------------------------------------------------------------
|
; ------------------------------------------------------------------------
|
||||||
@@ -92,21 +131,25 @@ PAGECOUNT:
|
|||||||
; by the driver.
|
; by the driver.
|
||||||
;
|
;
|
||||||
|
|
||||||
MAP: sta curpage
|
MAP: sei
|
||||||
|
sta curpage
|
||||||
stx curpage+1 ; Remember the new page
|
stx curpage+1 ; Remember the new page
|
||||||
|
|
||||||
clc
|
jsr calculate_bank_and_correct_page
|
||||||
adc #>BASE
|
stx curbank
|
||||||
sta ptr1+1
|
|
||||||
ldy #$00
|
|
||||||
sty ptr1
|
|
||||||
|
|
||||||
|
clc
|
||||||
|
adc #>BASE
|
||||||
|
sta ptr1+1
|
||||||
|
ldy #$00
|
||||||
|
sty ptr1
|
||||||
lda #<ptr1
|
lda #<ptr1
|
||||||
sta FETVEC
|
sta FETVEC
|
||||||
|
|
||||||
; Transfer one page
|
; Transfer one page
|
||||||
|
|
||||||
@L1: ldx #MMU_CFG_RAM1
|
@L1: ldx curbank
|
||||||
|
jsr getcurbankmmu
|
||||||
jsr FETCH
|
jsr FETCH
|
||||||
sta window,y
|
sta window,y
|
||||||
iny
|
iny
|
||||||
@@ -116,6 +159,7 @@ MAP: sta curpage
|
|||||||
|
|
||||||
lda #<window
|
lda #<window
|
||||||
ldx #>window ; Return the window address
|
ldx #>window ; Return the window address
|
||||||
|
cli
|
||||||
rts
|
rts
|
||||||
|
|
||||||
; ------------------------------------------------------------------------
|
; ------------------------------------------------------------------------
|
||||||
@@ -130,15 +174,19 @@ USE: sta curpage
|
|||||||
; ------------------------------------------------------------------------
|
; ------------------------------------------------------------------------
|
||||||
; COMMIT: Commit changes in the memory window to extended storage.
|
; COMMIT: Commit changes in the memory window to extended storage.
|
||||||
|
|
||||||
COMMIT: lda curpage ; Get the current page
|
COMMIT: sei
|
||||||
|
lda curpage ; Get the current page
|
||||||
ldx curpage+1
|
ldx curpage+1
|
||||||
bmi done ; Jump if no page mapped
|
bmi done ; Jump if no page mapped
|
||||||
|
|
||||||
|
jsr calculate_bank_and_correct_page
|
||||||
|
stx curbank
|
||||||
|
|
||||||
clc
|
clc
|
||||||
adc #>BASE
|
adc #>BASE
|
||||||
sta ptr1+1
|
sta ptr1+1
|
||||||
ldy #$00
|
ldy #$00
|
||||||
sty ptr1
|
sty ptr1
|
||||||
|
|
||||||
lda #<ptr1
|
lda #<ptr1
|
||||||
sta STAVEC
|
sta STAVEC
|
||||||
@@ -146,10 +194,12 @@ COMMIT: lda curpage ; Get the current page
|
|||||||
; Transfer one page. Y must be zero on entry
|
; Transfer one page. Y must be zero on entry
|
||||||
|
|
||||||
@L1: lda window,y
|
@L1: lda window,y
|
||||||
ldx #MMU_CFG_RAM1
|
ldx curbank
|
||||||
|
jsr getcurbankmmu
|
||||||
jsr STASH
|
jsr STASH
|
||||||
iny
|
iny
|
||||||
bne @L1
|
bne @L1
|
||||||
|
cli
|
||||||
|
|
||||||
; Done
|
; Done
|
||||||
|
|
||||||
@@ -162,64 +212,55 @@ done: rts
|
|||||||
;
|
;
|
||||||
|
|
||||||
COPYFROM:
|
COPYFROM:
|
||||||
sta ptr3
|
sei
|
||||||
stx ptr3+1 ; Save the passed em_copy pointer
|
jsr setup
|
||||||
|
|
||||||
ldy #EM_COPY::OFFS
|
; Setup is:
|
||||||
lda (ptr3),y
|
;
|
||||||
sta ptr1
|
; - ptr1 contains the struct pointer
|
||||||
ldy #EM_COPY::PAGE
|
; - ptr2 contains the linear memory buffer
|
||||||
lda (ptr3),y
|
; - ptr3 contains -(count-1)
|
||||||
clc
|
; - ptr4 contains the page buffer and offset
|
||||||
adc #>BASE
|
; - tmp1 contains the bank
|
||||||
sta ptr1+1 ; From
|
; - tmp2 contains zero (used for linear memory buffer offset)
|
||||||
|
|
||||||
ldy #EM_COPY::BUF
|
lda #<ptr4
|
||||||
lda (ptr3),y
|
|
||||||
sta ptr2
|
|
||||||
iny
|
|
||||||
lda (ptr3),y
|
|
||||||
sta ptr2+1 ; To
|
|
||||||
|
|
||||||
lda #<ptr1
|
|
||||||
sta FETVEC
|
sta FETVEC
|
||||||
|
jmp @L3
|
||||||
|
|
||||||
ldy #EM_COPY::COUNT+1
|
@L1: ldx tmp1
|
||||||
lda (ptr3),y ; Get number of pages
|
jsr getcurbankmmu
|
||||||
beq @L2 ; Skip if no full pages
|
ldy #0
|
||||||
sta tmp1
|
|
||||||
|
|
||||||
; Copy full pages
|
|
||||||
|
|
||||||
ldy #$00
|
|
||||||
@L1: ldx #MMU_CFG_RAM1
|
|
||||||
jsr FETCH
|
jsr FETCH
|
||||||
|
ldy tmp2
|
||||||
sta (ptr2),y
|
sta (ptr2),y
|
||||||
iny
|
inc tmp2
|
||||||
bne @L1
|
bne @L2
|
||||||
inc ptr1+1
|
|
||||||
inc ptr2+1
|
inc ptr2+1
|
||||||
dec tmp1
|
@L2: inc ptr4
|
||||||
bne @L1
|
|
||||||
|
|
||||||
; Copy the remainder of the page
|
|
||||||
|
|
||||||
@L2: ldy #EM_COPY::COUNT
|
|
||||||
lda (ptr3),y ; Get bytes in last page
|
|
||||||
beq @L4
|
beq @L4
|
||||||
sta tmp1
|
|
||||||
|
|
||||||
ldy #$00
|
; Bump count and repeat
|
||||||
@L3: ldx #MMU_CFG_RAM1
|
|
||||||
jsr FETCH
|
@L3: inc ptr3
|
||||||
sta (ptr2),y
|
bne @L1
|
||||||
iny
|
inc ptr3+1
|
||||||
dec tmp1
|
bne @L1
|
||||||
|
cli
|
||||||
|
rts
|
||||||
|
|
||||||
|
; Bump page register
|
||||||
|
|
||||||
|
@L4: inc ptr4+1
|
||||||
|
lda ptr4+1
|
||||||
|
cmp #$ff
|
||||||
bne @L3
|
bne @L3
|
||||||
|
lda #4
|
||||||
|
sta ptr4+1
|
||||||
|
inc tmp1
|
||||||
|
@L5:
|
||||||
|
jmp @L3
|
||||||
|
|
||||||
; Done
|
|
||||||
|
|
||||||
@L4: rts
|
|
||||||
|
|
||||||
; ------------------------------------------------------------------------
|
; ------------------------------------------------------------------------
|
||||||
; COPYTO: Copy from linear into extended memory. A pointer to a structure
|
; COPYTO: Copy from linear into extended memory. A pointer to a structure
|
||||||
@@ -227,62 +268,159 @@ COPYFROM:
|
|||||||
; The function must not return anything.
|
; The function must not return anything.
|
||||||
;
|
;
|
||||||
|
|
||||||
COPYTO: sta ptr3
|
COPYTO:
|
||||||
stx ptr3+1 ; Save the passed em_copy pointer
|
sei
|
||||||
|
jsr setup
|
||||||
|
|
||||||
ldy #EM_COPY::OFFS
|
; Setup is:
|
||||||
lda (ptr3),y
|
;
|
||||||
sta ptr1
|
; - ptr1 contains the struct pointer
|
||||||
ldy #EM_COPY::PAGE
|
; - ptr2 contains the linear memory buffer
|
||||||
lda (ptr3),y
|
; - ptr3 contains -(count-1)
|
||||||
|
; - ptr4 contains the page buffer and offset
|
||||||
|
; - tmp1 contains the bank
|
||||||
|
; - tmp2 contains zero (used for linear memory buffer offset)
|
||||||
|
|
||||||
|
lda #<ptr4
|
||||||
|
sta STAVEC
|
||||||
|
jmp @L3
|
||||||
|
|
||||||
|
@L1:
|
||||||
|
ldy tmp2
|
||||||
|
lda (ptr2),y
|
||||||
|
ldx tmp1
|
||||||
|
jsr getcurbankmmu
|
||||||
|
ldy #0
|
||||||
|
jsr STASH
|
||||||
|
inc tmp2
|
||||||
|
bne @L2
|
||||||
|
inc ptr2+1
|
||||||
|
@L2: inc ptr4
|
||||||
|
beq @L4
|
||||||
|
|
||||||
|
; Bump count and repeat
|
||||||
|
|
||||||
|
@L3: inc ptr3
|
||||||
|
bne @L1
|
||||||
|
inc ptr3+1
|
||||||
|
bne @L1
|
||||||
|
cli
|
||||||
|
rts
|
||||||
|
|
||||||
|
; Bump page register
|
||||||
|
|
||||||
|
@L4: inc ptr4+1
|
||||||
|
lda ptr4+1
|
||||||
|
cmp #$ff
|
||||||
|
bne @L3
|
||||||
|
inc tmp1
|
||||||
|
lda #4
|
||||||
|
sta ptr4+1
|
||||||
|
@L5:
|
||||||
|
jmp @L3
|
||||||
|
|
||||||
|
; ------------------------------------------------------------------------
|
||||||
|
; Helper function to calculate the correct bank and page
|
||||||
|
; when addressing bank 2 or 3
|
||||||
|
|
||||||
|
calculate_bank_and_correct_page:
|
||||||
|
cpx #2
|
||||||
|
beq @calculate_bank_3_with_2
|
||||||
|
cpx #1
|
||||||
|
beq @calculate_bank_2_or_3_with_1
|
||||||
|
sec
|
||||||
|
sbc #251
|
||||||
|
bcs @calculate_bank_2_with_0
|
||||||
|
ldx #1
|
||||||
|
lda curpage
|
||||||
|
rts
|
||||||
|
|
||||||
|
@calculate_bank_3_with_2:
|
||||||
|
lda curpage
|
||||||
clc
|
clc
|
||||||
adc #>BASE
|
adc #10
|
||||||
sta ptr1+1 ; To
|
@calculate_bank_3_with_1:
|
||||||
|
ldx #3
|
||||||
|
rts
|
||||||
|
|
||||||
|
@calculate_bank_2_or_3_with_1:
|
||||||
|
sec
|
||||||
|
sbc #246
|
||||||
|
bcs @calculate_bank_3_with_1
|
||||||
|
lda curpage
|
||||||
|
clc
|
||||||
|
adc #5
|
||||||
|
@calculate_bank_2_with_0:
|
||||||
|
ldx #2
|
||||||
|
rts
|
||||||
|
|
||||||
|
; ------------------------------------------------------------------------
|
||||||
|
; Helper function to get the correct mmu value in x
|
||||||
|
|
||||||
|
getcurbankmmu:
|
||||||
|
cpx #1
|
||||||
|
beq @bank1
|
||||||
|
cpx #2
|
||||||
|
beq @bank2
|
||||||
|
ldx #MMU_CFG_RAM3
|
||||||
|
rts
|
||||||
|
@bank2:
|
||||||
|
ldx #MMU_CFG_RAM2
|
||||||
|
rts
|
||||||
|
@bank1:
|
||||||
|
ldx #MMU_CFG_RAM1
|
||||||
|
rts
|
||||||
|
|
||||||
|
; ------------------------------------------------------------------------
|
||||||
|
; Helper function for COPYFROM and COPYTO: Store the pointer to the request
|
||||||
|
; structure and prepare data for the copy
|
||||||
|
|
||||||
|
setup: sta ptr1
|
||||||
|
stx ptr1+1 ; Save passed pointer
|
||||||
|
|
||||||
|
; Get the page number from the struct and adjust it so that it may be used
|
||||||
|
; with the hardware. That is: page pointer in ptr4 and bank in tmp1
|
||||||
|
|
||||||
|
ldy #EM_COPY::PAGE+1
|
||||||
|
lda (ptr1),y
|
||||||
|
tax
|
||||||
|
dey
|
||||||
|
lda (ptr1),y
|
||||||
|
sta curpage
|
||||||
|
jsr calculate_bank_and_correct_page
|
||||||
|
clc
|
||||||
|
adc #4
|
||||||
|
sta ptr4+1
|
||||||
|
stx tmp1
|
||||||
|
|
||||||
|
; Get the buffer pointer into ptr2
|
||||||
|
|
||||||
ldy #EM_COPY::BUF
|
ldy #EM_COPY::BUF
|
||||||
lda (ptr3),y
|
lda (ptr1),y
|
||||||
sta ptr2
|
sta ptr2
|
||||||
iny
|
iny
|
||||||
lda (ptr3),y
|
lda (ptr1),y
|
||||||
sta ptr2+1 ; From
|
sta ptr2+1
|
||||||
|
|
||||||
lda #<ptr1
|
; Get the count, calculate -(count-1) and store it into ptr3
|
||||||
sta STAVEC
|
|
||||||
|
|
||||||
ldy #EM_COPY::COUNT+1
|
ldy #EM_COPY::COUNT
|
||||||
lda (ptr3),y ; Get number of pages
|
lda (ptr1),y
|
||||||
beq @L2 ; Skip if no full pages
|
eor #$FF
|
||||||
sta tmp1
|
sta ptr3
|
||||||
|
|
||||||
; Copy full pages
|
|
||||||
|
|
||||||
ldy #$00
|
|
||||||
@L1: lda (ptr2),y
|
|
||||||
ldx #MMU_CFG_RAM1
|
|
||||||
jsr STASH
|
|
||||||
iny
|
iny
|
||||||
bne @L1
|
lda (ptr1),y
|
||||||
inc ptr1+1
|
eor #$FF
|
||||||
inc ptr2+1
|
sta ptr3+1
|
||||||
dec tmp1
|
|
||||||
bne @L1
|
|
||||||
|
|
||||||
; Copy the remainder of the page
|
; Get the page offset into the low byte of ptr4 clear tmp2
|
||||||
|
|
||||||
@L2: ldy #EM_COPY::COUNT
|
ldy #EM_COPY::OFFS
|
||||||
lda (ptr3),y ; Get bytes in last page
|
lda (ptr1),y
|
||||||
beq @L4
|
sta ptr4
|
||||||
sta tmp1
|
lda #0
|
||||||
|
sta tmp2
|
||||||
ldy #$00
|
|
||||||
@L3: lda (ptr2),y
|
|
||||||
ldx #MMU_CFG_RAM1
|
|
||||||
jsr STASH
|
|
||||||
iny
|
|
||||||
dec tmp1
|
|
||||||
bne @L3
|
|
||||||
|
|
||||||
; Done
|
; Done
|
||||||
|
|
||||||
@L4: rts
|
rts
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user