Fixed the strange return code in the read/write hooks (it's now B_NOT_ALLOWED instead of EROFS).
git-svn-id: file:///srv/svn/repos/haiku/haiku/trunk@12262 a95241bf-73f2-0310-859d-f6bbb57e9c96
This commit is contained in:
Axel Dörfler
parent
2a912be1d8
commit
a6548f7b39
@ -1,6 +1,6 @@
|
||||
/*
|
||||
* Copyright 2004 Haiku, Inc.
|
||||
* Distributed under the terms of the Haiku License.
|
||||
* Copyright 2004-2005 Haiku, Inc.
|
||||
* Distributed under the terms of the MIT License.
|
||||
*
|
||||
* keyboard.c:
|
||||
* PS/2 keyboard device driver
|
||||
@ -183,7 +183,7 @@ keyboard_read(void *cookie, off_t pos, void *buffer, size_t *_length)
|
||||
{
|
||||
TRACE(("keyboard read()\n"));
|
||||
*_length = 0;
|
||||
return EROFS;
|
||||
return B_NOT_ALLOWED;
|
||||
}
|
||||
|
||||
|
||||
@ -192,7 +192,7 @@ keyboard_write(void *cookie, off_t pos, const void *buf, size_t *len)
|
||||
{
|
||||
TRACE(("keyboard write()\n"));
|
||||
*len = 0;
|
||||
return EROFS;
|
||||
return B_NOT_ALLOWED;
|
||||
}
|
||||
|
||||
|
||||
|
||||
@ -1,425 +1,425 @@
|
||||
/*
|
||||
* Copyright 2001-2005 Haiku, Inc.
|
||||
* Distributed under the terms of the Haiku License.
|
||||
*
|
||||
* ps2mouse.c:
|
||||
* PS/2 mouse device driver
|
||||
* Authors (in chronological order):
|
||||
* Elad Lahav (elad@eldarshany.com)
|
||||
* Stefano Ceccherini (burton666@libero.it)
|
||||
*/
|
||||
|
||||
/*
|
||||
* A PS/2 mouse is connected to the IBM 8042 controller, and gets its
|
||||
* name from the IBM PS/2 personal computer, which was the first to
|
||||
* use this device. All resources are shared between the keyboard, and
|
||||
* the mouse, referred to as the "Auxiliary Device".
|
||||
* I/O:
|
||||
* ~~~
|
||||
* The controller has 3 I/O registers:
|
||||
* 1. Status (input), mapped to port 64h
|
||||
* 2. Control (output), mapped to port 64h
|
||||
* 3. Data (input/output), mapped to port 60h
|
||||
* Data:
|
||||
* ~~~~
|
||||
* A packet read from the mouse data port is composed of
|
||||
* three bytes:
|
||||
* byte 0: status byte, where
|
||||
* - bit 0: Y overflow (1 = true)
|
||||
* - bit 1: X overflow (1 = true)
|
||||
* - bit 2: MSB of Y offset
|
||||
* - bit 3: MSB of X offset
|
||||
* - bit 4: Syncronization bit (always 1)
|
||||
* - bit 5: Middle button (1 = down)
|
||||
* - bit 6: Right button (1 = down)
|
||||
* - bit 7: Left button (1 = down)
|
||||
* byte 1: X position change, since last probed (-127 to +127)
|
||||
* byte 2: Y position change, since last probed (-127 to +127)
|
||||
*
|
||||
* Intellimouse mice send a four byte packet, where the first three
|
||||
* bytes are the same as standard mice, and the last one reports the
|
||||
* Z position, which is, usually, the wheel movement.
|
||||
*
|
||||
* Interrupts:
|
||||
* ~~~~~~~~~~
|
||||
* The PS/2 mouse device is connected to interrupt 12, which means that
|
||||
* it uses the second interrupt controller (handles INT8 to INT15). In
|
||||
* order for this interrupt to be enabled, both the 5th interrupt of
|
||||
* the second controller AND the 3rd interrupt of the first controller
|
||||
* (cascade mode) should be unmasked.
|
||||
* This is all done inside install_io_interrupt_handler(), no need to
|
||||
* worry about it anymore
|
||||
* The controller uses 3 consecutive interrupts to inform the computer
|
||||
* that it has new data. On the first the data register holds the status
|
||||
* byte, on the second the X offset, and on the 3rd the Y offset.
|
||||
*/
|
||||
|
||||
#include <Drivers.h>
|
||||
#include <Errors.h>
|
||||
|
||||
#include <string.h>
|
||||
|
||||
#include "kb_mouse_driver.h"
|
||||
|
||||
#include "common.h"
|
||||
|
||||
#ifdef COMPILE_FOR_R5
|
||||
#include "cbuf_adapter.h"
|
||||
#else
|
||||
#include <cbuf.h>
|
||||
#endif
|
||||
|
||||
static sem_id sMouseSem;
|
||||
static int32 sSync;
|
||||
static cbuf *sMouseChain;
|
||||
static int32 sOpenMask;
|
||||
|
||||
static bigtime_t sLastClickTime;
|
||||
static bigtime_t sClickSpeed;
|
||||
static int32 sClickCount;
|
||||
static int sButtonsState;
|
||||
|
||||
static int32 sPacketSize;
|
||||
|
||||
/////////////////////////////////////////////////////////////////////////
|
||||
// mouse functions
|
||||
|
||||
/*
|
||||
static status_t
|
||||
ps2_reset_mouse()
|
||||
{
|
||||
int8 read;
|
||||
|
||||
TRACE(("ps2_reset_mouse()\n"));
|
||||
|
||||
write_aux_byte(PS2_CMD_RESET_MOUSE);
|
||||
read = read_data_byte();
|
||||
|
||||
TRACE(("reset mouse: %2x\n", read));
|
||||
return B_OK;
|
||||
}
|
||||
*/
|
||||
|
||||
|
||||
/** Enables or disables mouse reporting for the ps2 port.
|
||||
*/
|
||||
|
||||
static status_t
|
||||
ps2_enable_mouse(bool enable)
|
||||
{
|
||||
int32 tries = 2;
|
||||
uint8 read;
|
||||
|
||||
do {
|
||||
write_aux_byte(enable ? PS2_CMD_ENABLE_MOUSE : PS2_CMD_DISABLE_MOUSE);
|
||||
read = read_data_byte();
|
||||
if (read == PS2_RES_ACK)
|
||||
break;
|
||||
spin(100);
|
||||
} while (read == PS2_RES_RESEND && tries-- > 0);
|
||||
|
||||
if (read != PS2_RES_ACK)
|
||||
return B_ERROR;
|
||||
|
||||
return B_OK;
|
||||
}
|
||||
|
||||
|
||||
/** Set sampling rate of the ps2 port.
|
||||
*/
|
||||
|
||||
static status_t
|
||||
ps2_set_sample_rate(uint32 rate)
|
||||
{
|
||||
status_t status = B_ERROR;
|
||||
|
||||
write_aux_byte(PS2_CMD_SET_SAMPLE_RATE);
|
||||
if (read_data_byte() == PS2_RES_ACK) {
|
||||
write_aux_byte(rate);
|
||||
if (read_data_byte() == PS2_RES_ACK)
|
||||
status = B_OK;
|
||||
}
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
|
||||
/** Converts a packet received by the mouse to a "movement".
|
||||
*/
|
||||
|
||||
static void
|
||||
ps2_packet_to_movement(uint8 packet[], mouse_movement *pos)
|
||||
{
|
||||
int buttons = packet[0] & 7;
|
||||
int xDelta = ((packet[0] & 0x10) ? 0xFFFFFF00 : 0) | packet[1];
|
||||
int yDelta = ((packet[0] & 0x20) ? 0xFFFFFF00 : 0) | packet[2];
|
||||
bigtime_t currentTime = system_time();
|
||||
int8 wheel_ydelta = 0;
|
||||
int8 wheel_xdelta = 0;
|
||||
|
||||
if (buttons != 0) {
|
||||
if (sButtonsState == 0) {
|
||||
if (sLastClickTime + sClickSpeed > currentTime)
|
||||
sClickCount++;
|
||||
else
|
||||
sClickCount = 1;
|
||||
}
|
||||
}
|
||||
|
||||
sLastClickTime = currentTime;
|
||||
sButtonsState = buttons;
|
||||
|
||||
if (sPacketSize == PS2_PACKET_INTELLIMOUSE) {
|
||||
switch (packet[3] & 0x0F) {
|
||||
case 0x01: wheel_ydelta = +1; break; // wheel 1 down
|
||||
case 0x0F: wheel_ydelta = -1; break; // wheel 1 up
|
||||
case 0x02: wheel_xdelta = +1; break; // wheel 2 down
|
||||
case 0x0E: wheel_xdelta = -1; break; // wheel 2 up
|
||||
}
|
||||
}
|
||||
|
||||
if (pos) {
|
||||
pos->xdelta = xDelta;
|
||||
pos->ydelta = yDelta;
|
||||
pos->buttons = buttons;
|
||||
pos->clicks = sClickCount;
|
||||
pos->modifiers = 0;
|
||||
pos->timestamp = currentTime;
|
||||
pos->wheel_ydelta = (int)wheel_ydelta;
|
||||
pos->wheel_xdelta = (int)wheel_xdelta;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/** Read a mouse event from the mouse events chain buffer.
|
||||
*/
|
||||
static status_t
|
||||
ps2_mouse_read(mouse_movement *pos)
|
||||
{
|
||||
status_t status;
|
||||
uint8 packet[PS2_MAX_PACKET_SIZE];
|
||||
|
||||
TRACE(("ps2_mouse_read()\n"));
|
||||
status = acquire_sem_etc(sMouseSem, 1, B_CAN_INTERRUPT, 0);
|
||||
if (status < B_OK)
|
||||
return status;
|
||||
|
||||
status = cbuf_memcpy_from_chain(packet, sMouseChain, 0, sPacketSize);
|
||||
if (status < B_OK) {
|
||||
TRACE(("error copying buffer\n"));
|
||||
return status;
|
||||
}
|
||||
|
||||
ps2_packet_to_movement(packet, pos);
|
||||
|
||||
return B_OK;
|
||||
}
|
||||
|
||||
|
||||
/////////////////////////////////////////////////////////////////////////
|
||||
// interrupt
|
||||
|
||||
|
||||
/** Interrupt handler for the mouse device. Called whenever the I/O
|
||||
* controller generates an interrupt for the PS/2 mouse. Reads mouse
|
||||
* information from the data port, and stores it, so it can be accessed
|
||||
* by read() operations. The full data is obtained using 3 consecutive
|
||||
* calls to the handler, each holds a different byte on the data port.
|
||||
*/
|
||||
static int32
|
||||
handle_mouse_interrupt(void* data)
|
||||
{
|
||||
int8 read;
|
||||
TRACE(("mouse interrupt occurred!!!\n"));
|
||||
|
||||
read = gIsa->read_io_8(PS2_PORT_CTRL);
|
||||
|
||||
if (read < 0) {
|
||||
TRACE(("Interrupt was not generated by the ps2 mouse\n"));
|
||||
return B_UNHANDLED_INTERRUPT;
|
||||
}
|
||||
|
||||
read = read_data_byte();
|
||||
cbuf_memcpy_to_chain(sMouseChain, 0, &read, sizeof(read));
|
||||
|
||||
if (sSync == 0 && !(read & 8)) {
|
||||
TRACE(("mouse resynched, bad data\n"));
|
||||
return B_HANDLED_INTERRUPT;
|
||||
}
|
||||
|
||||
if (++sSync == sPacketSize) {
|
||||
TRACE(("mouse synched\n"));
|
||||
sSync = 0;
|
||||
release_sem_etc(sMouseSem, 1, B_DO_NOT_RESCHEDULE);
|
||||
|
||||
return B_INVOKE_SCHEDULER;
|
||||
}
|
||||
|
||||
return B_HANDLED_INTERRUPT;
|
||||
}
|
||||
|
||||
|
||||
/////////////////////////////////////////////////////////////////////////
|
||||
// file operations
|
||||
|
||||
|
||||
status_t
|
||||
mouse_open(const char *name, uint32 flags, void **cookie)
|
||||
{
|
||||
status_t status;
|
||||
int8 commandByte;
|
||||
int8 deviceId = -1;
|
||||
|
||||
TRACE(("mouse_open()\n"));
|
||||
|
||||
if (atomic_or(&sOpenMask, 1) != 0)
|
||||
return B_BUSY;
|
||||
|
||||
// get device id
|
||||
write_aux_byte(PS2_CMD_GET_DEVICE_ID);
|
||||
if (read_data_byte() == PS2_RES_ACK)
|
||||
deviceId = read_data_byte();
|
||||
|
||||
TRACE(("init_driver: device id: %2x\n", deviceId));
|
||||
if (deviceId == 0) {
|
||||
// try to switch to intellimouse mode
|
||||
ps2_set_sample_rate(200);
|
||||
ps2_set_sample_rate(100);
|
||||
ps2_set_sample_rate(80);
|
||||
}
|
||||
|
||||
// get device id, again
|
||||
write_aux_byte(PS2_CMD_GET_DEVICE_ID);
|
||||
if (read_data_byte() == PS2_RES_ACK)
|
||||
deviceId = read_data_byte();
|
||||
|
||||
if (deviceId == PS2_DEV_ID_STANDARD) {
|
||||
sPacketSize = PS2_PACKET_STANDARD;
|
||||
TRACE(("Standard ps2 mouse found\n"));
|
||||
} else if (deviceId == PS2_DEV_ID_INTELLIMOUSE) {
|
||||
sPacketSize = PS2_PACKET_INTELLIMOUSE;
|
||||
TRACE(("Extended ps2 mouse found\n"));
|
||||
} else {
|
||||
TRACE(("No mouse found\n"));
|
||||
put_module(B_ISA_MODULE_NAME);
|
||||
return B_ERROR; // Something's wrong. Better quit
|
||||
}
|
||||
|
||||
sMouseChain = cbuf_get_chain(MOUSE_HISTORY_SIZE);
|
||||
if (sMouseChain == NULL) {
|
||||
TRACE(("can't allocate cbuf chain\n"));
|
||||
put_module(B_ISA_MODULE_NAME);
|
||||
return B_ERROR;
|
||||
}
|
||||
|
||||
// create the mouse semaphore, used for synchronization between
|
||||
// the interrupt handler and the read operation
|
||||
sMouseSem = create_sem(0, "ps2_mouse_sem");
|
||||
if (sMouseSem < 0) {
|
||||
TRACE(("failed creating PS/2 mouse semaphore!\n"));
|
||||
cbuf_free_chain(sMouseChain);
|
||||
put_module(B_ISA_MODULE_NAME);
|
||||
return sMouseSem;
|
||||
}
|
||||
|
||||
set_sem_owner(sMouseSem, B_SYSTEM_TEAM);
|
||||
|
||||
*cookie = NULL;
|
||||
|
||||
commandByte = get_command_byte();
|
||||
commandByte |= PS2_BITS_AUX_INTERRUPT;
|
||||
commandByte &= ~PS2_BITS_MOUSE_DISABLED;
|
||||
set_command_byte(commandByte);
|
||||
|
||||
status = ps2_enable_mouse(true);
|
||||
if (status < B_OK) {
|
||||
TRACE(("mouse_open(): cannot enable PS/2 mouse\n"));
|
||||
return B_ERROR;
|
||||
}
|
||||
|
||||
TRACE(("mouse_open(): mouse succesfully enabled\n"));
|
||||
|
||||
// register interrupt handler
|
||||
status = install_io_interrupt_handler(INT_PS2_MOUSE, handle_mouse_interrupt, NULL, 0);
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
|
||||
status_t
|
||||
mouse_close(void * cookie)
|
||||
{
|
||||
TRACE(("mouse_close()\n"));
|
||||
ps2_enable_mouse(false);
|
||||
|
||||
cbuf_free_chain(sMouseChain);
|
||||
delete_sem(sMouseSem);
|
||||
|
||||
remove_io_interrupt_handler(INT_PS2_MOUSE, handle_mouse_interrupt, NULL);
|
||||
|
||||
atomic_and(&sOpenMask, 0);
|
||||
|
||||
return B_OK;
|
||||
}
|
||||
|
||||
|
||||
status_t
|
||||
mouse_freecookie(void * cookie)
|
||||
{
|
||||
return B_OK;
|
||||
}
|
||||
|
||||
|
||||
status_t
|
||||
mouse_read(void *cookie, off_t pos, void *buf, size_t *len)
|
||||
{
|
||||
*len = 0;
|
||||
return EROFS;
|
||||
}
|
||||
|
||||
|
||||
status_t
|
||||
mouse_write(void * cookie, off_t pos, const void *buf, size_t *len)
|
||||
{
|
||||
*len = 0;
|
||||
return EROFS;
|
||||
}
|
||||
|
||||
|
||||
status_t
|
||||
mouse_ioctl(void *cookie, uint32 op, void *buf, size_t len)
|
||||
{
|
||||
mouse_movement *pos = (mouse_movement *)buf;
|
||||
switch (op) {
|
||||
case MS_NUM_EVENTS:
|
||||
{
|
||||
int32 count;
|
||||
TRACE(("MS_NUM_EVENTS\n"));
|
||||
get_sem_count(sMouseSem, &count);
|
||||
return count;
|
||||
}
|
||||
case MS_READ:
|
||||
TRACE(("MS_READ\n"));
|
||||
return ps2_mouse_read(pos);
|
||||
case MS_SET_TYPE:
|
||||
TRACE(("MS_SET_TYPE not implemented\n"));
|
||||
return EINVAL;
|
||||
case MS_SET_MAP:
|
||||
TRACE(("MS_SET_MAP (set mouse mapping) not implemented\n"));
|
||||
return EINVAL;
|
||||
case MS_GET_ACCEL:
|
||||
TRACE(("MS_GET_ACCEL (get mouse acceleration) not implemented\n"));
|
||||
return EINVAL;
|
||||
case MS_SET_ACCEL:
|
||||
TRACE(("MS_SET_ACCEL (set mouse acceleration) not implemented\n"));
|
||||
return EINVAL;
|
||||
case MS_SET_CLICKSPEED:
|
||||
TRACE(("MS_SETCLICK (set click speed)\n"));
|
||||
sClickSpeed = *(bigtime_t *)buf;
|
||||
return B_OK;
|
||||
default:
|
||||
TRACE(("unknown opcode: %ld\n", op));
|
||||
return EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* Copyright 2001-2005 Haiku, Inc.
|
||||
* Distributed under the terms of the MIT License.
|
||||
*
|
||||
* ps2mouse.c:
|
||||
* PS/2 mouse device driver
|
||||
* Authors (in chronological order):
|
||||
* Elad Lahav (elad@eldarshany.com)
|
||||
* Stefano Ceccherini (burton666@libero.it)
|
||||
*/
|
||||
|
||||
/*
|
||||
* A PS/2 mouse is connected to the IBM 8042 controller, and gets its
|
||||
* name from the IBM PS/2 personal computer, which was the first to
|
||||
* use this device. All resources are shared between the keyboard, and
|
||||
* the mouse, referred to as the "Auxiliary Device".
|
||||
* I/O:
|
||||
* ~~~
|
||||
* The controller has 3 I/O registers:
|
||||
* 1. Status (input), mapped to port 64h
|
||||
* 2. Control (output), mapped to port 64h
|
||||
* 3. Data (input/output), mapped to port 60h
|
||||
* Data:
|
||||
* ~~~~
|
||||
* A packet read from the mouse data port is composed of
|
||||
* three bytes:
|
||||
* byte 0: status byte, where
|
||||
* - bit 0: Y overflow (1 = true)
|
||||
* - bit 1: X overflow (1 = true)
|
||||
* - bit 2: MSB of Y offset
|
||||
* - bit 3: MSB of X offset
|
||||
* - bit 4: Syncronization bit (always 1)
|
||||
* - bit 5: Middle button (1 = down)
|
||||
* - bit 6: Right button (1 = down)
|
||||
* - bit 7: Left button (1 = down)
|
||||
* byte 1: X position change, since last probed (-127 to +127)
|
||||
* byte 2: Y position change, since last probed (-127 to +127)
|
||||
*
|
||||
* Intellimouse mice send a four byte packet, where the first three
|
||||
* bytes are the same as standard mice, and the last one reports the
|
||||
* Z position, which is, usually, the wheel movement.
|
||||
*
|
||||
* Interrupts:
|
||||
* ~~~~~~~~~~
|
||||
* The PS/2 mouse device is connected to interrupt 12, which means that
|
||||
* it uses the second interrupt controller (handles INT8 to INT15). In
|
||||
* order for this interrupt to be enabled, both the 5th interrupt of
|
||||
* the second controller AND the 3rd interrupt of the first controller
|
||||
* (cascade mode) should be unmasked.
|
||||
* This is all done inside install_io_interrupt_handler(), no need to
|
||||
* worry about it anymore
|
||||
* The controller uses 3 consecutive interrupts to inform the computer
|
||||
* that it has new data. On the first the data register holds the status
|
||||
* byte, on the second the X offset, and on the 3rd the Y offset.
|
||||
*/
|
||||
|
||||
#include <Drivers.h>
|
||||
#include <Errors.h>
|
||||
|
||||
#include <string.h>
|
||||
|
||||
#include "kb_mouse_driver.h"
|
||||
|
||||
#include "common.h"
|
||||
|
||||
#ifdef COMPILE_FOR_R5
|
||||
#include "cbuf_adapter.h"
|
||||
#else
|
||||
#include <cbuf.h>
|
||||
#endif
|
||||
|
||||
static sem_id sMouseSem;
|
||||
static int32 sSync;
|
||||
static cbuf *sMouseChain;
|
||||
static int32 sOpenMask;
|
||||
|
||||
static bigtime_t sLastClickTime;
|
||||
static bigtime_t sClickSpeed;
|
||||
static int32 sClickCount;
|
||||
static int sButtonsState;
|
||||
|
||||
static int32 sPacketSize;
|
||||
|
||||
/////////////////////////////////////////////////////////////////////////
|
||||
// mouse functions
|
||||
|
||||
/*
|
||||
static status_t
|
||||
ps2_reset_mouse()
|
||||
{
|
||||
int8 read;
|
||||
|
||||
TRACE(("ps2_reset_mouse()\n"));
|
||||
|
||||
write_aux_byte(PS2_CMD_RESET_MOUSE);
|
||||
read = read_data_byte();
|
||||
|
||||
TRACE(("reset mouse: %2x\n", read));
|
||||
return B_OK;
|
||||
}
|
||||
*/
|
||||
|
||||
|
||||
/** Enables or disables mouse reporting for the ps2 port.
|
||||
*/
|
||||
|
||||
static status_t
|
||||
ps2_enable_mouse(bool enable)
|
||||
{
|
||||
int32 tries = 2;
|
||||
uint8 read;
|
||||
|
||||
do {
|
||||
write_aux_byte(enable ? PS2_CMD_ENABLE_MOUSE : PS2_CMD_DISABLE_MOUSE);
|
||||
read = read_data_byte();
|
||||
if (read == PS2_RES_ACK)
|
||||
break;
|
||||
spin(100);
|
||||
} while (read == PS2_RES_RESEND && tries-- > 0);
|
||||
|
||||
if (read != PS2_RES_ACK)
|
||||
return B_ERROR;
|
||||
|
||||
return B_OK;
|
||||
}
|
||||
|
||||
|
||||
/** Set sampling rate of the ps2 port.
|
||||
*/
|
||||
|
||||
static status_t
|
||||
ps2_set_sample_rate(uint32 rate)
|
||||
{
|
||||
status_t status = B_ERROR;
|
||||
|
||||
write_aux_byte(PS2_CMD_SET_SAMPLE_RATE);
|
||||
if (read_data_byte() == PS2_RES_ACK) {
|
||||
write_aux_byte(rate);
|
||||
if (read_data_byte() == PS2_RES_ACK)
|
||||
status = B_OK;
|
||||
}
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
|
||||
/** Converts a packet received by the mouse to a "movement".
|
||||
*/
|
||||
|
||||
static void
|
||||
ps2_packet_to_movement(uint8 packet[], mouse_movement *pos)
|
||||
{
|
||||
int buttons = packet[0] & 7;
|
||||
int xDelta = ((packet[0] & 0x10) ? 0xFFFFFF00 : 0) | packet[1];
|
||||
int yDelta = ((packet[0] & 0x20) ? 0xFFFFFF00 : 0) | packet[2];
|
||||
bigtime_t currentTime = system_time();
|
||||
int8 wheel_ydelta = 0;
|
||||
int8 wheel_xdelta = 0;
|
||||
|
||||
if (buttons != 0) {
|
||||
if (sButtonsState == 0) {
|
||||
if (sLastClickTime + sClickSpeed > currentTime)
|
||||
sClickCount++;
|
||||
else
|
||||
sClickCount = 1;
|
||||
}
|
||||
}
|
||||
|
||||
sLastClickTime = currentTime;
|
||||
sButtonsState = buttons;
|
||||
|
||||
if (sPacketSize == PS2_PACKET_INTELLIMOUSE) {
|
||||
switch (packet[3] & 0x0F) {
|
||||
case 0x01: wheel_ydelta = +1; break; // wheel 1 down
|
||||
case 0x0F: wheel_ydelta = -1; break; // wheel 1 up
|
||||
case 0x02: wheel_xdelta = +1; break; // wheel 2 down
|
||||
case 0x0E: wheel_xdelta = -1; break; // wheel 2 up
|
||||
}
|
||||
}
|
||||
|
||||
if (pos) {
|
||||
pos->xdelta = xDelta;
|
||||
pos->ydelta = yDelta;
|
||||
pos->buttons = buttons;
|
||||
pos->clicks = sClickCount;
|
||||
pos->modifiers = 0;
|
||||
pos->timestamp = currentTime;
|
||||
pos->wheel_ydelta = (int)wheel_ydelta;
|
||||
pos->wheel_xdelta = (int)wheel_xdelta;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/** Read a mouse event from the mouse events chain buffer.
|
||||
*/
|
||||
static status_t
|
||||
ps2_mouse_read(mouse_movement *pos)
|
||||
{
|
||||
status_t status;
|
||||
uint8 packet[PS2_MAX_PACKET_SIZE];
|
||||
|
||||
TRACE(("ps2_mouse_read()\n"));
|
||||
status = acquire_sem_etc(sMouseSem, 1, B_CAN_INTERRUPT, 0);
|
||||
if (status < B_OK)
|
||||
return status;
|
||||
|
||||
status = cbuf_memcpy_from_chain(packet, sMouseChain, 0, sPacketSize);
|
||||
if (status < B_OK) {
|
||||
TRACE(("error copying buffer\n"));
|
||||
return status;
|
||||
}
|
||||
|
||||
ps2_packet_to_movement(packet, pos);
|
||||
|
||||
return B_OK;
|
||||
}
|
||||
|
||||
|
||||
/////////////////////////////////////////////////////////////////////////
|
||||
// interrupt
|
||||
|
||||
|
||||
/** Interrupt handler for the mouse device. Called whenever the I/O
|
||||
* controller generates an interrupt for the PS/2 mouse. Reads mouse
|
||||
* information from the data port, and stores it, so it can be accessed
|
||||
* by read() operations. The full data is obtained using 3 consecutive
|
||||
* calls to the handler, each holds a different byte on the data port.
|
||||
*/
|
||||
static int32
|
||||
handle_mouse_interrupt(void* data)
|
||||
{
|
||||
int8 read;
|
||||
TRACE(("mouse interrupt occurred!!!\n"));
|
||||
|
||||
read = gIsa->read_io_8(PS2_PORT_CTRL);
|
||||
|
||||
if (read < 0) {
|
||||
TRACE(("Interrupt was not generated by the ps2 mouse\n"));
|
||||
return B_UNHANDLED_INTERRUPT;
|
||||
}
|
||||
|
||||
read = read_data_byte();
|
||||
cbuf_memcpy_to_chain(sMouseChain, 0, &read, sizeof(read));
|
||||
|
||||
if (sSync == 0 && !(read & 8)) {
|
||||
TRACE(("mouse resynched, bad data\n"));
|
||||
return B_HANDLED_INTERRUPT;
|
||||
}
|
||||
|
||||
if (++sSync == sPacketSize) {
|
||||
TRACE(("mouse synched\n"));
|
||||
sSync = 0;
|
||||
release_sem_etc(sMouseSem, 1, B_DO_NOT_RESCHEDULE);
|
||||
|
||||
return B_INVOKE_SCHEDULER;
|
||||
}
|
||||
|
||||
return B_HANDLED_INTERRUPT;
|
||||
}
|
||||
|
||||
|
||||
/////////////////////////////////////////////////////////////////////////
|
||||
// file operations
|
||||
|
||||
|
||||
status_t
|
||||
mouse_open(const char *name, uint32 flags, void **cookie)
|
||||
{
|
||||
status_t status;
|
||||
int8 commandByte;
|
||||
int8 deviceId = -1;
|
||||
|
||||
TRACE(("mouse_open()\n"));
|
||||
|
||||
if (atomic_or(&sOpenMask, 1) != 0)
|
||||
return B_BUSY;
|
||||
|
||||
// get device id
|
||||
write_aux_byte(PS2_CMD_GET_DEVICE_ID);
|
||||
if (read_data_byte() == PS2_RES_ACK)
|
||||
deviceId = read_data_byte();
|
||||
|
||||
TRACE(("init_driver: device id: %2x\n", deviceId));
|
||||
if (deviceId == 0) {
|
||||
// try to switch to intellimouse mode
|
||||
ps2_set_sample_rate(200);
|
||||
ps2_set_sample_rate(100);
|
||||
ps2_set_sample_rate(80);
|
||||
}
|
||||
|
||||
// get device id, again
|
||||
write_aux_byte(PS2_CMD_GET_DEVICE_ID);
|
||||
if (read_data_byte() == PS2_RES_ACK)
|
||||
deviceId = read_data_byte();
|
||||
|
||||
if (deviceId == PS2_DEV_ID_STANDARD) {
|
||||
sPacketSize = PS2_PACKET_STANDARD;
|
||||
TRACE(("Standard ps2 mouse found\n"));
|
||||
} else if (deviceId == PS2_DEV_ID_INTELLIMOUSE) {
|
||||
sPacketSize = PS2_PACKET_INTELLIMOUSE;
|
||||
TRACE(("Extended ps2 mouse found\n"));
|
||||
} else {
|
||||
TRACE(("No mouse found\n"));
|
||||
put_module(B_ISA_MODULE_NAME);
|
||||
return B_ERROR; // Something's wrong. Better quit
|
||||
}
|
||||
|
||||
sMouseChain = cbuf_get_chain(MOUSE_HISTORY_SIZE);
|
||||
if (sMouseChain == NULL) {
|
||||
TRACE(("can't allocate cbuf chain\n"));
|
||||
put_module(B_ISA_MODULE_NAME);
|
||||
return B_ERROR;
|
||||
}
|
||||
|
||||
// create the mouse semaphore, used for synchronization between
|
||||
// the interrupt handler and the read operation
|
||||
sMouseSem = create_sem(0, "ps2_mouse_sem");
|
||||
if (sMouseSem < 0) {
|
||||
TRACE(("failed creating PS/2 mouse semaphore!\n"));
|
||||
cbuf_free_chain(sMouseChain);
|
||||
put_module(B_ISA_MODULE_NAME);
|
||||
return sMouseSem;
|
||||
}
|
||||
|
||||
set_sem_owner(sMouseSem, B_SYSTEM_TEAM);
|
||||
|
||||
*cookie = NULL;
|
||||
|
||||
commandByte = get_command_byte();
|
||||
commandByte |= PS2_BITS_AUX_INTERRUPT;
|
||||
commandByte &= ~PS2_BITS_MOUSE_DISABLED;
|
||||
set_command_byte(commandByte);
|
||||
|
||||
status = ps2_enable_mouse(true);
|
||||
if (status < B_OK) {
|
||||
TRACE(("mouse_open(): cannot enable PS/2 mouse\n"));
|
||||
return B_ERROR;
|
||||
}
|
||||
|
||||
TRACE(("mouse_open(): mouse succesfully enabled\n"));
|
||||
|
||||
// register interrupt handler
|
||||
status = install_io_interrupt_handler(INT_PS2_MOUSE, handle_mouse_interrupt, NULL, 0);
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
|
||||
status_t
|
||||
mouse_close(void * cookie)
|
||||
{
|
||||
TRACE(("mouse_close()\n"));
|
||||
ps2_enable_mouse(false);
|
||||
|
||||
cbuf_free_chain(sMouseChain);
|
||||
delete_sem(sMouseSem);
|
||||
|
||||
remove_io_interrupt_handler(INT_PS2_MOUSE, handle_mouse_interrupt, NULL);
|
||||
|
||||
atomic_and(&sOpenMask, 0);
|
||||
|
||||
return B_OK;
|
||||
}
|
||||
|
||||
|
||||
status_t
|
||||
mouse_freecookie(void * cookie)
|
||||
{
|
||||
return B_OK;
|
||||
}
|
||||
|
||||
|
||||
status_t
|
||||
mouse_read(void *cookie, off_t pos, void *buf, size_t *len)
|
||||
{
|
||||
*len = 0;
|
||||
return B_NOT_ALLOWED;
|
||||
}
|
||||
|
||||
|
||||
status_t
|
||||
mouse_write(void * cookie, off_t pos, const void *buf, size_t *len)
|
||||
{
|
||||
*len = 0;
|
||||
return B_NOT_ALLOWED;
|
||||
}
|
||||
|
||||
|
||||
status_t
|
||||
mouse_ioctl(void *cookie, uint32 op, void *buf, size_t len)
|
||||
{
|
||||
mouse_movement *pos = (mouse_movement *)buf;
|
||||
switch (op) {
|
||||
case MS_NUM_EVENTS:
|
||||
{
|
||||
int32 count;
|
||||
TRACE(("MS_NUM_EVENTS\n"));
|
||||
get_sem_count(sMouseSem, &count);
|
||||
return count;
|
||||
}
|
||||
case MS_READ:
|
||||
TRACE(("MS_READ\n"));
|
||||
return ps2_mouse_read(pos);
|
||||
case MS_SET_TYPE:
|
||||
TRACE(("MS_SET_TYPE not implemented\n"));
|
||||
return EINVAL;
|
||||
case MS_SET_MAP:
|
||||
TRACE(("MS_SET_MAP (set mouse mapping) not implemented\n"));
|
||||
return EINVAL;
|
||||
case MS_GET_ACCEL:
|
||||
TRACE(("MS_GET_ACCEL (get mouse acceleration) not implemented\n"));
|
||||
return EINVAL;
|
||||
case MS_SET_ACCEL:
|
||||
TRACE(("MS_SET_ACCEL (set mouse acceleration) not implemented\n"));
|
||||
return EINVAL;
|
||||
case MS_SET_CLICKSPEED:
|
||||
TRACE(("MS_SETCLICK (set click speed)\n"));
|
||||
sClickSpeed = *(bigtime_t *)buf;
|
||||
return B_OK;
|
||||
default:
|
||||
TRACE(("unknown opcode: %ld\n", op));
|
||||
return EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
Loading…
Reference in New Issue
Block a user