monitor command 'F' adaptation, not tested yet

src/mon_m65/mon_helper_memory.s

@@ -10,6 +10,74 @@ Get_From_Memory:
 
 	; Copy PC + .Z to TMP, set .Z to 0
 
+	jsr  Get_Put_Memory_Prepare
+
+	; Check addressing mode
+
+	bbs7  Addr_Mode, @mode_flat
+
+@mode_64k:
+
+	lda  #$00                          ; make sure this is 64K address
+	sta  Long_TMP+2
+	sta  Long_TMP+3
+
+	lda  Long_TMP+1
+	bne  @read_64k                     ; branch if no need to handle shadow memory (not zero page)
+	lda  Long_TMP+0
+	dec
+	dec
+	cmp  #$8E
+	bcs  @read_64k                     ; branch if no need to handle shadow memory (0, 1, or above $8F)
+@1:
+	bra  @read_shadow
+
+@mode_flat:
+
+	lda  Long_TMP+3
+	ora  Long_TMP+2
+	ora  Long_TMP+1
+	bne  @read_flat
+
+	lda  Long_TMP+0
+	dec
+	dec
+	cmp  #$8E
+	bcs  @read_flat
+	bra  @1
+
+@read_64k:
+
+	bbr7 Long_TMP+1, @read_flat        ; below $8000 we do not want to retrieve MAP/EOM banked memory
+	bra  @read
+
+@read_shadow:
+
+	jsr  Get_Put_Memory_Prepare_Shadow
+
+@read_flat:
+	
+	jsr  monitor_memread_helper
+	bra  Get_Put_Memory_End
+
+@read:
+
+	lda  (Long_TMP),Z
+
+	; FALLTROUGH
+
+Get_Put_Memory_End: 
+
+	plz
+	ply
+	plx
+
+	rts
+
+Get_Put_Memory_Prepare:
+
+	; Copy PC + .Z to TMP, set .Z to 0
+
 	clc
 	tza
 	adc  Long_PC+0
@@ -26,47 +94,11 @@ Get_From_Memory:
 
 	ldz  #$00
 
-	; Check addressing mode
+	rts
 
-	bbs7  Adr_Mode, @mode_flat
+Get_Put_Memory_Prepare_Shadow:
 
-@mode_64k:
-
-	lda  #$00                          ; make sure this is 64K address
-	sta  Long_TMP+2
-	sta  Long_TMP+3
-
-	lda  Long_TMP+1
-	bne  @read_64k                     ; branch if no need to handle shadow memory (not zero page)
-	lda  Long_TMP+0
-	dec
-	dec
-	cmp  #$8E
-	bcs  @read_64k                     ; branch if no need to handle shadow memory (0, 1, or above $8F)
-@2:
 	sta  Long_TMP+0
-	bra  @read_shadow
-
-@mode_flat:
-
-	lda  Long_TMP+3
-	ora  Long_TMP+2
-	ora  Long_TMP+1
-	bne  @read_flat
-
-	lda  Long_TMP+0
-	dec
-	dec
-	cmp  #$8E
-	bcs  @read_flat
-	bra  @2
-
-@read_64k:
-
-	bbr7 Long_TMP+1, @read_flat        ; below $8000 we do not want to retrieve MAP/EOM banked memory
-	bra  @read
-
-@read_shadow:
 
 	lda  #MEMCONF_SHADOW_BZP_1
 	sta  Long_TMP+1
@@ -75,18 +107,40 @@ Get_From_Memory:
 	lda  #MEMCONF_SHADOW_BZP_3
 	sta  Long_TMP+3
 
-@read_flat:
-	
-	jsr  monitor_memread_helper
-	bra  @end
-
-@read: 
-	lda  (Long_TMP),Z
-
-@end: 
-
-	plz
-	ply
-	plx
-
 	rts
+
+
+
+Put_To_Memory:
+
+	phx
+	phy
+	phz
+	pha
+
+	; Copy PC + .Z to TMP, set .Z to 0
+
+	jsr Get_Put_Memory_Prepare
+
+	; Check if address is related to shadow zeropage
+
+	lda  Long_TMP+1
+	ora  Long_TMP+2
+	ora  Long_TMP+3
+	beq  @write_flat
+
+	lda  Long_TMP+0
+	dec
+	dec
+	cmp  #$8E
+	bcs  @write_flat
+
+@write_shadow:
+
+	jsr Get_Put_Memory_Prepare_Shadow
+
+@write_flat:
+
+	pla
+	jsr  monitor_memwrite_helper
+	bra  Get_Put_Memory_End