dev #2
78
src/main.c
78
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);
|
||||||
|
|
||||||
}
|
//конец кадра
|
||||||
|
VDP_waitVSync();
|
||||||
|
}
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|||||||
Loading…
x
Reference in New Issue
Block a user