This patch adds serial mouse support for sun4m slavio emulation.
Funky, I had made almost the same changes some time ago, but I didn't know
about the extra two bytes in the protocol. I merged your changes with mine,
result attached.
_________________________________________________________________
Express yourself instantly with MSN Messenger! Download today it's FREE!
http://messenger.msn.click-url.com/go/onm00200471ave/direct/01/
Index: qemu/hw/slavio_serial.c
===================================================================
--- qemu.orig/hw/slavio_serial.c 2006-08-10 17:39:10.000000000 +0000
+++ qemu/hw/slavio_serial.c 2006-08-10 17:56:10.000000000 +0000
@@ -42,6 +42,13 @@
*
*/
+/*
+ * Modifications:
+ * 2006-Aug-10 Igor Kovalenko : Renamed KBDQueue to SERIOQueue,
implemented
+ * serial mouse queue.
+ * Implemented serial mouse protocol.
+ */
+
#ifdef DEBUG_SERIAL
#define SER_DPRINTF(fmt, args...) \
do { printf("SER: " fmt , ##args); } while (0)
@@ -58,7 +65,7 @@
#endif
#ifdef DEBUG_MOUSE
#define MS_DPRINTF(fmt, args...) \
-do { printf("SER: " fmt , ##args); } while (0)
+do { printf("MSC: " fmt , ##args); } while (0)
#else
#define MS_DPRINTF(fmt, args...)
#endif
@@ -71,12 +78,12 @@
ser, kbd, mouse,
} chn_type_t;
-#define KBD_QUEUE_SIZE 256
+#define SERIO_QUEUE_SIZE 256
typedef struct {
- uint8_t data[KBD_QUEUE_SIZE];
+ uint8_t data[SERIO_QUEUE_SIZE];
int rptr, wptr, count;
-} KBDQueue;
+} SERIOQueue;
typedef struct ChannelState {
int irq;
@@ -86,7 +93,7 @@
chn_type_t type;
struct ChannelState *otherchn;
uint8_t rx, tx, wregs[16], rregs[16];
- KBDQueue queue;
+ SERIOQueue queue;
CharDriverState *chr;
} ChannelState;
@@ -103,13 +110,13 @@
static void put_queue(void *opaque, int b)
{
ChannelState *s = opaque;
- KBDQueue *q = &s->queue;
+ SERIOQueue *q = &s->queue;
- KBD_DPRINTF("put: 0x%02x\n", b);
- if (q->count >= KBD_QUEUE_SIZE)
+ SER_DPRINTF("put: 0x%02x\n", b);
+ if (q->count >= SERIO_QUEUE_SIZE)
return;
q->data[q->wptr] = b;
- if (++q->wptr == KBD_QUEUE_SIZE)
+ if (++q->wptr == SERIO_QUEUE_SIZE)
q->wptr = 0;
q->count++;
serial_receive_byte(s, 0);
@@ -118,14 +125,14 @@
static uint32_t get_queue(void *opaque)
{
ChannelState *s = opaque;
- KBDQueue *q = &s->queue;
+ SERIOQueue *q = &s->queue;
int val;
if (q->count == 0) {
return 0;
} else {
val = q->data[q->rptr];
- if (++q->rptr == KBD_QUEUE_SIZE)
+ if (++q->rptr == SERIO_QUEUE_SIZE)
q->rptr = 0;
q->count--;
}
@@ -135,17 +142,26 @@
return val;
}
-static void slavio_serial_update_irq(ChannelState *s)
+static int slavio_serial_update_irq_chn(ChannelState *s)
{
if ((s->wregs[1] & 1) && // interrupts enabled
(((s->wregs[1] & 2) && s->txint == 1) || // tx ints enabled, pending
((((s->wregs[1] & 0x18) == 8) || ((s->wregs[1] & 0x18) == 0x10)) &&
s->rxint == 1) || // rx ints enabled, pending
((s->wregs[15] & 0x80) && (s->rregs[0] & 0x80)))) { // break int e&p
- pic_set_irq(s->irq, 1);
- } else {
- pic_set_irq(s->irq, 0);
+ return 1;
}
+ return 0;
+}
+
+static void slavio_serial_update_irq(ChannelState *s)
+{
+ int irq;
+
+ irq = slavio_serial_update_irq_chn(s);
+ irq |= slavio_serial_update_irq_chn(s->otherchn);
+
+ pic_set_irq(s->irq, irq);
}
static void slavio_serial_reset_chn(ChannelState *s)
@@ -326,7 +342,7 @@
case 1:
s->rregs[0] &= ~1;
clr_rxint(s);
- if (s->type == kbd)
+ if (s->type == kbd || s->type == mouse)
ret = get_queue(s);
else
ret = s->rx;
@@ -512,9 +528,44 @@
ChannelState *s = opaque;
int ch;
- // XXX
- ch = 0x42;
- serial_receive_byte(s, ch);
+ /* XXX: SDL sometimes generates nul events: we delete them */
+ if (dx == 0 && dy == 0 && dz == 0 && buttons_state == 0)
+ return;
+ MS_DPRINTF("dx=%d dy=%d buttons=%01x\n", dx, dy, buttons_state);
+
+ ch = 0x80 | 0x7; /* protocol start byte, no buttons pressed */
+
+ if (buttons_state & MOUSE_EVENT_LBUTTON)
+ ch ^= 0x4;
+ if (buttons_state & MOUSE_EVENT_MBUTTON)
+ ch ^= 0x2;
+ if (buttons_state & MOUSE_EVENT_RBUTTON)
+ ch ^= 0x1;
+
+ put_queue(s, ch);
+
+ ch = dx;
+
+ if (ch > 127)
+ ch=127;
+ else if (ch < -127)
+ ch=-127;
+
+ put_queue(s, ch & 0xff);
+
+ ch = -dy;
+
+ if (ch > 127)
+ ch=127;
+ else if (ch < -127)
+ ch=-127;
+
+ put_queue(s, ch & 0xff);
+
+ // MSC protocol specify two extra motion bytes
+
+ put_queue(s, 0);
+ put_queue(s, 0);
}
void slavio_serial_ms_kbd_init(int base, int irq)
_______________________________________________
Qemu-devel mailing list
Qemu-devel@nongnu.org
http://lists.nongnu.org/mailman/listinfo/qemu-devel