Update main.c
This commit is contained in:
		
							parent
							
								
									5e1ba9d749
								
							
						
					
					
						commit
						f18727a49c
					
				
							
								
								
									
										80
									
								
								src/main.c
									
									
									
									
									
								
							
							
						
						
									
										80
									
								
								src/main.c
									
									
									
									
									
								
							| @ -3,59 +3,53 @@ | |||||||
| #define MOUSE_PORT ((volatile u8*)0xA10003) | #define MOUSE_PORT ((volatile u8*)0xA10003) | ||||||
| #define Z80_HALT  *((volatile u16*)0xA11100) | #define Z80_HALT  *((volatile u16*)0xA11100) | ||||||
| 
 | 
 | ||||||
| #define MOUSE_DELAY 32 | #define MOUSE_DELAY 16 | ||||||
| 
 | 
 | ||||||
| static inline void delay(void) { | static inline void delay(void) { | ||||||
|     __asm__ volatile ( | 	__asm__ volatile ( | ||||||
|         "move.w %0,%%d0\n\t" | 		"move.w %0,%%d0\n\t" | ||||||
|         "1: subq.w #1,%%d0\n\t" | 		"1: subq.w #1,%%d0\n\t" | ||||||
|         "bne.s 1b" | 		"bne.s 1b" | ||||||
|         : | 		: | ||||||
|         : "i"(MOUSE_DELAY) | 		: "i"(MOUSE_DELAY) | ||||||
|         : "d0" | 		: "d0" | ||||||
|     ); | 	); | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| int main() { | int main() { | ||||||
|     VDP_setTextPlane(0); | 	VDP_setTextPlane(0); | ||||||
|     VDP_drawText("Sega Mega Mouse RAW reader", 7, 27); | 	VDP_drawText("Sega Mega Mouse RAW reader", 7, 27); | ||||||
| 	VDP_drawText("RAW nibbles:", 14,0); | 	VDP_drawText("RAW nibbles:", 14,0); | ||||||
|     u8 nibbles[16] = {0}; | 	u8 nibbles[16] = {0}; | ||||||
|     s16 x = 0; | 	s16 x = 0; | ||||||
|     s16 y = 0; | 	s16 y = 0; | ||||||
| 
 | 
 | ||||||
|     char buf[40]; //буфер строки для вывода на экран
 | 	char buf[40]; //буфер строки для вывода на экран
 | ||||||
| 
 | 
 | ||||||
|     while(TRUE) { | 	while(TRUE) {		 | ||||||
| 
 | 		//опрос мыши
 | ||||||
|         SYS_doVBlankProcess(); | 		Z80_HALT = 0x0100; | ||||||
| 
 | 		*MOUSE_PORT = 0x60; delay(); | ||||||
| 		VDP_clearTextArea(0, 1, 40, 13); |  | ||||||
| 
 |  | ||||||
| 		 |  | ||||||
|         //опрос мыши
 |  | ||||||
|         Z80_HALT = 0x0100; |  | ||||||
|         *MOUSE_PORT = 0x60; delay(); |  | ||||||
| 
 | 
 | ||||||
| 		nibbles[0] = *MOUSE_PORT & 0x0F; | 		nibbles[0] = *MOUSE_PORT & 0x0F; | ||||||
| 
 | 
 | ||||||
| 
 | 
 | ||||||
|         for(int i=1;i<10;i++) { | 		for(int i=1;i<10;i++) { | ||||||
|             *MOUSE_PORT = (i&1)?0x20:0x00; | 			*MOUSE_PORT = (i&1)?0x20:0x00; | ||||||
|             delay(); | 			delay(); | ||||||
|             nibbles[i] = *MOUSE_PORT & 0x0F; | 			nibbles[i] = *MOUSE_PORT & 0x0F; | ||||||
|             delay(); | 			delay(); | ||||||
|         } | 		} | ||||||
| 
 | 
 | ||||||
|         *MOUSE_PORT = 0x60; delay(); | 		*MOUSE_PORT = 0x60; delay(); | ||||||
|         Z80_HALT = 0x0000; | 		Z80_HALT = 0x0000; | ||||||
| 		//конец опроса мыши
 | 		//конец опроса мыши
 | ||||||
| 
 | 
 | ||||||
|         // выводим нибблы на экран
 | 		//выводим нибблы на экран
 | ||||||
| 		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]); | 		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); | 		VDP_drawText(buf, 13,1); | ||||||
| 
 | 
 | ||||||
|         //считаем dx dy 
 | 		//считаем dx dy 
 | ||||||
| 		s16 dx = (nibbles[6] << 4) | nibbles[7]; | 		s16 dx = (nibbles[6] << 4) | nibbles[7]; | ||||||
| 		s16 dy = (nibbles[8] << 4) | nibbles[9]; | 		s16 dy = (nibbles[8] << 4) | nibbles[9]; | ||||||
| 		if (nibbles[4]&8) dy = 255; | 		if (nibbles[4]&8) dy = 255; | ||||||
| @ -65,13 +59,19 @@ int main() { | |||||||
| 		x+=dx; | 		x+=dx; | ||||||
| 		y+=dy; | 		y+=dy; | ||||||
| 
 | 
 | ||||||
|  | 		//ограничиваем x и y
 | ||||||
|  | 		x = (x > 9999) ? -9999 : (x < -9999 ? 9999 : x); | ||||||
|  | 		y = (y > 9999) ? -9999 : (y < -9999 ? 9999 : y); | ||||||
|  | 
 | ||||||
| 		//выводим на экран полезные данные
 | 		//выводим на экран полезные данные
 | ||||||
| 		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'); | 		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,y); |  | ||||||
| 		VDP_drawText(buf, 2, 12); | 		VDP_drawText(buf, 2, 12); | ||||||
| 		 | 		sprintf(buf, "dx: %+04d dy: %+04d x: %+05d y: %+05d", dx,dy,x,y); | ||||||
|     } | 		VDP_drawText(buf, 2, 13); | ||||||
| 
 | 
 | ||||||
|     return 0; | 		//конец кадра
 | ||||||
|  | 		VDP_waitVSync(); | ||||||
|  | 	} | ||||||
|  | 
 | ||||||
|  | 	return 0; | ||||||
| } | } | ||||||
|  | |||||||
		Loading…
	
	
			
			x
			
			
		
	
		Reference in New Issue
	
	Block a user