From 4879631cd01d1a2e43d5673cd6b45e257bfdbfc7 Mon Sep 17 00:00:00 2001
From: Paul Gardner-Stephen <paul@m-e-g-a.org>
Date: Sun, 21 Apr 2024 16:24:33 +0200
Subject: [PATCH] add timeout to R3 I2C setup #800

---
 src/hyppo/targetsetup.asm | 17 +++++++++++++++--
 1 file changed, 15 insertions(+), 2 deletions(-)

diff --git a/src/hyppo/targetsetup.asm b/src/hyppo/targetsetup.asm
index 35b1f1419..aa2f52257 100644
--- 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: