allow communication with non-active ps2 devices

git-svn-id: file:///srv/svn/repos/haiku/haiku/trunk@15974 a95241bf-73f2-0310-859d-f6bbb57e9c96
This commit is contained in:
Marcus Overhagen 2006-01-16 13:43:23 +00:00
parent f21b0edf83
commit 7593e461e3
3 changed files with 52 additions and 15 deletions

View File

@ -270,6 +270,8 @@ init_driver(void)
if (gDeviceOpenSemaphore < B_OK)
goto err_2;
status = ps2_dev_init();
status = ps2_service_init();
status = install_io_interrupt_handler(INT_PS2_KEYBOARD, &ps2_interrupt, NULL, 0);
@ -313,6 +315,7 @@ err_4:
remove_io_interrupt_handler(INT_PS2_KEYBOARD, &ps2_interrupt, NULL);
err_3:
ps2_service_exit();
ps2_dev_exit();
delete_sem(gDeviceOpenSemaphore);
delete_sem(sKbcSem);
err_2:
@ -328,6 +331,7 @@ uninit_driver(void)
remove_io_interrupt_handler(INT_PS2_MOUSE, &ps2_interrupt, NULL);
remove_io_interrupt_handler(INT_PS2_KEYBOARD, &ps2_interrupt, NULL);
ps2_service_exit();
ps2_dev_exit();
delete_sem(gDeviceOpenSemaphore);
delete_sem(sKbcSem);
put_module(B_ISA_MODULE_NAME);

View File

@ -12,16 +12,49 @@
#include "ps2_dev.h"
#include "ps2_service.h"
ps2_dev ps2_device[5] =
#define PS2_DEV_COUNT 5
ps2_dev ps2_device[PS2_DEV_COUNT] =
{
{ .name = "input/mouse/ps2/0", .active = false },
{ .name = "input/mouse/ps2/1", .active = false },
{ .name = "input/mouse/ps2/2", .active = false },
{ .name = "input/mouse/ps2/3", .active = false },
{ .name = "input/keyboard/at/0", .active = false, .flags = PS2_FLAG_KEYB }
{ .name = "input/mouse/ps2/0", .active = false, .result_sem = -1 },
{ .name = "input/mouse/ps2/1", .active = false, .result_sem = -1 },
{ .name = "input/mouse/ps2/2", .active = false, .result_sem = -1 },
{ .name = "input/mouse/ps2/3", .active = false, .result_sem = -1 },
{ .name = "input/keyboard/at/0", .active = false, .result_sem = -1, .flags = PS2_FLAG_KEYB }
};
status_t
ps2_dev_init(void)
{
int i;
for (i = 0; i < PS2_DEV_COUNT; i++) {
ps2_dev *dev = &ps2_device[i];
dev->result_sem = create_sem(0, "ps2 result");
if (dev->result_sem < 0)
goto err;
}
return B_OK;
err:
ps2_dev_exit();
return B_ERROR;
}
void
ps2_dev_exit(void)
{
int i;
for (i = 0; i < PS2_DEV_COUNT; i++) {
ps2_dev *dev = &ps2_device[i];
if (dev->result_sem >= 0) {
delete_sem(dev->result_sem);
dev->result_sem = -1;
}
}
}
void
ps2_dev_publish(ps2_dev *dev)
{
@ -32,12 +65,6 @@ ps2_dev_publish(ps2_dev *dev)
TRACE(("ps2_dev_publish %s\n", dev->name));
dev->result_sem = create_sem(0, "ps2 result");
dev->result_buf = NULL;
dev->result_buf_idx = 0;
dev->result_buf_cnt = 0;
dev->flags &= PS2_FLAG_KEYB;
dev->active = true;
status = devfs_publish_device(dev->name, NULL,
@ -56,8 +83,6 @@ ps2_dev_unpublish(ps2_dev *dev)
TRACE(("ps2_dev_unpublish %s\n", dev->name));
dev->active = false;
delete_sem(dev->result_sem);
}
@ -66,8 +91,8 @@ ps2_dev_handle_int(ps2_dev *dev, uint8 data)
{
if (!dev->active) {
ps2_service_handle_device_added(dev);
return B_HANDLED_INTERRUPT;
}
if (dev->result_buf_cnt) {
dev->result_buf[dev->result_buf_idx] = data;
dev->result_buf_idx++;
@ -78,6 +103,10 @@ ps2_dev_handle_int(ps2_dev *dev, uint8 data)
}
return B_HANDLED_INTERRUPT;
}
if (!dev->active) {
return B_HANDLED_INTERRUPT;
}
// temporary hack...
if (dev->flags & PS2_FLAG_KEYB)
@ -85,3 +114,4 @@ ps2_dev_handle_int(ps2_dev *dev, uint8 data)
else
return mouse_handle_int(data);
}

View File

@ -30,6 +30,9 @@ extern ps2_dev ps2_device[5];
#define PS2_FLAG_KEYB 1
status_t ps2_dev_init(void);
void ps2_dev_exit(void);
void ps2_dev_publish(ps2_dev *dev);
void ps2_dev_unpublish(ps2_dev *dev);