From 9b8db3343b88bf17ddcbb72b01faa245fed71bee Mon Sep 17 00:00:00 2001
From: DIvan2000 <divan2000@noreply.localhost>
Date: Mon, 22 Sep 2025 19:45:21 +0400
Subject: [PATCH] Update main.c

---
 src/main.c | 58 +++++++++++++++++++++++++++++++++---------------------
 1 file changed, 36 insertions(+), 22 deletions(-)

diff --git a/src/main.c b/src/main.c
index 5d9423d..625483b 100644
--- a/src/main.c
+++ b/src/main.c
@@ -3,36 +3,46 @@
 #define MOUSE_PORT ((volatile u8*)0xA10003)
 #define Z80_HALT  *((volatile u16*)0xA11100)
 
-#define MOUSE_DELAY 32
+#define MOUSE_DELAY 8
 
-static inline void delay() {
-    for(int i=0;i<MOUSE_DELAY;i++) asm volatile("nop");
+
+static inline void delay(void) {
+    __asm__ volatile (
+        "move.w %0,%%d0\n\t"
+        "1: subq.w #1,%%d0\n\t"
+        "bne.s 1b"
+        :
+        : "i"(MOUSE_DELAY)
+        : "d0"
+    );
 }
 
 
+
+
 int main() {
     VDP_setTextPlane(0);
-    VDP_drawText("Sega Mega Mouse RAW reader", 2, 16);
-
-    u8 nibbles[16];
+    VDP_drawText("Sega Mega Mouse RAW reader", 7, 27);
+	VDP_drawText("RAW nibbles:", 12,0);
+    u8 nibbles[16] = {0};
     int x = 0;
     int y = 0;
 
-    
+    char buf[40]; //буфер строки для вывода на экран
 
     while(TRUE) {
 
         SYS_doVBlankProcess();
-    	
-        VDP_clearTextArea(0, 0, 40, 13);
 
-        // считываем нибблы напрямую
+        //опрос мыши
         Z80_HALT = 0x0100;
         *MOUSE_PORT = 0x60; delay();
-        *MOUSE_PORT = 0x60; delay();
+
+		nibbles[0] = *MOUSE_PORT & 0x0F;
+
 
         for(int i=1;i<10;i++) {
-            *MOUSE_PORT = (i&1)?0x00:0x20;
+            *MOUSE_PORT = (i&1)?0x20:0x00;
             delay();
             nibbles[i] = *MOUSE_PORT & 0x0F;
             delay();
@@ -40,25 +50,29 @@ int main() {
 
         *MOUSE_PORT = 0x60; delay();
         Z80_HALT = 0x0000;
+		//конец опроса мыши
 
         // выводим нибблы на экран
-        char buf[64];
+        VDP_clearTextArea(0, 1, 40, 1);
+		sprintf(buf, "%X%X%X%X %X %X %X%X %X%X", nibbles[0],nibbles[1],nibbles[2],nibbles[3],nibbles[4],nibbles[5],nibbles[6],nibbles[7],nibbles[8],nibbles[9]);
+		VDP_drawText(buf, 13,1);
+
+        //считаем dx dy 
 		int dx = (nibbles[6] << 4) | nibbles[7];
 		int dy = (nibbles[8] << 4) | nibbles[9];
-
-		if (nibbles[3]&8) dy = 255;
-		if (nibbles[3]&4) dx = 255;
-		if (nibbles[3]&2) dy = -dy;
-		if (nibbles[3]&1) dx = -dx;
-
+		if (nibbles[4]&8) dy = 255;
+		if (nibbles[4]&4) dx = 255;
+		if (nibbles[4]&2) dy = -dy;
+		if (nibbles[4]&1) dx = -dx;
 		x+=dx;
 		y+=dy;
 
-		
+		//выводим на экран полезные данные
+        VDP_clearTextArea(0, 10, 40, 3);
+		sprintf(buf, "buttons: %c%c%c%c", (nibbles[5]&8&&1)+'0',(nibbles[5]&4&&1)+'0',(nibbles[5]&2&&1)+'0',(nibbles[5]&1&&1)+'0');
+		VDP_drawText(buf, 2, 10);
 		sprintf(buf, "dx: %+04d dy: %+04d x: %+04d y: %+04d", dx,dy,x/64,y/64);
 		VDP_drawText(buf, 2, 12);
-		sprintf(buf, "buttons: %c%c%c%c", (nibbles[4]&8&&1)+'0',(nibbles[4]&4&&1)+'0',(nibbles[4]&2&&1)+'0',(nibbles[4]&1&&1)+'0');
-		VDP_drawText(buf, 2, 10);
 		
     }