add timeout to R3 I2C setup #800

MEGA65 · Apr 21, 2024 · 4879631 · 4879631
1 parent 644d278
commit 4879631
Showing 1 changed file with 15 additions and 2 deletions.
diff --git a/src/hyppo/targetsetup.asm b/src/hyppo/targetsetup.asm
@@ -50,16 +50,29 @@ mps3_loop:
         lda mega65r3_i2c_settings,y
         iny
 
+	ldx #$ff		
 
         ;; Keep writing it until it gets written
--
+	-
  	sta [<zptempv32],z
 
 	inc $d020	
         cmp [<zptempv32],z
-        bne -
+        beq mps3_loop
+	jsr i2c_job_delay
+	dex
+	bne -
 
         jmp mps3_loop
+
+i2c_job_delay:
+	phx
+	ldx #$00	
+-	
+	dex
+	bne -
+
+	rts
 	
 megaphone_r1_i2c_setup: