mirror of
https://github.com/romychs/Sprinter-FT.git
synced 2025-04-18 01:52:40 +03:00
Compare commits
2 Commits
9a36cc9440
...
d48227f0ae
| Author | SHA1 | Date | |
|---|---|---|---|
|
d48227f0ae | ||
|
|
490ca266e4 |
BIN
Export/preview.png
Normal file
BIN
Export/preview.png
Normal file
Binary file not shown.
|
After Width: | Height: | Size: 487 KiB |
Binary file not shown.
|
Before Width: | Height: | Size: 73 KiB |
@ -10,7 +10,7 @@
|
|||||||
|
|
||||||
[Файлы для производства](Export/Gerbers/Sprinter-FT_v1.0.0.zip)
|
[Файлы для производства](Export/Gerbers/Sprinter-FT_v1.0.0.zip)
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
[Спринтер в Телеграм](https://t.me/zx_sprinter)
|
[Спринтер в Телеграм](https://t.me/zx_sprinter)
|
||||||
|
|
||||||
|
|||||||
74
Tester/dss.inc
Normal file
74
Tester/dss.inc
Normal file
@ -0,0 +1,74 @@
|
|||||||
|
; ======================================================
|
||||||
|
; Defines for DSS Estex for Sprinter computer
|
||||||
|
; By Roman Boykov. Copyright (c) 2024
|
||||||
|
; https://github.com/romychs
|
||||||
|
; ======================================================
|
||||||
|
|
||||||
|
IFNDEF _DSS_INC
|
||||||
|
DEFINE _DSS_INC
|
||||||
|
|
||||||
|
; DSS RST Entry
|
||||||
|
DSS EQU 0x10
|
||||||
|
|
||||||
|
; DSS Functions
|
||||||
|
DSS_CURDISK EQU 0x02
|
||||||
|
DSS_CREATE_FILE EQU 0x0B
|
||||||
|
DSS_OPEN_FILE EQU 0x11
|
||||||
|
DSS_CLOSE_FILE EQU 0x12
|
||||||
|
DSS_READ_FILE EQU 0x13
|
||||||
|
DSS_WRITE EQU 0x14
|
||||||
|
DSS_MOVE_FP_CP EQU 0x0115
|
||||||
|
DSS_FIND_FIRST EQU 0x0119
|
||||||
|
DSS_FIND_NEXT EQU 0x011A
|
||||||
|
DSS_MKDIR EQU 0x1B
|
||||||
|
DSS_CHDIR EQU 0x1D
|
||||||
|
DSS_CURDIR EQU 0x1E
|
||||||
|
DSS_SCANKEY EQU 0x31
|
||||||
|
DSS_ECHOKEY EQU 0x32
|
||||||
|
DSS_SETMEM EQU 0x38
|
||||||
|
DSS_GETMEM EQU 0x3D
|
||||||
|
DSS_FREEMEM EQU 0x3E
|
||||||
|
DSS_EXIT EQU 0x41
|
||||||
|
DSS_WAITKEY EQU 0x48
|
||||||
|
DSS_SETVMOD EQU 0x50
|
||||||
|
DSS_GETVMOD EQU 0x51
|
||||||
|
DSS_CLEAR EQU 0x56
|
||||||
|
DSS_PUTCHAR EQU 0x5B
|
||||||
|
DSS_PCHARS EQU 0x5C
|
||||||
|
|
||||||
|
|
||||||
|
DSS_VMOD_T40 EQU 0x02 ; text 40x32, 16 colors
|
||||||
|
DSS_VMOD_T80 EQU 0x03 ; text 80x32, 16 colors
|
||||||
|
DSS_VMOD_G320 EQU 0x81 ; graphics 320x256, 256 colors
|
||||||
|
DSS_VMOD_G640 EQU 0x82 ; graphics 640x256, 16 colors
|
||||||
|
|
||||||
|
|
||||||
|
; DSS Error codes
|
||||||
|
E_FILE_EXISTS EQU 7
|
||||||
|
E_FILE_NOT_FOUND EQU 3
|
||||||
|
|
||||||
|
; Keyboard Shift key status bits
|
||||||
|
KB_R_ALT EQU 0x01
|
||||||
|
KB_R_CTRL EQU 0x02
|
||||||
|
KB_L_ALT EQU 0x04
|
||||||
|
KB_L_CTRL EQU 0x08
|
||||||
|
KB_ALT EQU 0x10
|
||||||
|
KB_CTRL EQU 0x20
|
||||||
|
KB_R_SHIFT EQU 0x40
|
||||||
|
KB_L_SHIFT EQU 0x80
|
||||||
|
|
||||||
|
|
||||||
|
; File attributes
|
||||||
|
FA_READONLY EQU 0x01
|
||||||
|
FA_HIDDEN EQU 0x02
|
||||||
|
FA_SYSTEM EQU 0x04
|
||||||
|
FA_LABEL EQU 0x08
|
||||||
|
FA_DIRECTORY EQU 0x10
|
||||||
|
FA_ARCHIVE EQU 0x20
|
||||||
|
|
||||||
|
; File Access mode
|
||||||
|
FM_READ_WRITE EQU 0x00
|
||||||
|
FM_READ EQU 0x01
|
||||||
|
FM_WRITE EQU 0x02
|
||||||
|
|
||||||
|
ENDIF
|
||||||
72
Tester/ftlib.asm
Normal file
72
Tester/ftlib.asm
Normal file
@ -0,0 +1,72 @@
|
|||||||
|
; ======================================================
|
||||||
|
; Library for Sprinter-FT ISA Card
|
||||||
|
; By Roman Boykov. Copyright (c) 2025
|
||||||
|
; https://github.com/romychs
|
||||||
|
; License: BSD 3-Clause
|
||||||
|
; ======================================================
|
||||||
|
|
||||||
|
IFNDEF _FT_LIB
|
||||||
|
DEFINE _FT_LIB
|
||||||
|
|
||||||
|
|
||||||
|
INCLUDE "isa.asm"
|
||||||
|
INCLUDE "util.asm"
|
||||||
|
|
||||||
|
|
||||||
|
FT_CTRL EQU 0x77
|
||||||
|
FT_DATA EQU 0x57
|
||||||
|
|
||||||
|
PORT_FT_CTRL EQU ISA_BASE_A + FT_CTRL ; Memory address to read Strinter-FT Control port
|
||||||
|
PORT_FT_DATA EQU ISA_BASE_A + FT_DATA ; Memory address to read Strinter-FT Data port
|
||||||
|
|
||||||
|
MODULE FT
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; Reset ESP module
|
||||||
|
; ------------------------------------------------------
|
||||||
|
|
||||||
|
FT_RESET
|
||||||
|
PUSH AF,HL
|
||||||
|
|
||||||
|
CALL ISA.ISA_OPEN
|
||||||
|
|
||||||
|
; TODO: FT Init code here
|
||||||
|
|
||||||
|
CALL ISA.ISA_CLOSE
|
||||||
|
|
||||||
|
; wait 2s for ESP firmware boot
|
||||||
|
LD HL,2000
|
||||||
|
CALL UTIL.DELAY
|
||||||
|
|
||||||
|
POP HL,AF
|
||||||
|
RET
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; Check ISA slots for Sprinter-FT card
|
||||||
|
; Out: CF if no card found
|
||||||
|
; (ISA.ISA_SLOT) = slot no 0 - ISA1, 1-ISA2
|
||||||
|
; ------------------------------------------------------
|
||||||
|
FT_FIND
|
||||||
|
PUSH BC, HL
|
||||||
|
|
||||||
|
XOR A
|
||||||
|
LD B,2
|
||||||
|
LD (ISA.ISA_SLOT),A
|
||||||
|
|
||||||
|
.FT_CHK_SLOT:
|
||||||
|
CALL ISA.ISA_OPEN
|
||||||
|
LD A, (PORT_FT_CTRL)
|
||||||
|
CALL ISA.ISA_CLOSE
|
||||||
|
CP 0xFC
|
||||||
|
JR Z, .FT_FOUND
|
||||||
|
LD HL, ISA.ISA_SLOT
|
||||||
|
INC (HL)
|
||||||
|
DJNZ .FT_CHK_SLOT
|
||||||
|
SCF
|
||||||
|
.FT_FOUND
|
||||||
|
POP HL, BC
|
||||||
|
RET
|
||||||
|
|
||||||
|
ENDMODULE
|
||||||
|
|
||||||
|
ENDIF
|
||||||
122
Tester/ftt.asm
Normal file
122
Tester/ftt.asm
Normal file
@ -0,0 +1,122 @@
|
|||||||
|
; ======================================================
|
||||||
|
; FT-Test to test Sprinter-FT
|
||||||
|
; FT812 Video card for Sprinter computer
|
||||||
|
; By Roman Boykov. Copyright (c) 2025
|
||||||
|
; https://github.com/romychs
|
||||||
|
; License: BSD 3-Clause
|
||||||
|
; ======================================================
|
||||||
|
|
||||||
|
; Set to 1 to turn debug ON with DeZog VSCode plugin
|
||||||
|
; Set to 0 to compile .EXE
|
||||||
|
DEBUG EQU 0
|
||||||
|
|
||||||
|
; Set to 1 to output TRACE messages
|
||||||
|
TRACE EQU 0
|
||||||
|
|
||||||
|
; Version of EXE file, 1 for DSS 1.70+
|
||||||
|
EXE_VERSION EQU 0
|
||||||
|
|
||||||
|
; Timeout to wait ESP response
|
||||||
|
DEFAULT_TIMEOUT EQU 2000
|
||||||
|
|
||||||
|
SLDOPT COMMENT WPMEM, LOGPOINT, ASSERTION
|
||||||
|
|
||||||
|
DEVICE NOSLOT64K
|
||||||
|
|
||||||
|
INCLUDE "macro.inc"
|
||||||
|
INCLUDE "dss.inc"
|
||||||
|
INCLUDE "sprinter.inc"
|
||||||
|
|
||||||
|
MODULE MAIN
|
||||||
|
|
||||||
|
ORG 0x8080
|
||||||
|
; ------------------------------------------------------
|
||||||
|
EXE_HEADER
|
||||||
|
DB "EXE"
|
||||||
|
DB EXE_VERSION ; EXE Version
|
||||||
|
DW 0x0080 ; Code offset
|
||||||
|
DW 0
|
||||||
|
DW 0 ; Primary loader size
|
||||||
|
DW 0 ; Reserved
|
||||||
|
DW 0
|
||||||
|
DW 0
|
||||||
|
DW START ; Loading Address
|
||||||
|
DW START ; Entry Point
|
||||||
|
DW STACK_TOP ; Stack address
|
||||||
|
DS 106, 0 ; Reserved
|
||||||
|
|
||||||
|
ORG 0x8100
|
||||||
|
@STACK_TOP
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
START
|
||||||
|
|
||||||
|
IFDEF DEBUG
|
||||||
|
; LD IX,CMD_LINE1
|
||||||
|
LD SP, STACK_TOP
|
||||||
|
; JP MAIN_LOOP
|
||||||
|
ENDIF
|
||||||
|
|
||||||
|
// CALL @WCOMMON.INIT_VMODE
|
||||||
|
|
||||||
|
PRINTLN MSG_START
|
||||||
|
|
||||||
|
CALL ISA.ISA_RESET ; Reset ISA Devices
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; Do Some
|
||||||
|
; ------------------------------------------------------
|
||||||
|
|
||||||
|
MAIN_LOOP
|
||||||
|
|
||||||
|
; Find FT
|
||||||
|
CALL FT.FT_FIND
|
||||||
|
LD HL, MSG_NO_FT
|
||||||
|
JR C, MSG_FNF_OUT
|
||||||
|
; FT is Found
|
||||||
|
LD A, (ISA.ISA_SLOT)
|
||||||
|
INC A
|
||||||
|
LD L, A
|
||||||
|
LD H, 0
|
||||||
|
LD DE, MSG_SLOT_NO
|
||||||
|
CALL UTIL.FAST_UTOA
|
||||||
|
LD HL, MSG_IS_FT
|
||||||
|
; Out message about FT slot
|
||||||
|
MSG_FNF_OUT
|
||||||
|
PRINTLN_HL
|
||||||
|
|
||||||
|
|
||||||
|
OK_EXIT
|
||||||
|
LD B,0
|
||||||
|
DSS_EXEC DSS_EXIT
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; Custom messages
|
||||||
|
; ------------------------------------------------------
|
||||||
|
|
||||||
|
MSG_START
|
||||||
|
DB "FTTest for Sprinter-FT by Sprinter Team. v1.0.b1, ", __DATE__, "\r\n", 0
|
||||||
|
|
||||||
|
MSG_NO_FT
|
||||||
|
DB "Sprinter-FT not found!",0
|
||||||
|
|
||||||
|
|
||||||
|
MSG_IS_FT
|
||||||
|
DB "Sprinter-FT found at ISA"
|
||||||
|
MSG_SLOT_NO
|
||||||
|
DB 0,0,0
|
||||||
|
|
||||||
|
;MSG_EXIT
|
||||||
|
; DB "Bye!",0
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; Custom commands
|
||||||
|
; ------------------------------------------------------
|
||||||
|
|
||||||
|
ENDMODULE
|
||||||
|
|
||||||
|
INCLUDE "ftlib.asm"
|
||||||
|
INCLUDE "util.asm"
|
||||||
|
INCLUDE "isa.asm"
|
||||||
|
|
||||||
|
END MAIN.START
|
||||||
BIN
Tester/ftt.exe
Normal file
BIN
Tester/ftt.exe
Normal file
Binary file not shown.
94
Tester/isa.asm
Normal file
94
Tester/isa.asm
Normal file
@ -0,0 +1,94 @@
|
|||||||
|
; ======================================================
|
||||||
|
; ISA Library for Sprinter computer
|
||||||
|
; By Roman Boykov. Copyright (c) 2024
|
||||||
|
; https://github.com/romychs
|
||||||
|
; License: BSD 3-Clause
|
||||||
|
; ======================================================
|
||||||
|
|
||||||
|
IFNDEF _ISA
|
||||||
|
DEFINE _ISA
|
||||||
|
|
||||||
|
INCLUDE "sprinter.inc"
|
||||||
|
INCLUDE "util.asm"
|
||||||
|
|
||||||
|
PORT_ISA EQU 0x9FBD
|
||||||
|
PORT_SYSTEM EQU 0x1FFD
|
||||||
|
|
||||||
|
ISA_BASE_A EQU 0xC000 ; Базовый адрес портов ISA в памяти
|
||||||
|
|
||||||
|
; --- PORT_ISA bits
|
||||||
|
ISA_A14 EQU 0x01
|
||||||
|
ISA_A15 EQU 0x02
|
||||||
|
ISA_A16 EQU 0x04
|
||||||
|
ISA_A17 EQU 0x08
|
||||||
|
ISA_A18 EQU 0x10
|
||||||
|
ISA_A19 EQU 0x20
|
||||||
|
ISA_AEN EQU 0x40
|
||||||
|
ISA_RST EQU 0x80
|
||||||
|
NOP_FOR_DELAY EQU 5
|
||||||
|
|
||||||
|
MODULE ISA
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; Reset ISA device
|
||||||
|
; ------------------------------------------------------
|
||||||
|
ISA_RESET
|
||||||
|
PUSH AF, BC
|
||||||
|
LD BC, PORT_ISA
|
||||||
|
LD A, ISA_RST | ISA_AEN ; RESET=1 AEN=1
|
||||||
|
OUT (C), A
|
||||||
|
DUP NOP_FOR_DELAY
|
||||||
|
NOP
|
||||||
|
EDUP
|
||||||
|
;CALL @UTIL.DELAY_100uS
|
||||||
|
XOR A
|
||||||
|
OUT (C), A ; RESET=0 AEN=0
|
||||||
|
;CALL @UTIL.DELAY_100uS
|
||||||
|
POP BC, AF
|
||||||
|
RET
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; Open access to ISA ports as memory
|
||||||
|
; Inp: A = 0 - ISA slot 0, 1 - ISA SLOT 1
|
||||||
|
; ------------------------------------------------------
|
||||||
|
ISA_OPEN
|
||||||
|
PUSH AF,BC
|
||||||
|
LD BC, PAGE3
|
||||||
|
IN A,(C)
|
||||||
|
LD (SAVE_MMU3), A
|
||||||
|
LD BC, PORT_SYSTEM
|
||||||
|
LD A, 0x11
|
||||||
|
OUT (C), A
|
||||||
|
ISA_SLOT EQU $+1
|
||||||
|
LD A, 0x00
|
||||||
|
SLA A
|
||||||
|
OR A, 0xD4 ; D4 - ISA1, D6 - ISA2
|
||||||
|
LD BC, PAGE3
|
||||||
|
OUT (C), A
|
||||||
|
LD BC, PORT_ISA
|
||||||
|
XOR A
|
||||||
|
OUT (C), A
|
||||||
|
POP BC,AF
|
||||||
|
RET
|
||||||
|
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; Close access to ISA ports
|
||||||
|
; ------------------------------------------------------
|
||||||
|
ISA_CLOSE
|
||||||
|
PUSH AF,BC
|
||||||
|
LD A,0x01
|
||||||
|
LD BC,PORT_SYSTEM
|
||||||
|
OUT (C),A
|
||||||
|
LD BC,PAGE3
|
||||||
|
LD A,(SAVE_MMU3)
|
||||||
|
OUT (C),A
|
||||||
|
POP BC,AF
|
||||||
|
RET
|
||||||
|
|
||||||
|
; To save memory page 3
|
||||||
|
SAVE_MMU3 DB 0
|
||||||
|
|
||||||
|
ENDMODULE
|
||||||
|
|
||||||
|
ENDIF
|
||||||
70
Tester/macro.inc
Normal file
70
Tester/macro.inc
Normal file
@ -0,0 +1,70 @@
|
|||||||
|
; ======================================================
|
||||||
|
; Macros for Sprinter-WiFi utilities
|
||||||
|
; By Roman Boykov. Copyright (c) 2024
|
||||||
|
; https://github.com/romychs
|
||||||
|
; License: BSD 3-Clause
|
||||||
|
; ======================================================
|
||||||
|
|
||||||
|
IFNDEF _MACRO
|
||||||
|
DEFINE _MACRO
|
||||||
|
|
||||||
|
; Transmit data|command via UART and check response
|
||||||
|
MACRO SEND_CMD data
|
||||||
|
LD HL, data
|
||||||
|
CALL @WIFI.UART_TX_CMD
|
||||||
|
CALL CHECK_ERROR
|
||||||
|
ENDM
|
||||||
|
|
||||||
|
; Print data forn HL - pointer to ASCIIZ string to screen
|
||||||
|
MACRO PRINT_HL
|
||||||
|
LD C,DSS_PCHARS
|
||||||
|
RST DSS
|
||||||
|
ENDM
|
||||||
|
|
||||||
|
; Print data forn HL - pointer to ASCIIZ string to screen, and <CR><LF>
|
||||||
|
MACRO PRINTLN_HL
|
||||||
|
PRINT_HL
|
||||||
|
LD HL, UTIL.LINE_END
|
||||||
|
PRINT_HL
|
||||||
|
ENDM
|
||||||
|
|
||||||
|
; Print data ASCIIZ string to screen
|
||||||
|
MACRO PRINT data
|
||||||
|
LD HL,data
|
||||||
|
PRINT_HL
|
||||||
|
ENDM
|
||||||
|
|
||||||
|
; Print data ASCIIZ string to screen and <CR><LF>
|
||||||
|
MACRO PRINTLN data
|
||||||
|
LD HL,data
|
||||||
|
PRINTLN_HL
|
||||||
|
ENDM
|
||||||
|
|
||||||
|
; Print data ASCIIZ string to screen if TRACE enabled
|
||||||
|
MACRO TRACELN data
|
||||||
|
IFDEF TRACE
|
||||||
|
PUSH BC,DE
|
||||||
|
PRINTLN data
|
||||||
|
POP DE,BC
|
||||||
|
ENDIF
|
||||||
|
ENDM
|
||||||
|
|
||||||
|
; Execute specified DSS function
|
||||||
|
MACRO DSS_EXEC func
|
||||||
|
IF func>255
|
||||||
|
LD BC,func
|
||||||
|
ELSE
|
||||||
|
LD C,func
|
||||||
|
ENDIF
|
||||||
|
RST DSS
|
||||||
|
ENDM
|
||||||
|
|
||||||
|
; If current work mode is upload, go to label
|
||||||
|
MACRO IF_UPLOAD_GO lbl
|
||||||
|
LD A,(WORK_MODE)
|
||||||
|
;CP WM_UPLOAD
|
||||||
|
DEC A
|
||||||
|
JR Z,lbl
|
||||||
|
ENDM
|
||||||
|
|
||||||
|
ENDIF
|
||||||
37
Tester/sprinter.inc
Normal file
37
Tester/sprinter.inc
Normal file
@ -0,0 +1,37 @@
|
|||||||
|
; ======================================================
|
||||||
|
; Defines for Sprinter computer hardware
|
||||||
|
; By Roman Boykov. Copyright (c) 2024
|
||||||
|
; https://github.com/romychs
|
||||||
|
; ======================================================
|
||||||
|
|
||||||
|
IFNDEF _SPRINTER
|
||||||
|
DEFINE _SPRINTER
|
||||||
|
|
||||||
|
; Memory pages
|
||||||
|
PAGE0_ADDR EQU 0x0000
|
||||||
|
PAGE1_ADDR EQU 0x4000
|
||||||
|
PAGE2_ADDR EQU 0x8000
|
||||||
|
PAGE3_ADDR EQU 0xC000
|
||||||
|
|
||||||
|
; Sprinter ports to switch mem pages
|
||||||
|
PAGE0 EQU 0x82
|
||||||
|
PAGE1 EQU 0xA2
|
||||||
|
PAGE2 EQU 0xC2
|
||||||
|
PAGE3 EQU 0xE2
|
||||||
|
|
||||||
|
; CTC Control register ports
|
||||||
|
CTC_CH0 EQU 0x10
|
||||||
|
CTC_CH1 EQU 0x11
|
||||||
|
CTC_CH2 EQU 0x12
|
||||||
|
CTC_CH3 EQU 0x13
|
||||||
|
|
||||||
|
CTC_CR_VEC EQU 0x01 ; 1 - Vector, 0 - Control
|
||||||
|
CTC_CR_SWR EQU 0x02 ; 1 - Software Reset, 0 - Continued operation
|
||||||
|
CTC_CR_TCF EQU 0x04 ; 1 - TYime const follows
|
||||||
|
CTC_CR_TTR EQU 0x08 ; 1 - Time trigger
|
||||||
|
CTC_CT_TRE EQU 0x10 ; 1 - Trigger Edge
|
||||||
|
CTC_CT_PRE EQU 0x20 ; 1 - 256 Prescaler, 0 - 16
|
||||||
|
CTC_CT_CTR EQU 0x40 ; 0 - Timer, 1 - Counter
|
||||||
|
CTC_CT_EI EQU 0x80 ; Interrupt 1 - enable, 0 - disable
|
||||||
|
|
||||||
|
ENDIF
|
||||||
405
Tester/util.asm
Normal file
405
Tester/util.asm
Normal file
@ -0,0 +1,405 @@
|
|||||||
|
; ======================================================
|
||||||
|
; Utility code for Sprinter-WiFi utilities
|
||||||
|
; By Roman Boykov. Copyright (c) 2024
|
||||||
|
; https://github.com/romychs
|
||||||
|
; License: BSD 3-Clause
|
||||||
|
; ======================================================
|
||||||
|
|
||||||
|
IFNDEF _UTIL
|
||||||
|
DEFINE _UTIL
|
||||||
|
|
||||||
|
MODULE UTIL
|
||||||
|
|
||||||
|
MAX_BUFF_SIZE EQU 2048
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; Small delay
|
||||||
|
; Inp: HL - number of cycles, if HL=0, then 2000
|
||||||
|
; ------------------------------------------------------
|
||||||
|
DELAY
|
||||||
|
PUSH AF,BC,HL
|
||||||
|
|
||||||
|
LD A,H
|
||||||
|
OR L
|
||||||
|
JR NZ,.DELAY_NXT
|
||||||
|
LD HL,20
|
||||||
|
|
||||||
|
.DELAY_NXT
|
||||||
|
CALL .DELAY_1MS_INT
|
||||||
|
DEC HL
|
||||||
|
LD A,H
|
||||||
|
OR L
|
||||||
|
JP NZ,.DELAY_NXT
|
||||||
|
|
||||||
|
POP HL,BC,AF
|
||||||
|
RET
|
||||||
|
|
||||||
|
.DELAY_1MS_INT
|
||||||
|
LD BC,400
|
||||||
|
.SBD_NXT
|
||||||
|
DEC BC
|
||||||
|
LD A, B
|
||||||
|
OR C
|
||||||
|
JR NZ, .SBD_NXT
|
||||||
|
RET
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; Delay for about 1ms
|
||||||
|
; ------------------------------------------------------
|
||||||
|
DELAY_1MS
|
||||||
|
PUSH BC
|
||||||
|
CALL DELAY.DELAY_1MS_INT
|
||||||
|
POP BC
|
||||||
|
RET
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; Delay for about 100us
|
||||||
|
; ------------------------------------------------------
|
||||||
|
DELAY_100uS
|
||||||
|
PUSH BC
|
||||||
|
LD BC,40
|
||||||
|
CALL DELAY.SBD_NXT
|
||||||
|
POP BC
|
||||||
|
RET
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; Calc length of zero ended string
|
||||||
|
; Inp: HL - pointer to string;
|
||||||
|
; Out: BC - length of string
|
||||||
|
; ------------------------------------------------------
|
||||||
|
;;IFUSED STRLEN
|
||||||
|
STRLEN
|
||||||
|
PUSH DE, HL, HL
|
||||||
|
LD BC, MAX_BUFF_SIZE
|
||||||
|
XOR A
|
||||||
|
CPIR
|
||||||
|
POP DE
|
||||||
|
SBC HL, DE ; length of zero ended string
|
||||||
|
LD BC, HL
|
||||||
|
LD A, B
|
||||||
|
OR C
|
||||||
|
JR Z, .STRL_NCOR
|
||||||
|
DEC BC
|
||||||
|
.STRL_NCOR
|
||||||
|
POP HL, DE
|
||||||
|
RET
|
||||||
|
;ENDIF
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; Compare strings
|
||||||
|
; Inp: HL, DE - pointers to asciiz strings to compare;
|
||||||
|
; Out: CF=0 - equal, CF=1 - not equal
|
||||||
|
; ------------------------------------------------------
|
||||||
|
;;IFUSED STRCMP
|
||||||
|
STRCMP
|
||||||
|
PUSH DE,HL
|
||||||
|
.STC_NEXT
|
||||||
|
LD A, (DE)
|
||||||
|
CP (HL)
|
||||||
|
JR NZ,.STC_NE
|
||||||
|
AND A
|
||||||
|
JR Z,.STC_EQ
|
||||||
|
INC DE
|
||||||
|
INC HL
|
||||||
|
JR .STC_NEXT
|
||||||
|
.STC_NE
|
||||||
|
SCF
|
||||||
|
.STC_EQ
|
||||||
|
POP HL,DE
|
||||||
|
RET
|
||||||
|
;;ENDIF
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; Compare first BC chars for two zero-ended strings
|
||||||
|
; Inp: HL, DE - pointers to strings to compare;
|
||||||
|
; BC - Number of chars to compare;
|
||||||
|
; Out: ZF=0 - not equal, ZF=1 - equal
|
||||||
|
; ------------------------------------------------------
|
||||||
|
;IFUSED STRNCMP
|
||||||
|
STRNCMP
|
||||||
|
PUSH HL,DE,BC
|
||||||
|
.STRN_NXT
|
||||||
|
LD A,(DE)
|
||||||
|
SUB (HL)
|
||||||
|
JR NZ,.STRN_NE
|
||||||
|
LD A,(DE)
|
||||||
|
OR A
|
||||||
|
JR Z,.STRN_NE
|
||||||
|
INC DE
|
||||||
|
INC HL
|
||||||
|
DEC BC
|
||||||
|
LD A,B
|
||||||
|
OR C
|
||||||
|
JP NZ,.STRN_NXT
|
||||||
|
.STRN_NE
|
||||||
|
POP BC,DE,HL
|
||||||
|
RET
|
||||||
|
;ENDIF
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; Checks whether a string (HL) starts with the strinf (DE)
|
||||||
|
; Inp: DE - points to start string;
|
||||||
|
; HL - points to string;
|
||||||
|
; Out: ZF=0 - not equal, ZF=1 - equal
|
||||||
|
; ------------------------------------------------------
|
||||||
|
;;IFUSED STARTSWITH
|
||||||
|
STARTSWITH
|
||||||
|
PUSH HL,DE
|
||||||
|
.STRW_NXT
|
||||||
|
LD A,(DE)
|
||||||
|
OR A
|
||||||
|
JR Z,.STRW_END
|
||||||
|
LD A,(DE)
|
||||||
|
CP (HL)
|
||||||
|
JR NZ,.STRW_END
|
||||||
|
INC HL
|
||||||
|
INC DE
|
||||||
|
JR .STRW_NXT
|
||||||
|
.STRW_END
|
||||||
|
POP DE,HL
|
||||||
|
RET
|
||||||
|
;;ENDIF
|
||||||
|
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; Skip spaces at start of zero ended string
|
||||||
|
; Inp: HL - pointer to string;
|
||||||
|
; Out: HL - points to first non space symbol
|
||||||
|
; ------------------------------------------------------
|
||||||
|
;;IFUSED LTRIM
|
||||||
|
LTRIM
|
||||||
|
LD A, (HL)
|
||||||
|
OR A
|
||||||
|
RET Z
|
||||||
|
CP 0x21
|
||||||
|
RET P
|
||||||
|
INC HL
|
||||||
|
JR LTRIM
|
||||||
|
;;ENDIF
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; Convert string to number
|
||||||
|
; Inp: DE - ptr to zero ended string;
|
||||||
|
; Out: HL - Result
|
||||||
|
; ------------------------------------------------------
|
||||||
|
;;IFUSED ATOU
|
||||||
|
ATOU
|
||||||
|
PUSH BC
|
||||||
|
LD HL,0x0000
|
||||||
|
.ATOU_L1
|
||||||
|
LD A,(DE)
|
||||||
|
AND A
|
||||||
|
JR Z, .ATOU_LE
|
||||||
|
SUB 0x30
|
||||||
|
CP 10
|
||||||
|
JR NC, .ATOU_LE
|
||||||
|
INC DE
|
||||||
|
LD B,H
|
||||||
|
LD C,L
|
||||||
|
ADD HL,HL
|
||||||
|
ADD HL,HL
|
||||||
|
ADD HL,BC
|
||||||
|
ADD HL,HL
|
||||||
|
ADD A,L
|
||||||
|
LD L,A
|
||||||
|
JR NC,.ATOU_L1
|
||||||
|
INC H
|
||||||
|
JP .ATOU_L1
|
||||||
|
.ATOU_LE
|
||||||
|
POP BC
|
||||||
|
RET
|
||||||
|
;;ENDIF
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; Convert 16 bit unsigned number to string
|
||||||
|
; Inp: HL - number;
|
||||||
|
; DE - ptr to buffer;
|
||||||
|
; Out: DE -> asciiz string representing a number
|
||||||
|
; ------------------------------------------------------
|
||||||
|
;;IFUSED UTOA
|
||||||
|
UTOA:
|
||||||
|
PUSH BC, HL
|
||||||
|
XOR A
|
||||||
|
PUSH AF ; END MARKER A=0, Z
|
||||||
|
.UTOA_L1
|
||||||
|
CALL DIV_10
|
||||||
|
ADD '0'
|
||||||
|
PUSH AF ; DIGIT: A>0, NZ
|
||||||
|
LD A,H
|
||||||
|
OR L
|
||||||
|
JR NZ,.UTOA_L1
|
||||||
|
.UTOA_L2
|
||||||
|
POP AF
|
||||||
|
LD (DE),A
|
||||||
|
INC DE
|
||||||
|
JR NZ,.UTOA_L2
|
||||||
|
POP HL, BC
|
||||||
|
RET
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; Division by 10
|
||||||
|
; Inp: HL - number;
|
||||||
|
; Out: HL - quotient;
|
||||||
|
; A - remainder;
|
||||||
|
; ------------------------------------------------------
|
||||||
|
DIV_10:
|
||||||
|
PUSH BC
|
||||||
|
LD BC,0x0D0A
|
||||||
|
XOR A
|
||||||
|
ADD HL,HL
|
||||||
|
RLA
|
||||||
|
ADD HL,HL
|
||||||
|
RLA
|
||||||
|
ADD HL,HL
|
||||||
|
RLA
|
||||||
|
.DDL1
|
||||||
|
ADD HL,HL
|
||||||
|
RLA
|
||||||
|
CP C
|
||||||
|
JR C,.DDL2
|
||||||
|
SUB C
|
||||||
|
INC L
|
||||||
|
.DDL2
|
||||||
|
DJNZ .DDL1
|
||||||
|
POP BC
|
||||||
|
RET
|
||||||
|
;;ENDIF
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; FAST_UTOA
|
||||||
|
; Inp: HL - number;
|
||||||
|
; DE - Buffer;
|
||||||
|
; CF is set to write leading zeroes;
|
||||||
|
; Out: DE - address of destination string
|
||||||
|
; ------------------------------------------------------
|
||||||
|
;;IFUSED FAST_UTOA
|
||||||
|
FAST_UTOA
|
||||||
|
LD BC,0+256
|
||||||
|
PUSH BC
|
||||||
|
LD BC,-10+256
|
||||||
|
PUSH BC
|
||||||
|
INC H
|
||||||
|
DEC H
|
||||||
|
JR Z, .EIGHT_BIT
|
||||||
|
|
||||||
|
LD C,0xFF & (-100+256)
|
||||||
|
PUSH BC
|
||||||
|
|
||||||
|
LD BC,-1000+256
|
||||||
|
PUSH BC
|
||||||
|
|
||||||
|
LD BC,-10000
|
||||||
|
|
||||||
|
JR C,.LEADING_ZEROES
|
||||||
|
|
||||||
|
.NO_LEADING_ZEROES
|
||||||
|
|
||||||
|
CALL .DIVIDE
|
||||||
|
CP '0'
|
||||||
|
JR NZ,.WRITE
|
||||||
|
|
||||||
|
POP BC
|
||||||
|
DJNZ .NO_LEADING_ZEROES
|
||||||
|
|
||||||
|
JR .WRITE1S
|
||||||
|
|
||||||
|
.LEADING_ZEROES
|
||||||
|
CALL .DIVIDE
|
||||||
|
|
||||||
|
.WRITE
|
||||||
|
LD (DE),A
|
||||||
|
INC DE
|
||||||
|
|
||||||
|
POP BC
|
||||||
|
DJNZ .LEADING_ZEROES
|
||||||
|
|
||||||
|
.WRITE1S
|
||||||
|
LD A,L
|
||||||
|
ADD A,'0'
|
||||||
|
|
||||||
|
LD (DE),A
|
||||||
|
INC DE
|
||||||
|
RET
|
||||||
|
|
||||||
|
.DIVIDE
|
||||||
|
LD A,'0'-1
|
||||||
|
|
||||||
|
.DIVLOOP
|
||||||
|
INC A
|
||||||
|
ADD HL,BC
|
||||||
|
JR C, .DIVLOOP
|
||||||
|
|
||||||
|
SBC HL,BC
|
||||||
|
RET
|
||||||
|
|
||||||
|
.EIGHT_BIT
|
||||||
|
LD BC,-100
|
||||||
|
JR NC, .NO_LEADING_ZEROES
|
||||||
|
|
||||||
|
; write two leading zeroes to output string
|
||||||
|
LD A,'0'
|
||||||
|
LD (DE),A
|
||||||
|
INC DE
|
||||||
|
LD (DE),A
|
||||||
|
INC DE
|
||||||
|
|
||||||
|
JR .LEADING_ZEROES
|
||||||
|
;;ENDIF
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; Find char in string
|
||||||
|
; Inp: HL - ptr to zero endeds string;
|
||||||
|
; A - char to find;
|
||||||
|
; Outp: CF=0, HL points to char if found;
|
||||||
|
; CF=1 - Not found
|
||||||
|
; ------------------------------------------------------
|
||||||
|
;;IFUSED STRCHR
|
||||||
|
STRCHR
|
||||||
|
PUSH BC
|
||||||
|
.STCH_NEXT
|
||||||
|
LD C,A
|
||||||
|
LD A,(HL)
|
||||||
|
AND A
|
||||||
|
JR Z, .STCH_N_FOUND
|
||||||
|
CP C
|
||||||
|
JR Z, .STCH_FOUND
|
||||||
|
INC HL
|
||||||
|
JR .STCH_NEXT
|
||||||
|
.STCH_N_FOUND
|
||||||
|
SCF
|
||||||
|
.STCH_FOUND
|
||||||
|
POP BC
|
||||||
|
RET
|
||||||
|
;;ENDIF
|
||||||
|
|
||||||
|
; ------------------------------------------------------
|
||||||
|
; Convert Byte to hex
|
||||||
|
; Inp: C
|
||||||
|
; Out: (DE)
|
||||||
|
; ------------------------------------------------------
|
||||||
|
HEXB
|
||||||
|
LD A,C
|
||||||
|
RRA
|
||||||
|
RRA
|
||||||
|
RRA
|
||||||
|
RRA
|
||||||
|
CALL .CONV_NIBLE
|
||||||
|
LD A,C
|
||||||
|
|
||||||
|
.CONV_NIBLE
|
||||||
|
AND 0x0f
|
||||||
|
ADD A,0x90
|
||||||
|
DAA
|
||||||
|
ADC A,0x40
|
||||||
|
DAA
|
||||||
|
LD (DE), A
|
||||||
|
INC DE
|
||||||
|
RET
|
||||||
|
|
||||||
|
LINE_END
|
||||||
|
DB "\r\n",0
|
||||||
|
|
||||||
|
ENDMODULE
|
||||||
|
|
||||||
|
ENDIF
|
||||||
Loading…
Reference in New Issue
Block a user