- global add_hla
- global ioiniml,ioini1l
- global intinit
- global bufinit
+ public intinit
+ public bufinit
+ public cpu_frq
+ public get_tmr
- global fifolst
+ public fifolst
- extrn ?pmsg
- extrn msg.sm,hwl2phy
+ extrn div32_r,?pmsg
+ extrn msg.sm,msg.recv,hwl2phy
include config.inc
include z180reg.inc
-;--------------------------------------------------------------
-;
-; add a to hl
-;
-; return:
-; hl = hl + a
-; Flags undefined
-
- cseg ; (common. TODO: check for banked)
-
-add_hla:
- add a,l
- ld l,a
- ret nc
- inc h
- ret
-
-;----------------------------------------------------------------------
-
- ; output bytes to consecutive portaddresses
- ;
- ; hl: table with following structure:
- ; db n, port1, val1, val2,... valn
- ; db m, port1, val1, val2,... valm
- ; ...
- ; db 0 ; Terminate table
-
-
- cseg ; (common for now)
-
-ioiniml:
- push bc
- xor a
-ioml_lp:
- ld b,(hl)
- inc hl
- cp b
- jr z,ioml_e
-
- ld c,(hl)
- inc hl
- otimr
- jr ioml_lp
-ioml_e:
- pop bc
- ret
-
-;----------------------------------------------------------------------
-
- ; output bytes to ports
- ;
- ; hl: tables of port,value pairs:
- ; db n, port1,val1, port2,val2,... portn,valn
- ; ...
- ; db 0 ; Terminate table
-
- cseg ; (common for now)
-
-ioini1l:
- push bc
- jr io1_nxt
-io1_lp:
- ld c,(hl) ;port address
- inc hl
- otim
- jr nz,io1_lp
-io1_nxt:
- ld b,(hl) ;count
- inc hl
- inc b
- djnz io1_lp
-
- pop bc
- ret
;----------------------------------------------------------------------
spi$nr: db '0'
db 0
+;--------------------------------------------------------------------
+;
+; Get/compute CPU clock
+;
+; return:
+; hlde: CPU frequency (Hz)
+;
+
+ dseg
+
+cpu_frq:
+ ld hl,0
+ ld d,h
+ ld e,l
+ call get_tmr
+ push de
+ push hl
+
+; delay ~8ms @ 18.432MHz --> 147456 clock cycles
+; delay ~10ms @ 18.432MHz --> 184320 clock cycles
+;
+
+; ld hl,8192 ; 147456/18
+ ld hl,(10240-100)*5 ; 184320/18
+ ld de,1
+ or a
+dly_lp:
+ sbc hl,de ; 10
+ jr nz,dly_lp ; 6/8 -> 18 cycles
+
+ pop hl
+ pop de
+ call get_tmr
+
+ ld b,h
+ ld c,l
+ ld de,036EEh ;18432000/(2**16) * 50
+ ld hl,08000h ;18432000%(2**16) * 50
+
+ ld a,b
+ or a
+ jr nz,cpuf_div
+ ld a,c
+ cp 2
+ jr c,cpuf_done
+cpuf_div:
+ call div32_r
+cpuf_done:
+ ret
+
+;--------------------------------------------------------------------
+
+ dseg
+get_tmr:
+ push de
+ push hl
+ ld hl,1*256 + 3 ; h = subcommand, l = command
+ push hl
+ ld hl,0
+ add hl,sp
+ ld b,6
+ call msg.sm
+
+ dec sp
+ ld hl,0
+ add hl,sp
+ ld b,7 ; max receive message len
+ call msg.recv
+
+ pop bc
+ inc sp
+ pop hl
+ pop de
+ ret
;--------------------------------------------------------------------
- cseg
+ dseg
fifolst:
rept 4
dw 0
- db 0
endm
;--------------------------------------------------------------------
dseg
bufinit:
- ld c,a
+ ld (ix+o.in_idx),0 ;reset pointers (empty fifo)
+ ld (ix+o.out_idx),0
ld a,(ix+o.id)
- cp 4
- jr nc,bfi_doit2
-
ld hl,fifolst
ld e,a
ld d,0
add hl,de
add hl,de
- add hl,de
-
- ld e,(hl)
- inc hl
- ld d,(hl)
- dec hl
- ld a,e
- or d
- jr z,bfi_doit
-
-; TODO: address translation
- push de
- pop ix
- ret
-
-bfi_doit:
push ix
pop de
-; TODO: address translation
+ cp 4
+ jr nc,bfi_skip
+
ld (hl),e
inc hl
ld (hl),d
- ld a,(ix+o.id)
- or a
- jr nz,bfi_doit2
-
- ld hl,fifolst
- ld (040h),hl
- ld (040h+2),a
-
-bfi_doit2:
- ld (ix+o.in_idx),0 ;reset pointers
- ld (ix+o.out_idx),0
- ld (ix+o.mask),c ;reset "size"
- push ix ;get phys. address of fifo
- pop hl
- call hwl2phy
+bfi_skip:
ex de,hl
+ call hwl2phy ;get phys. address of fifo
ld c,a
ld a,(ix+o.id) ;fifo id
or a ;test if fifo 0
- jr nz,bfi_1
-
- out (AVRINT5),a
- ret
-
-bfi_1:
- ld hl,bfi_msg_end
- ld (hl),c
- dec hl
- ld (hl),d
- dec hl
- ld (hl),e
- dec hl
- ld (hl),a
- dec hl
- ld b,bfi_msg_len
+ ret z
+
+ ld b,a
+ push bc ;c: bank-addr, b: ignored
+ push hl ;address
+ ld c,0
+ push bc ;c: function, b:subf
+ ld b,5
+ ld h,c
+ ld l,c
+ add hl,sp
call msg.sm
+ pop hl
+ pop hl
+ pop hl
ret
-bfi_msg:
- db 0 ;function: 0
- db 0 ;subfunc: gets overwritten with buf id
- dw 0 ;physical
- db 0 ; address
-bfi_msg_len equ $ - bfi_msg
-bfi_msg_end equ $ - 1
-
;----------------------------------------------------------------------