;;
;; Official Kernal routine, described in:
;;
;; - [RG64] C64 Programmer's Reference Guide   - page 285
;; - [CM64] Compute's Mapping the Commodore 64 - page 238
;;
;; CPU registers that has to be preserved (see [RG64]): none
;;

ioinit:

	; Set $00/$01 port mode and value
	; We want BASIC and KERNAL ROMs mapped, and datasette motor off
	; (https://www.c64-wiki.com/wiki/Zeropage)
	;; XXX - Work around VICE bug: Writing $00 before $01 results in rubbish in $01
	;; after. https://sourceforge.net/p/vice-emu/bugs/1057/
	lda #$27
	ldx #$2F
	sta CPU_R6510
	stx CPU_D6510

	;; Silence the SID chips under common addresses

	ldy #$00
*
	;; SIDs under $D4xx
	lda SID_SIGVOL, Y
	and #$F0
	sta SID_SIGVOL, Y
	;; SIDs under $D5xx
	lda SID_SIGVOL + $100, Y
	and #$F0
	sta SID_SIGVOL + $100, Y
	tya
	clc
	adc #$20
	tay
	bne -

	;; XXX: calibrate TOD for both CIA's, see here: https://codebase64.org/doku.php?id=base:efficient_tod_initialisation

	;; Enable CIA1 IRQ and ~50Hz timer (https://csdb.dk/forums/?roomid=11&topicid=69037)
	lda #$7F
	sta CIA1_ICR ; disable all

	;; Set timer interval to ~1/60th of a second
	
	;; (This value was calculated by running a custom IRQ handler on a C64
	;; with original KERNAL, and writing the values of $DC04/5 to the screen
	;; in the IRQ handler to see roughly what value the timers must be set to)
	;; ldy #<16380
	;; ldx #>16380

	;; PAL C64 (https://codebase64.org/doku.php?id=base:cpu_clocking),
	;; is clocked at 0.985248 MHz, so that 1/60s is 16421 CPU cycles

	ldy #<16421
	ldx #>16421

	sty CIA1_TIMALO
	stx CIA1_TIMAHI

	;; Enable timer interrupt
	lda #$81
	sta CIA1_ICR

	;; Enable timer A to run continuously (http://codebase64.org/doku.php?id=base:timerinterrupts)
	lda #$11
	sta CIA1_CRA
	lda CIA1_ICR

	;; Set DDR on CIA2 for IEC bus, VIC-II banking
	lda #$3B
	sta CIA2_DDRA

	;; Set IEC bus to its initial idle state
	jmp iec_set_idle