added mouse protocol (Igor Kovalenko)
git-svn-id: svn://svn.savannah.nongnu.org/qemu/trunk@2150 c046a42c-6fe2-441c-8c8c-71466251a162
This commit is contained in:
parent
21206a104f
commit
715748fa08
@ -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
|
#ifdef DEBUG_SERIAL
|
||||||
#define SER_DPRINTF(fmt, args...) \
|
#define SER_DPRINTF(fmt, args...) \
|
||||||
do { printf("SER: " fmt , ##args); } while (0)
|
do { printf("SER: " fmt , ##args); } while (0)
|
||||||
@ -58,7 +65,7 @@ do { printf("KBD: " fmt , ##args); } while (0)
|
|||||||
#endif
|
#endif
|
||||||
#ifdef DEBUG_MOUSE
|
#ifdef DEBUG_MOUSE
|
||||||
#define MS_DPRINTF(fmt, args...) \
|
#define MS_DPRINTF(fmt, args...) \
|
||||||
do { printf("SER: " fmt , ##args); } while (0)
|
do { printf("MSC: " fmt , ##args); } while (0)
|
||||||
#else
|
#else
|
||||||
#define MS_DPRINTF(fmt, args...)
|
#define MS_DPRINTF(fmt, args...)
|
||||||
#endif
|
#endif
|
||||||
@ -71,12 +78,12 @@ typedef enum {
|
|||||||
ser, kbd, mouse,
|
ser, kbd, mouse,
|
||||||
} chn_type_t;
|
} chn_type_t;
|
||||||
|
|
||||||
#define KBD_QUEUE_SIZE 256
|
#define SERIO_QUEUE_SIZE 256
|
||||||
|
|
||||||
typedef struct {
|
typedef struct {
|
||||||
uint8_t data[KBD_QUEUE_SIZE];
|
uint8_t data[SERIO_QUEUE_SIZE];
|
||||||
int rptr, wptr, count;
|
int rptr, wptr, count;
|
||||||
} KBDQueue;
|
} SERIOQueue;
|
||||||
|
|
||||||
typedef struct ChannelState {
|
typedef struct ChannelState {
|
||||||
int irq;
|
int irq;
|
||||||
@ -86,7 +93,7 @@ typedef struct ChannelState {
|
|||||||
chn_type_t type;
|
chn_type_t type;
|
||||||
struct ChannelState *otherchn;
|
struct ChannelState *otherchn;
|
||||||
uint8_t rx, tx, wregs[16], rregs[16];
|
uint8_t rx, tx, wregs[16], rregs[16];
|
||||||
KBDQueue queue;
|
SERIOQueue queue;
|
||||||
CharDriverState *chr;
|
CharDriverState *chr;
|
||||||
} ChannelState;
|
} ChannelState;
|
||||||
|
|
||||||
@ -103,13 +110,13 @@ static void serial_receive_byte(ChannelState *s, int ch);
|
|||||||
static void put_queue(void *opaque, int b)
|
static void put_queue(void *opaque, int b)
|
||||||
{
|
{
|
||||||
ChannelState *s = opaque;
|
ChannelState *s = opaque;
|
||||||
KBDQueue *q = &s->queue;
|
SERIOQueue *q = &s->queue;
|
||||||
|
|
||||||
KBD_DPRINTF("put: 0x%02x\n", b);
|
SER_DPRINTF("put: 0x%02x\n", b);
|
||||||
if (q->count >= KBD_QUEUE_SIZE)
|
if (q->count >= SERIO_QUEUE_SIZE)
|
||||||
return;
|
return;
|
||||||
q->data[q->wptr] = b;
|
q->data[q->wptr] = b;
|
||||||
if (++q->wptr == KBD_QUEUE_SIZE)
|
if (++q->wptr == SERIO_QUEUE_SIZE)
|
||||||
q->wptr = 0;
|
q->wptr = 0;
|
||||||
q->count++;
|
q->count++;
|
||||||
serial_receive_byte(s, 0);
|
serial_receive_byte(s, 0);
|
||||||
@ -118,14 +125,14 @@ static void put_queue(void *opaque, int b)
|
|||||||
static uint32_t get_queue(void *opaque)
|
static uint32_t get_queue(void *opaque)
|
||||||
{
|
{
|
||||||
ChannelState *s = opaque;
|
ChannelState *s = opaque;
|
||||||
KBDQueue *q = &s->queue;
|
SERIOQueue *q = &s->queue;
|
||||||
int val;
|
int val;
|
||||||
|
|
||||||
if (q->count == 0) {
|
if (q->count == 0) {
|
||||||
return 0;
|
return 0;
|
||||||
} else {
|
} else {
|
||||||
val = q->data[q->rptr];
|
val = q->data[q->rptr];
|
||||||
if (++q->rptr == KBD_QUEUE_SIZE)
|
if (++q->rptr == SERIO_QUEUE_SIZE)
|
||||||
q->rptr = 0;
|
q->rptr = 0;
|
||||||
q->count--;
|
q->count--;
|
||||||
}
|
}
|
||||||
@ -326,7 +333,7 @@ static uint32_t slavio_serial_mem_readb(void *opaque, target_phys_addr_t addr)
|
|||||||
case 1:
|
case 1:
|
||||||
s->rregs[0] &= ~1;
|
s->rregs[0] &= ~1;
|
||||||
clr_rxint(s);
|
clr_rxint(s);
|
||||||
if (s->type == kbd)
|
if (s->type == kbd || s->type == mouse)
|
||||||
ret = get_queue(s);
|
ret = get_queue(s);
|
||||||
else
|
else
|
||||||
ret = s->rx;
|
ret = s->rx;
|
||||||
@ -512,9 +519,41 @@ static void sunmouse_event(void *opaque,
|
|||||||
ChannelState *s = opaque;
|
ChannelState *s = opaque;
|
||||||
int ch;
|
int ch;
|
||||||
|
|
||||||
// XXX
|
MS_DPRINTF("dx=%d dy=%d buttons=%01x\n", dx, dy, buttons_state);
|
||||||
ch = 0x42;
|
|
||||||
serial_receive_byte(s, ch);
|
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)
|
void slavio_serial_ms_kbd_init(int base, int irq)
|
||||||
|
Loading…
x
Reference in New Issue
Block a user