Creation of Cybook 2416 (actually Gen4) repository
This commit is contained in:
92
drivers/input/misc/Kconfig
Normal file
92
drivers/input/misc/Kconfig
Normal file
@@ -0,0 +1,92 @@
|
||||
#
|
||||
# Input misc drivers configuration
|
||||
#
|
||||
menuconfig INPUT_MISC
|
||||
bool "Miscellaneous devices"
|
||||
help
|
||||
Say Y here, and a list of miscellaneous input drivers will be displayed.
|
||||
Everything that didn't fit into the other categories is here. This option
|
||||
doesn't affect the kernel.
|
||||
|
||||
If unsure, say Y.
|
||||
|
||||
if INPUT_MISC
|
||||
|
||||
config INPUT_PCSPKR
|
||||
tristate "PC Speaker support"
|
||||
depends on ALPHA || X86 || MIPS || PPC_PREP || PPC_CHRP || PPC_PSERIES
|
||||
help
|
||||
Say Y here if you want the standard PC Speaker to be used for
|
||||
bells and whistles.
|
||||
|
||||
If unsure, say Y.
|
||||
|
||||
To compile this driver as a module, choose M here: the
|
||||
module will be called pcspkr.
|
||||
|
||||
config INPUT_SPARCSPKR
|
||||
tristate "SPARC Speaker support"
|
||||
depends on PCI && SPARC64
|
||||
help
|
||||
Say Y here if you want the standard Speaker on Sparc PCI systems
|
||||
to be used for bells and whistles.
|
||||
|
||||
If unsure, say Y.
|
||||
|
||||
To compile this driver as a module, choose M here: the
|
||||
module will be called sparcspkr.
|
||||
|
||||
config INPUT_M68K_BEEP
|
||||
tristate "M68k Beeper support"
|
||||
depends on M68K
|
||||
|
||||
config INPUT_WISTRON_BTNS
|
||||
tristate "x86 Wistron laptop button interface"
|
||||
depends on X86 && !X86_64
|
||||
help
|
||||
Say Y here for support of Winstron laptop button interface, used on
|
||||
laptops of various brands, including Acer and Fujitsu-Siemens.
|
||||
|
||||
To compile this driver as a module, choose M here: the module will
|
||||
be called wistron_btns.
|
||||
|
||||
config INPUT_ATLAS_BTNS
|
||||
tristate "x86 Atlas button interface"
|
||||
depends on X86 && ACPI
|
||||
help
|
||||
Say Y here for support of Atlas wallmount touchscreen buttons.
|
||||
The events will show up as scancodes F1 through F9 via evdev.
|
||||
|
||||
To compile this driver as a module, choose M here: the module will
|
||||
be called atlas_btns.
|
||||
|
||||
config INPUT_IXP4XX_BEEPER
|
||||
tristate "IXP4XX Beeper support"
|
||||
depends on ARCH_IXP4XX
|
||||
help
|
||||
If you say yes here, you can connect a beeper to the
|
||||
ixp4xx gpio pins. This is used by the LinkSys NSLU2.
|
||||
|
||||
If unsure, say Y.
|
||||
|
||||
To compile this driver as a module, choose M here: the
|
||||
module will be called ixp4xx-beeper.
|
||||
|
||||
config INPUT_UINPUT
|
||||
tristate "User level driver support"
|
||||
help
|
||||
Say Y here if you want to support user level drivers for input
|
||||
subsystem accessible under char device 10:223 - /dev/input/uinput.
|
||||
|
||||
To compile this driver as a module, choose M here: the
|
||||
module will be called uinput.
|
||||
|
||||
config HP_SDC_RTC
|
||||
tristate "HP SDC Real Time Clock"
|
||||
depends on GSC || HP300
|
||||
select HP_SDC
|
||||
help
|
||||
Say Y here if you want to support the built-in real time clock
|
||||
of the HP SDC controller.
|
||||
|
||||
endif
|
||||
14
drivers/input/misc/Makefile
Normal file
14
drivers/input/misc/Makefile
Normal file
@@ -0,0 +1,14 @@
|
||||
#
|
||||
# Makefile for the input misc drivers.
|
||||
#
|
||||
|
||||
# Each configuration option enables a list of files.
|
||||
|
||||
obj-$(CONFIG_INPUT_SPARCSPKR) += sparcspkr.o
|
||||
obj-$(CONFIG_INPUT_PCSPKR) += pcspkr.o
|
||||
obj-$(CONFIG_INPUT_M68K_BEEP) += m68kspkr.o
|
||||
obj-$(CONFIG_INPUT_UINPUT) += uinput.o
|
||||
obj-$(CONFIG_INPUT_WISTRON_BTNS) += wistron_btns.o
|
||||
obj-$(CONFIG_INPUT_ATLAS_BTNS) += atlas_btns.o
|
||||
obj-$(CONFIG_HP_SDC_RTC) += hp_sdc_rtc.o
|
||||
obj-$(CONFIG_INPUT_IXP4XX_BEEPER) += ixp4xx-beeper.o
|
||||
170
drivers/input/misc/atlas_btns.c
Normal file
170
drivers/input/misc/atlas_btns.c
Normal file
@@ -0,0 +1,170 @@
|
||||
/*
|
||||
* atlas_btns.c - Atlas Wallmount Touchscreen ACPI Extras
|
||||
*
|
||||
* Copyright (C) 2006 Jaya Kumar
|
||||
* Based on Toshiba ACPI by John Belmonte and ASUS ACPI
|
||||
* This work was sponsored by CIS(M) Sdn Bhd.
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program; if not, write to the Free Software
|
||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
||||
*
|
||||
*/
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/input.h>
|
||||
#include <linux/types.h>
|
||||
#include <asm/uaccess.h>
|
||||
#include <acpi/acpi_drivers.h>
|
||||
|
||||
#define ACPI_ATLAS_NAME "Atlas ACPI"
|
||||
#define ACPI_ATLAS_CLASS "Atlas"
|
||||
#define ACPI_ATLAS_BUTTON_HID "ASIM0000"
|
||||
|
||||
static struct input_dev *input_dev;
|
||||
|
||||
/* button handling code */
|
||||
static acpi_status acpi_atlas_button_setup(acpi_handle region_handle,
|
||||
u32 function, void *handler_context, void **return_context)
|
||||
{
|
||||
*return_context =
|
||||
(function != ACPI_REGION_DEACTIVATE) ? handler_context : NULL;
|
||||
|
||||
return AE_OK;
|
||||
}
|
||||
|
||||
static acpi_status acpi_atlas_button_handler(u32 function,
|
||||
acpi_physical_address address,
|
||||
u32 bit_width, acpi_integer *value,
|
||||
void *handler_context, void *region_context)
|
||||
{
|
||||
acpi_status status;
|
||||
int keycode;
|
||||
|
||||
if (function == ACPI_WRITE) {
|
||||
keycode = KEY_F1 + (address & 0x0F);
|
||||
input_report_key(input_dev, keycode, !(address & 0x10));
|
||||
input_sync(input_dev);
|
||||
status = 0;
|
||||
} else {
|
||||
printk(KERN_WARNING "atlas: shrugged on unexpected function"
|
||||
":function=%x,address=%lx,value=%x\n",
|
||||
function, (unsigned long)address, (u32)*value);
|
||||
status = -EINVAL;
|
||||
}
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
static int atlas_acpi_button_add(struct acpi_device *device)
|
||||
{
|
||||
acpi_status status;
|
||||
int err;
|
||||
|
||||
input_dev = input_allocate_device();
|
||||
if (!input_dev) {
|
||||
printk(KERN_ERR "atlas: unable to allocate input device\n");
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
input_dev->name = "Atlas ACPI button driver";
|
||||
input_dev->phys = "ASIM0000/atlas/input0";
|
||||
input_dev->id.bustype = BUS_HOST;
|
||||
input_dev->evbit[LONG(EV_KEY)] = BIT(EV_KEY);
|
||||
|
||||
set_bit(KEY_F1, input_dev->keybit);
|
||||
set_bit(KEY_F2, input_dev->keybit);
|
||||
set_bit(KEY_F3, input_dev->keybit);
|
||||
set_bit(KEY_F4, input_dev->keybit);
|
||||
set_bit(KEY_F5, input_dev->keybit);
|
||||
set_bit(KEY_F6, input_dev->keybit);
|
||||
set_bit(KEY_F7, input_dev->keybit);
|
||||
set_bit(KEY_F8, input_dev->keybit);
|
||||
set_bit(KEY_F9, input_dev->keybit);
|
||||
|
||||
err = input_register_device(input_dev);
|
||||
if (err) {
|
||||
printk(KERN_ERR "atlas: couldn't register input device\n");
|
||||
input_free_device(input_dev);
|
||||
return err;
|
||||
}
|
||||
|
||||
/* hookup button handler */
|
||||
status = acpi_install_address_space_handler(device->handle,
|
||||
0x81, &acpi_atlas_button_handler,
|
||||
&acpi_atlas_button_setup, device);
|
||||
if (ACPI_FAILURE(status)) {
|
||||
printk(KERN_ERR "Atlas: Error installing addr spc handler\n");
|
||||
input_unregister_device(input_dev);
|
||||
status = -EINVAL;
|
||||
}
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
static int atlas_acpi_button_remove(struct acpi_device *device, int type)
|
||||
{
|
||||
acpi_status status;
|
||||
|
||||
status = acpi_remove_address_space_handler(device->handle,
|
||||
0x81, &acpi_atlas_button_handler);
|
||||
if (ACPI_FAILURE(status)) {
|
||||
printk(KERN_ERR "Atlas: Error removing addr spc handler\n");
|
||||
status = -EINVAL;
|
||||
}
|
||||
|
||||
input_unregister_device(input_dev);
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
static struct acpi_driver atlas_acpi_driver = {
|
||||
.name = ACPI_ATLAS_NAME,
|
||||
.class = ACPI_ATLAS_CLASS,
|
||||
.ids = ACPI_ATLAS_BUTTON_HID,
|
||||
.ops = {
|
||||
.add = atlas_acpi_button_add,
|
||||
.remove = atlas_acpi_button_remove,
|
||||
},
|
||||
};
|
||||
|
||||
static int __init atlas_acpi_init(void)
|
||||
{
|
||||
int result;
|
||||
|
||||
if (acpi_disabled)
|
||||
return -ENODEV;
|
||||
|
||||
result = acpi_bus_register_driver(&atlas_acpi_driver);
|
||||
if (result < 0) {
|
||||
printk(KERN_ERR "Atlas ACPI: Unable to register driver\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void __exit atlas_acpi_exit(void)
|
||||
{
|
||||
acpi_bus_unregister_driver(&atlas_acpi_driver);
|
||||
}
|
||||
|
||||
module_init(atlas_acpi_init);
|
||||
module_exit(atlas_acpi_exit);
|
||||
|
||||
MODULE_AUTHOR("Jaya Kumar");
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_DESCRIPTION("Atlas button driver");
|
||||
|
||||
719
drivers/input/misc/hp_sdc_rtc.c
Normal file
719
drivers/input/misc/hp_sdc_rtc.c
Normal file
@@ -0,0 +1,719 @@
|
||||
/*
|
||||
* HP i8042 SDC + MSM-58321 BBRTC driver.
|
||||
*
|
||||
* Copyright (c) 2001 Brian S. Julin
|
||||
* All rights reserved.
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted provided that the following conditions
|
||||
* are met:
|
||||
* 1. Redistributions of source code must retain the above copyright
|
||||
* notice, this list of conditions, and the following disclaimer,
|
||||
* without modification.
|
||||
* 2. The name of the author may not be used to endorse or promote products
|
||||
* derived from this software without specific prior written permission.
|
||||
*
|
||||
* Alternatively, this software may be distributed under the terms of the
|
||||
* GNU General Public License ("GPL").
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
|
||||
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
|
||||
* ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
||||
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
||||
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
||||
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
||||
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
||||
*
|
||||
* References:
|
||||
* System Device Controller Microprocessor Firmware Theory of Operation
|
||||
* for Part Number 1820-4784 Revision B. Dwg No. A-1820-4784-2
|
||||
* efirtc.c by Stephane Eranian/Hewlett Packard
|
||||
*
|
||||
*/
|
||||
|
||||
#include <linux/hp_sdc.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/types.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/time.h>
|
||||
#include <linux/miscdevice.h>
|
||||
#include <linux/proc_fs.h>
|
||||
#include <linux/poll.h>
|
||||
#include <linux/rtc.h>
|
||||
|
||||
MODULE_AUTHOR("Brian S. Julin <bri@calyx.com>");
|
||||
MODULE_DESCRIPTION("HP i8042 SDC + MSM-58321 RTC Driver");
|
||||
MODULE_LICENSE("Dual BSD/GPL");
|
||||
|
||||
#define RTC_VERSION "1.10d"
|
||||
|
||||
static unsigned long epoch = 2000;
|
||||
|
||||
static struct semaphore i8042tregs;
|
||||
|
||||
static hp_sdc_irqhook hp_sdc_rtc_isr;
|
||||
|
||||
static struct fasync_struct *hp_sdc_rtc_async_queue;
|
||||
|
||||
static DECLARE_WAIT_QUEUE_HEAD(hp_sdc_rtc_wait);
|
||||
|
||||
static ssize_t hp_sdc_rtc_read(struct file *file, char __user *buf,
|
||||
size_t count, loff_t *ppos);
|
||||
|
||||
static int hp_sdc_rtc_ioctl(struct inode *inode, struct file *file,
|
||||
unsigned int cmd, unsigned long arg);
|
||||
|
||||
static unsigned int hp_sdc_rtc_poll(struct file *file, poll_table *wait);
|
||||
|
||||
static int hp_sdc_rtc_open(struct inode *inode, struct file *file);
|
||||
static int hp_sdc_rtc_release(struct inode *inode, struct file *file);
|
||||
static int hp_sdc_rtc_fasync (int fd, struct file *filp, int on);
|
||||
|
||||
static int hp_sdc_rtc_read_proc(char *page, char **start, off_t off,
|
||||
int count, int *eof, void *data);
|
||||
|
||||
static void hp_sdc_rtc_isr (int irq, void *dev_id,
|
||||
uint8_t status, uint8_t data)
|
||||
{
|
||||
return;
|
||||
}
|
||||
|
||||
static int hp_sdc_rtc_do_read_bbrtc (struct rtc_time *rtctm)
|
||||
{
|
||||
struct semaphore tsem;
|
||||
hp_sdc_transaction t;
|
||||
uint8_t tseq[91];
|
||||
int i;
|
||||
|
||||
i = 0;
|
||||
while (i < 91) {
|
||||
tseq[i++] = HP_SDC_ACT_DATAREG |
|
||||
HP_SDC_ACT_POSTCMD | HP_SDC_ACT_DATAIN;
|
||||
tseq[i++] = 0x01; /* write i8042[0x70] */
|
||||
tseq[i] = i / 7; /* BBRTC reg address */
|
||||
i++;
|
||||
tseq[i++] = HP_SDC_CMD_DO_RTCR; /* Trigger command */
|
||||
tseq[i++] = 2; /* expect 1 stat/dat pair back. */
|
||||
i++; i++; /* buffer for stat/dat pair */
|
||||
}
|
||||
tseq[84] |= HP_SDC_ACT_SEMAPHORE;
|
||||
t.endidx = 91;
|
||||
t.seq = tseq;
|
||||
t.act.semaphore = &tsem;
|
||||
init_MUTEX_LOCKED(&tsem);
|
||||
|
||||
if (hp_sdc_enqueue_transaction(&t)) return -1;
|
||||
|
||||
down_interruptible(&tsem); /* Put ourselves to sleep for results. */
|
||||
|
||||
/* Check for nonpresence of BBRTC */
|
||||
if (!((tseq[83] | tseq[90] | tseq[69] | tseq[76] |
|
||||
tseq[55] | tseq[62] | tseq[34] | tseq[41] |
|
||||
tseq[20] | tseq[27] | tseq[6] | tseq[13]) & 0x0f))
|
||||
return -1;
|
||||
|
||||
memset(rtctm, 0, sizeof(struct rtc_time));
|
||||
rtctm->tm_year = (tseq[83] & 0x0f) + (tseq[90] & 0x0f) * 10;
|
||||
rtctm->tm_mon = (tseq[69] & 0x0f) + (tseq[76] & 0x0f) * 10;
|
||||
rtctm->tm_mday = (tseq[55] & 0x0f) + (tseq[62] & 0x0f) * 10;
|
||||
rtctm->tm_wday = (tseq[48] & 0x0f);
|
||||
rtctm->tm_hour = (tseq[34] & 0x0f) + (tseq[41] & 0x0f) * 10;
|
||||
rtctm->tm_min = (tseq[20] & 0x0f) + (tseq[27] & 0x0f) * 10;
|
||||
rtctm->tm_sec = (tseq[6] & 0x0f) + (tseq[13] & 0x0f) * 10;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int hp_sdc_rtc_read_bbrtc (struct rtc_time *rtctm)
|
||||
{
|
||||
struct rtc_time tm, tm_last;
|
||||
int i = 0;
|
||||
|
||||
/* MSM-58321 has no read latch, so must read twice and compare. */
|
||||
|
||||
if (hp_sdc_rtc_do_read_bbrtc(&tm_last)) return -1;
|
||||
if (hp_sdc_rtc_do_read_bbrtc(&tm)) return -1;
|
||||
|
||||
while (memcmp(&tm, &tm_last, sizeof(struct rtc_time))) {
|
||||
if (i++ > 4) return -1;
|
||||
memcpy(&tm_last, &tm, sizeof(struct rtc_time));
|
||||
if (hp_sdc_rtc_do_read_bbrtc(&tm)) return -1;
|
||||
}
|
||||
|
||||
memcpy(rtctm, &tm, sizeof(struct rtc_time));
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
static int64_t hp_sdc_rtc_read_i8042timer (uint8_t loadcmd, int numreg)
|
||||
{
|
||||
hp_sdc_transaction t;
|
||||
uint8_t tseq[26] = {
|
||||
HP_SDC_ACT_PRECMD | HP_SDC_ACT_POSTCMD | HP_SDC_ACT_DATAIN,
|
||||
0,
|
||||
HP_SDC_CMD_READ_T1, 2, 0, 0,
|
||||
HP_SDC_ACT_POSTCMD | HP_SDC_ACT_DATAIN,
|
||||
HP_SDC_CMD_READ_T2, 2, 0, 0,
|
||||
HP_SDC_ACT_POSTCMD | HP_SDC_ACT_DATAIN,
|
||||
HP_SDC_CMD_READ_T3, 2, 0, 0,
|
||||
HP_SDC_ACT_POSTCMD | HP_SDC_ACT_DATAIN,
|
||||
HP_SDC_CMD_READ_T4, 2, 0, 0,
|
||||
HP_SDC_ACT_POSTCMD | HP_SDC_ACT_DATAIN,
|
||||
HP_SDC_CMD_READ_T5, 2, 0, 0
|
||||
};
|
||||
|
||||
t.endidx = numreg * 5;
|
||||
|
||||
tseq[1] = loadcmd;
|
||||
tseq[t.endidx - 4] |= HP_SDC_ACT_SEMAPHORE; /* numreg assumed > 1 */
|
||||
|
||||
t.seq = tseq;
|
||||
t.act.semaphore = &i8042tregs;
|
||||
|
||||
down_interruptible(&i8042tregs); /* Sleep if output regs in use. */
|
||||
|
||||
if (hp_sdc_enqueue_transaction(&t)) return -1;
|
||||
|
||||
down_interruptible(&i8042tregs); /* Sleep until results come back. */
|
||||
up(&i8042tregs);
|
||||
|
||||
return (tseq[5] |
|
||||
((uint64_t)(tseq[10]) << 8) | ((uint64_t)(tseq[15]) << 16) |
|
||||
((uint64_t)(tseq[20]) << 24) | ((uint64_t)(tseq[25]) << 32));
|
||||
}
|
||||
|
||||
|
||||
/* Read the i8042 real-time clock */
|
||||
static inline int hp_sdc_rtc_read_rt(struct timeval *res) {
|
||||
int64_t raw;
|
||||
uint32_t tenms;
|
||||
unsigned int days;
|
||||
|
||||
raw = hp_sdc_rtc_read_i8042timer(HP_SDC_CMD_LOAD_RT, 5);
|
||||
if (raw < 0) return -1;
|
||||
|
||||
tenms = (uint32_t)raw & 0xffffff;
|
||||
days = (unsigned int)(raw >> 24) & 0xffff;
|
||||
|
||||
res->tv_usec = (suseconds_t)(tenms % 100) * 10000;
|
||||
res->tv_sec = (time_t)(tenms / 100) + days * 86400;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
/* Read the i8042 fast handshake timer */
|
||||
static inline int hp_sdc_rtc_read_fhs(struct timeval *res) {
|
||||
uint64_t raw;
|
||||
unsigned int tenms;
|
||||
|
||||
raw = hp_sdc_rtc_read_i8042timer(HP_SDC_CMD_LOAD_FHS, 2);
|
||||
if (raw < 0) return -1;
|
||||
|
||||
tenms = (unsigned int)raw & 0xffff;
|
||||
|
||||
res->tv_usec = (suseconds_t)(tenms % 100) * 10000;
|
||||
res->tv_sec = (time_t)(tenms / 100);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
/* Read the i8042 match timer (a.k.a. alarm) */
|
||||
static inline int hp_sdc_rtc_read_mt(struct timeval *res) {
|
||||
int64_t raw;
|
||||
uint32_t tenms;
|
||||
|
||||
raw = hp_sdc_rtc_read_i8042timer(HP_SDC_CMD_LOAD_MT, 3);
|
||||
if (raw < 0) return -1;
|
||||
|
||||
tenms = (uint32_t)raw & 0xffffff;
|
||||
|
||||
res->tv_usec = (suseconds_t)(tenms % 100) * 10000;
|
||||
res->tv_sec = (time_t)(tenms / 100);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
/* Read the i8042 delay timer */
|
||||
static inline int hp_sdc_rtc_read_dt(struct timeval *res) {
|
||||
int64_t raw;
|
||||
uint32_t tenms;
|
||||
|
||||
raw = hp_sdc_rtc_read_i8042timer(HP_SDC_CMD_LOAD_DT, 3);
|
||||
if (raw < 0) return -1;
|
||||
|
||||
tenms = (uint32_t)raw & 0xffffff;
|
||||
|
||||
res->tv_usec = (suseconds_t)(tenms % 100) * 10000;
|
||||
res->tv_sec = (time_t)(tenms / 100);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
/* Read the i8042 cycle timer (a.k.a. periodic) */
|
||||
static inline int hp_sdc_rtc_read_ct(struct timeval *res) {
|
||||
int64_t raw;
|
||||
uint32_t tenms;
|
||||
|
||||
raw = hp_sdc_rtc_read_i8042timer(HP_SDC_CMD_LOAD_CT, 3);
|
||||
if (raw < 0) return -1;
|
||||
|
||||
tenms = (uint32_t)raw & 0xffffff;
|
||||
|
||||
res->tv_usec = (suseconds_t)(tenms % 100) * 10000;
|
||||
res->tv_sec = (time_t)(tenms / 100);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
/* Set the i8042 real-time clock */
|
||||
static int hp_sdc_rtc_set_rt (struct timeval *setto)
|
||||
{
|
||||
uint32_t tenms;
|
||||
unsigned int days;
|
||||
hp_sdc_transaction t;
|
||||
uint8_t tseq[11] = {
|
||||
HP_SDC_ACT_PRECMD | HP_SDC_ACT_DATAOUT,
|
||||
HP_SDC_CMD_SET_RTMS, 3, 0, 0, 0,
|
||||
HP_SDC_ACT_PRECMD | HP_SDC_ACT_DATAOUT,
|
||||
HP_SDC_CMD_SET_RTD, 2, 0, 0
|
||||
};
|
||||
|
||||
t.endidx = 10;
|
||||
|
||||
if (0xffff < setto->tv_sec / 86400) return -1;
|
||||
days = setto->tv_sec / 86400;
|
||||
if (0xffff < setto->tv_usec / 1000000 / 86400) return -1;
|
||||
days += ((setto->tv_sec % 86400) + setto->tv_usec / 1000000) / 86400;
|
||||
if (days > 0xffff) return -1;
|
||||
|
||||
if (0xffffff < setto->tv_sec) return -1;
|
||||
tenms = setto->tv_sec * 100;
|
||||
if (0xffffff < setto->tv_usec / 10000) return -1;
|
||||
tenms += setto->tv_usec / 10000;
|
||||
if (tenms > 0xffffff) return -1;
|
||||
|
||||
tseq[3] = (uint8_t)(tenms & 0xff);
|
||||
tseq[4] = (uint8_t)((tenms >> 8) & 0xff);
|
||||
tseq[5] = (uint8_t)((tenms >> 16) & 0xff);
|
||||
|
||||
tseq[9] = (uint8_t)(days & 0xff);
|
||||
tseq[10] = (uint8_t)((days >> 8) & 0xff);
|
||||
|
||||
t.seq = tseq;
|
||||
|
||||
if (hp_sdc_enqueue_transaction(&t)) return -1;
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* Set the i8042 fast handshake timer */
|
||||
static int hp_sdc_rtc_set_fhs (struct timeval *setto)
|
||||
{
|
||||
uint32_t tenms;
|
||||
hp_sdc_transaction t;
|
||||
uint8_t tseq[5] = {
|
||||
HP_SDC_ACT_PRECMD | HP_SDC_ACT_DATAOUT,
|
||||
HP_SDC_CMD_SET_FHS, 2, 0, 0
|
||||
};
|
||||
|
||||
t.endidx = 4;
|
||||
|
||||
if (0xffff < setto->tv_sec) return -1;
|
||||
tenms = setto->tv_sec * 100;
|
||||
if (0xffff < setto->tv_usec / 10000) return -1;
|
||||
tenms += setto->tv_usec / 10000;
|
||||
if (tenms > 0xffff) return -1;
|
||||
|
||||
tseq[3] = (uint8_t)(tenms & 0xff);
|
||||
tseq[4] = (uint8_t)((tenms >> 8) & 0xff);
|
||||
|
||||
t.seq = tseq;
|
||||
|
||||
if (hp_sdc_enqueue_transaction(&t)) return -1;
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
/* Set the i8042 match timer (a.k.a. alarm) */
|
||||
#define hp_sdc_rtc_set_mt (setto) \
|
||||
hp_sdc_rtc_set_i8042timer(setto, HP_SDC_CMD_SET_MT)
|
||||
|
||||
/* Set the i8042 delay timer */
|
||||
#define hp_sdc_rtc_set_dt (setto) \
|
||||
hp_sdc_rtc_set_i8042timer(setto, HP_SDC_CMD_SET_DT)
|
||||
|
||||
/* Set the i8042 cycle timer (a.k.a. periodic) */
|
||||
#define hp_sdc_rtc_set_ct (setto) \
|
||||
hp_sdc_rtc_set_i8042timer(setto, HP_SDC_CMD_SET_CT)
|
||||
|
||||
/* Set one of the i8042 3-byte wide timers */
|
||||
static int hp_sdc_rtc_set_i8042timer (struct timeval *setto, uint8_t setcmd)
|
||||
{
|
||||
uint32_t tenms;
|
||||
hp_sdc_transaction t;
|
||||
uint8_t tseq[6] = {
|
||||
HP_SDC_ACT_PRECMD | HP_SDC_ACT_DATAOUT,
|
||||
0, 3, 0, 0, 0
|
||||
};
|
||||
|
||||
t.endidx = 6;
|
||||
|
||||
if (0xffffff < setto->tv_sec) return -1;
|
||||
tenms = setto->tv_sec * 100;
|
||||
if (0xffffff < setto->tv_usec / 10000) return -1;
|
||||
tenms += setto->tv_usec / 10000;
|
||||
if (tenms > 0xffffff) return -1;
|
||||
|
||||
tseq[1] = setcmd;
|
||||
tseq[3] = (uint8_t)(tenms & 0xff);
|
||||
tseq[4] = (uint8_t)((tenms >> 8) & 0xff);
|
||||
tseq[5] = (uint8_t)((tenms >> 16) & 0xff);
|
||||
|
||||
t.seq = tseq;
|
||||
|
||||
if (hp_sdc_enqueue_transaction(&t)) {
|
||||
return -1;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static ssize_t hp_sdc_rtc_read(struct file *file, char __user *buf,
|
||||
size_t count, loff_t *ppos) {
|
||||
ssize_t retval;
|
||||
|
||||
if (count < sizeof(unsigned long))
|
||||
return -EINVAL;
|
||||
|
||||
retval = put_user(68, (unsigned long __user *)buf);
|
||||
return retval;
|
||||
}
|
||||
|
||||
static unsigned int hp_sdc_rtc_poll(struct file *file, poll_table *wait)
|
||||
{
|
||||
unsigned long l;
|
||||
|
||||
l = 0;
|
||||
if (l != 0)
|
||||
return POLLIN | POLLRDNORM;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int hp_sdc_rtc_open(struct inode *inode, struct file *file)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int hp_sdc_rtc_release(struct inode *inode, struct file *file)
|
||||
{
|
||||
/* Turn off interrupts? */
|
||||
|
||||
if (file->f_flags & FASYNC) {
|
||||
hp_sdc_rtc_fasync (-1, file, 0);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int hp_sdc_rtc_fasync (int fd, struct file *filp, int on)
|
||||
{
|
||||
return fasync_helper (fd, filp, on, &hp_sdc_rtc_async_queue);
|
||||
}
|
||||
|
||||
static int hp_sdc_rtc_proc_output (char *buf)
|
||||
{
|
||||
#define YN(bit) ("no")
|
||||
#define NY(bit) ("yes")
|
||||
char *p;
|
||||
struct rtc_time tm;
|
||||
struct timeval tv;
|
||||
|
||||
memset(&tm, 0, sizeof(struct rtc_time));
|
||||
|
||||
p = buf;
|
||||
|
||||
if (hp_sdc_rtc_read_bbrtc(&tm)) {
|
||||
p += sprintf(p, "BBRTC\t\t: READ FAILED!\n");
|
||||
} else {
|
||||
p += sprintf(p,
|
||||
"rtc_time\t: %02d:%02d:%02d\n"
|
||||
"rtc_date\t: %04d-%02d-%02d\n"
|
||||
"rtc_epoch\t: %04lu\n",
|
||||
tm.tm_hour, tm.tm_min, tm.tm_sec,
|
||||
tm.tm_year + 1900, tm.tm_mon + 1,
|
||||
tm.tm_mday, epoch);
|
||||
}
|
||||
|
||||
if (hp_sdc_rtc_read_rt(&tv)) {
|
||||
p += sprintf(p, "i8042 rtc\t: READ FAILED!\n");
|
||||
} else {
|
||||
p += sprintf(p, "i8042 rtc\t: %ld.%02d seconds\n",
|
||||
tv.tv_sec, tv.tv_usec/1000);
|
||||
}
|
||||
|
||||
if (hp_sdc_rtc_read_fhs(&tv)) {
|
||||
p += sprintf(p, "handshake\t: READ FAILED!\n");
|
||||
} else {
|
||||
p += sprintf(p, "handshake\t: %ld.%02d seconds\n",
|
||||
tv.tv_sec, tv.tv_usec/1000);
|
||||
}
|
||||
|
||||
if (hp_sdc_rtc_read_mt(&tv)) {
|
||||
p += sprintf(p, "alarm\t\t: READ FAILED!\n");
|
||||
} else {
|
||||
p += sprintf(p, "alarm\t\t: %ld.%02d seconds\n",
|
||||
tv.tv_sec, tv.tv_usec/1000);
|
||||
}
|
||||
|
||||
if (hp_sdc_rtc_read_dt(&tv)) {
|
||||
p += sprintf(p, "delay\t\t: READ FAILED!\n");
|
||||
} else {
|
||||
p += sprintf(p, "delay\t\t: %ld.%02d seconds\n",
|
||||
tv.tv_sec, tv.tv_usec/1000);
|
||||
}
|
||||
|
||||
if (hp_sdc_rtc_read_ct(&tv)) {
|
||||
p += sprintf(p, "periodic\t: READ FAILED!\n");
|
||||
} else {
|
||||
p += sprintf(p, "periodic\t: %ld.%02d seconds\n",
|
||||
tv.tv_sec, tv.tv_usec/1000);
|
||||
}
|
||||
|
||||
p += sprintf(p,
|
||||
"DST_enable\t: %s\n"
|
||||
"BCD\t\t: %s\n"
|
||||
"24hr\t\t: %s\n"
|
||||
"square_wave\t: %s\n"
|
||||
"alarm_IRQ\t: %s\n"
|
||||
"update_IRQ\t: %s\n"
|
||||
"periodic_IRQ\t: %s\n"
|
||||
"periodic_freq\t: %ld\n"
|
||||
"batt_status\t: %s\n",
|
||||
YN(RTC_DST_EN),
|
||||
NY(RTC_DM_BINARY),
|
||||
YN(RTC_24H),
|
||||
YN(RTC_SQWE),
|
||||
YN(RTC_AIE),
|
||||
YN(RTC_UIE),
|
||||
YN(RTC_PIE),
|
||||
1UL,
|
||||
1 ? "okay" : "dead");
|
||||
|
||||
return p - buf;
|
||||
#undef YN
|
||||
#undef NY
|
||||
}
|
||||
|
||||
static int hp_sdc_rtc_read_proc(char *page, char **start, off_t off,
|
||||
int count, int *eof, void *data)
|
||||
{
|
||||
int len = hp_sdc_rtc_proc_output (page);
|
||||
if (len <= off+count) *eof = 1;
|
||||
*start = page + off;
|
||||
len -= off;
|
||||
if (len>count) len = count;
|
||||
if (len<0) len = 0;
|
||||
return len;
|
||||
}
|
||||
|
||||
static int hp_sdc_rtc_ioctl(struct inode *inode, struct file *file,
|
||||
unsigned int cmd, unsigned long arg)
|
||||
{
|
||||
#if 1
|
||||
return -EINVAL;
|
||||
#else
|
||||
|
||||
struct rtc_time wtime;
|
||||
struct timeval ttime;
|
||||
int use_wtime = 0;
|
||||
|
||||
/* This needs major work. */
|
||||
|
||||
switch (cmd) {
|
||||
|
||||
case RTC_AIE_OFF: /* Mask alarm int. enab. bit */
|
||||
case RTC_AIE_ON: /* Allow alarm interrupts. */
|
||||
case RTC_PIE_OFF: /* Mask periodic int. enab. bit */
|
||||
case RTC_PIE_ON: /* Allow periodic ints */
|
||||
case RTC_UIE_ON: /* Allow ints for RTC updates. */
|
||||
case RTC_UIE_OFF: /* Allow ints for RTC updates. */
|
||||
{
|
||||
/* We cannot mask individual user timers and we
|
||||
cannot tell them apart when they occur, so it
|
||||
would be disingenuous to succeed these IOCTLs */
|
||||
return -EINVAL;
|
||||
}
|
||||
case RTC_ALM_READ: /* Read the present alarm time */
|
||||
{
|
||||
if (hp_sdc_rtc_read_mt(&ttime)) return -EFAULT;
|
||||
if (hp_sdc_rtc_read_bbrtc(&wtime)) return -EFAULT;
|
||||
|
||||
wtime.tm_hour = ttime.tv_sec / 3600; ttime.tv_sec %= 3600;
|
||||
wtime.tm_min = ttime.tv_sec / 60; ttime.tv_sec %= 60;
|
||||
wtime.tm_sec = ttime.tv_sec;
|
||||
|
||||
break;
|
||||
}
|
||||
case RTC_IRQP_READ: /* Read the periodic IRQ rate. */
|
||||
{
|
||||
return put_user(hp_sdc_rtc_freq, (unsigned long *)arg);
|
||||
}
|
||||
case RTC_IRQP_SET: /* Set periodic IRQ rate. */
|
||||
{
|
||||
/*
|
||||
* The max we can do is 100Hz.
|
||||
*/
|
||||
|
||||
if ((arg < 1) || (arg > 100)) return -EINVAL;
|
||||
ttime.tv_sec = 0;
|
||||
ttime.tv_usec = 1000000 / arg;
|
||||
if (hp_sdc_rtc_set_ct(&ttime)) return -EFAULT;
|
||||
hp_sdc_rtc_freq = arg;
|
||||
return 0;
|
||||
}
|
||||
case RTC_ALM_SET: /* Store a time into the alarm */
|
||||
{
|
||||
/*
|
||||
* This expects a struct hp_sdc_rtc_time. Writing 0xff means
|
||||
* "don't care" or "match all" for PC timers. The HP SDC
|
||||
* does not support that perk, but it could be emulated fairly
|
||||
* easily. Only the tm_hour, tm_min and tm_sec are used.
|
||||
* We could do it with 10ms accuracy with the HP SDC, if the
|
||||
* rtc interface left us a way to do that.
|
||||
*/
|
||||
struct hp_sdc_rtc_time alm_tm;
|
||||
|
||||
if (copy_from_user(&alm_tm, (struct hp_sdc_rtc_time*)arg,
|
||||
sizeof(struct hp_sdc_rtc_time)))
|
||||
return -EFAULT;
|
||||
|
||||
if (alm_tm.tm_hour > 23) return -EINVAL;
|
||||
if (alm_tm.tm_min > 59) return -EINVAL;
|
||||
if (alm_tm.tm_sec > 59) return -EINVAL;
|
||||
|
||||
ttime.sec = alm_tm.tm_hour * 3600 +
|
||||
alm_tm.tm_min * 60 + alm_tm.tm_sec;
|
||||
ttime.usec = 0;
|
||||
if (hp_sdc_rtc_set_mt(&ttime)) return -EFAULT;
|
||||
return 0;
|
||||
}
|
||||
case RTC_RD_TIME: /* Read the time/date from RTC */
|
||||
{
|
||||
if (hp_sdc_rtc_read_bbrtc(&wtime)) return -EFAULT;
|
||||
break;
|
||||
}
|
||||
case RTC_SET_TIME: /* Set the RTC */
|
||||
{
|
||||
struct rtc_time hp_sdc_rtc_tm;
|
||||
unsigned char mon, day, hrs, min, sec, leap_yr;
|
||||
unsigned int yrs;
|
||||
|
||||
if (!capable(CAP_SYS_TIME))
|
||||
return -EACCES;
|
||||
if (copy_from_user(&hp_sdc_rtc_tm, (struct rtc_time *)arg,
|
||||
sizeof(struct rtc_time)))
|
||||
return -EFAULT;
|
||||
|
||||
yrs = hp_sdc_rtc_tm.tm_year + 1900;
|
||||
mon = hp_sdc_rtc_tm.tm_mon + 1; /* tm_mon starts at zero */
|
||||
day = hp_sdc_rtc_tm.tm_mday;
|
||||
hrs = hp_sdc_rtc_tm.tm_hour;
|
||||
min = hp_sdc_rtc_tm.tm_min;
|
||||
sec = hp_sdc_rtc_tm.tm_sec;
|
||||
|
||||
if (yrs < 1970)
|
||||
return -EINVAL;
|
||||
|
||||
leap_yr = ((!(yrs % 4) && (yrs % 100)) || !(yrs % 400));
|
||||
|
||||
if ((mon > 12) || (day == 0))
|
||||
return -EINVAL;
|
||||
if (day > (days_in_mo[mon] + ((mon == 2) && leap_yr)))
|
||||
return -EINVAL;
|
||||
if ((hrs >= 24) || (min >= 60) || (sec >= 60))
|
||||
return -EINVAL;
|
||||
|
||||
if ((yrs -= eH) > 255) /* They are unsigned */
|
||||
return -EINVAL;
|
||||
|
||||
|
||||
return 0;
|
||||
}
|
||||
case RTC_EPOCH_READ: /* Read the epoch. */
|
||||
{
|
||||
return put_user (epoch, (unsigned long *)arg);
|
||||
}
|
||||
case RTC_EPOCH_SET: /* Set the epoch. */
|
||||
{
|
||||
/*
|
||||
* There were no RTC clocks before 1900.
|
||||
*/
|
||||
if (arg < 1900)
|
||||
return -EINVAL;
|
||||
if (!capable(CAP_SYS_TIME))
|
||||
return -EACCES;
|
||||
|
||||
epoch = arg;
|
||||
return 0;
|
||||
}
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
return copy_to_user((void *)arg, &wtime, sizeof wtime) ? -EFAULT : 0;
|
||||
#endif
|
||||
}
|
||||
|
||||
static const struct file_operations hp_sdc_rtc_fops = {
|
||||
.owner = THIS_MODULE,
|
||||
.llseek = no_llseek,
|
||||
.read = hp_sdc_rtc_read,
|
||||
.poll = hp_sdc_rtc_poll,
|
||||
.ioctl = hp_sdc_rtc_ioctl,
|
||||
.open = hp_sdc_rtc_open,
|
||||
.release = hp_sdc_rtc_release,
|
||||
.fasync = hp_sdc_rtc_fasync,
|
||||
};
|
||||
|
||||
static struct miscdevice hp_sdc_rtc_dev = {
|
||||
.minor = RTC_MINOR,
|
||||
.name = "rtc_HIL",
|
||||
.fops = &hp_sdc_rtc_fops
|
||||
};
|
||||
|
||||
static int __init hp_sdc_rtc_init(void)
|
||||
{
|
||||
int ret;
|
||||
|
||||
init_MUTEX(&i8042tregs);
|
||||
|
||||
if ((ret = hp_sdc_request_timer_irq(&hp_sdc_rtc_isr)))
|
||||
return ret;
|
||||
if (misc_register(&hp_sdc_rtc_dev) != 0)
|
||||
printk(KERN_INFO "Could not register misc. dev for i8042 rtc\n");
|
||||
|
||||
create_proc_read_entry ("driver/rtc", 0, NULL,
|
||||
hp_sdc_rtc_read_proc, NULL);
|
||||
|
||||
printk(KERN_INFO "HP i8042 SDC + MSM-58321 RTC support loaded "
|
||||
"(RTC v " RTC_VERSION ")\n");
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void __exit hp_sdc_rtc_exit(void)
|
||||
{
|
||||
remove_proc_entry ("driver/rtc", NULL);
|
||||
misc_deregister(&hp_sdc_rtc_dev);
|
||||
hp_sdc_release_timer_irq(hp_sdc_rtc_isr);
|
||||
printk(KERN_INFO "HP i8042 SDC + MSM-58321 RTC support unloaded\n");
|
||||
}
|
||||
|
||||
module_init(hp_sdc_rtc_init);
|
||||
module_exit(hp_sdc_rtc_exit);
|
||||
184
drivers/input/misc/ixp4xx-beeper.c
Normal file
184
drivers/input/misc/ixp4xx-beeper.c
Normal file
@@ -0,0 +1,184 @@
|
||||
/*
|
||||
* Generic IXP4xx beeper driver
|
||||
*
|
||||
* Copyright (C) 2005 Tower Technologies
|
||||
*
|
||||
* based on nslu2-io.c
|
||||
* Copyright (C) 2004 Karen Spearel
|
||||
*
|
||||
* Author: Alessandro Zummo <a.zummo@towertech.it>
|
||||
* Maintainers: http://www.nslu2-linux.org/
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License version 2 as
|
||||
* published by the Free Software Foundation.
|
||||
*
|
||||
*/
|
||||
|
||||
#include <linux/module.h>
|
||||
#include <linux/input.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <asm/hardware.h>
|
||||
|
||||
MODULE_AUTHOR("Alessandro Zummo <a.zummo@towertech.it>");
|
||||
MODULE_DESCRIPTION("ixp4xx beeper driver");
|
||||
MODULE_LICENSE("GPL");
|
||||
|
||||
static DEFINE_SPINLOCK(beep_lock);
|
||||
|
||||
static void ixp4xx_spkr_control(unsigned int pin, unsigned int count)
|
||||
{
|
||||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&beep_lock, flags);
|
||||
|
||||
if (count) {
|
||||
gpio_line_config(pin, IXP4XX_GPIO_OUT);
|
||||
gpio_line_set(pin, IXP4XX_GPIO_LOW);
|
||||
|
||||
*IXP4XX_OSRT2 = (count & ~IXP4XX_OST_RELOAD_MASK) | IXP4XX_OST_ENABLE;
|
||||
} else {
|
||||
gpio_line_config(pin, IXP4XX_GPIO_IN);
|
||||
gpio_line_set(pin, IXP4XX_GPIO_HIGH);
|
||||
|
||||
*IXP4XX_OSRT2 = 0;
|
||||
}
|
||||
|
||||
spin_unlock_irqrestore(&beep_lock, flags);
|
||||
}
|
||||
|
||||
static int ixp4xx_spkr_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
|
||||
{
|
||||
unsigned int pin = (unsigned int) dev->private;
|
||||
unsigned int count = 0;
|
||||
|
||||
if (type != EV_SND)
|
||||
return -1;
|
||||
|
||||
switch (code) {
|
||||
case SND_BELL:
|
||||
if (value)
|
||||
value = 1000;
|
||||
case SND_TONE:
|
||||
break;
|
||||
default:
|
||||
return -1;
|
||||
}
|
||||
|
||||
if (value > 20 && value < 32767)
|
||||
#ifndef FREQ
|
||||
count = (ixp4xx_get_board_tick_rate() / (value * 4)) - 1;
|
||||
#else
|
||||
count = (FREQ / (value * 4)) - 1;
|
||||
#endif
|
||||
|
||||
ixp4xx_spkr_control(pin, count);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static irqreturn_t ixp4xx_spkr_interrupt(int irq, void *dev_id)
|
||||
{
|
||||
/* clear interrupt */
|
||||
*IXP4XX_OSST = IXP4XX_OSST_TIMER_2_PEND;
|
||||
|
||||
/* flip the beeper output */
|
||||
*IXP4XX_GPIO_GPOUTR ^= (1 << (unsigned int) dev_id);
|
||||
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
static int __devinit ixp4xx_spkr_probe(struct platform_device *dev)
|
||||
{
|
||||
struct input_dev *input_dev;
|
||||
int err;
|
||||
|
||||
input_dev = input_allocate_device();
|
||||
if (!input_dev)
|
||||
return -ENOMEM;
|
||||
|
||||
input_dev->private = (void *) dev->id;
|
||||
input_dev->name = "ixp4xx beeper",
|
||||
input_dev->phys = "ixp4xx/gpio";
|
||||
input_dev->id.bustype = BUS_HOST;
|
||||
input_dev->id.vendor = 0x001f;
|
||||
input_dev->id.product = 0x0001;
|
||||
input_dev->id.version = 0x0100;
|
||||
input_dev->cdev.dev = &dev->dev;
|
||||
|
||||
input_dev->evbit[0] = BIT(EV_SND);
|
||||
input_dev->sndbit[0] = BIT(SND_BELL) | BIT(SND_TONE);
|
||||
input_dev->event = ixp4xx_spkr_event;
|
||||
|
||||
err = request_irq(IRQ_IXP4XX_TIMER2, &ixp4xx_spkr_interrupt,
|
||||
IRQF_DISABLED | IRQF_TIMER, "ixp4xx-beeper", (void *) dev->id);
|
||||
if (err)
|
||||
goto err_free_device;
|
||||
|
||||
err = input_register_device(input_dev);
|
||||
if (err)
|
||||
goto err_free_irq;
|
||||
|
||||
platform_set_drvdata(dev, input_dev);
|
||||
|
||||
return 0;
|
||||
|
||||
err_free_irq:
|
||||
free_irq(IRQ_IXP4XX_TIMER2, dev);
|
||||
err_free_device:
|
||||
input_free_device(input_dev);
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
static int __devexit ixp4xx_spkr_remove(struct platform_device *dev)
|
||||
{
|
||||
struct input_dev *input_dev = platform_get_drvdata(dev);
|
||||
unsigned int pin = (unsigned int) input_dev->private;
|
||||
|
||||
input_unregister_device(input_dev);
|
||||
platform_set_drvdata(dev, NULL);
|
||||
|
||||
/* turn the speaker off */
|
||||
disable_irq(IRQ_IXP4XX_TIMER2);
|
||||
ixp4xx_spkr_control(pin, 0);
|
||||
|
||||
free_irq(IRQ_IXP4XX_TIMER2, dev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void ixp4xx_spkr_shutdown(struct platform_device *dev)
|
||||
{
|
||||
struct input_dev *input_dev = platform_get_drvdata(dev);
|
||||
unsigned int pin = (unsigned int) input_dev->private;
|
||||
|
||||
/* turn off the speaker */
|
||||
disable_irq(IRQ_IXP4XX_TIMER2);
|
||||
ixp4xx_spkr_control(pin, 0);
|
||||
}
|
||||
|
||||
static struct platform_driver ixp4xx_spkr_platform_driver = {
|
||||
.driver = {
|
||||
.name = "ixp4xx-beeper",
|
||||
.owner = THIS_MODULE,
|
||||
},
|
||||
.probe = ixp4xx_spkr_probe,
|
||||
.remove = __devexit_p(ixp4xx_spkr_remove),
|
||||
.shutdown = ixp4xx_spkr_shutdown,
|
||||
};
|
||||
|
||||
static int __init ixp4xx_spkr_init(void)
|
||||
{
|
||||
return platform_driver_register(&ixp4xx_spkr_platform_driver);
|
||||
}
|
||||
|
||||
static void __exit ixp4xx_spkr_exit(void)
|
||||
{
|
||||
platform_driver_unregister(&ixp4xx_spkr_platform_driver);
|
||||
}
|
||||
|
||||
module_init(ixp4xx_spkr_init);
|
||||
module_exit(ixp4xx_spkr_exit);
|
||||
151
drivers/input/misc/m68kspkr.c
Normal file
151
drivers/input/misc/m68kspkr.c
Normal file
@@ -0,0 +1,151 @@
|
||||
/*
|
||||
* m68k beeper driver for Linux
|
||||
*
|
||||
* Copyright (c) 2002 Richard Zidlicky
|
||||
* Copyright (c) 2002 Vojtech Pavlik
|
||||
* Copyright (c) 1992 Orest Zborowski
|
||||
*
|
||||
*/
|
||||
|
||||
/*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License version 2 as published by
|
||||
* the Free Software Foundation
|
||||
*/
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/input.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <asm/machdep.h>
|
||||
#include <asm/io.h>
|
||||
|
||||
MODULE_AUTHOR("Richard Zidlicky <rz@linux-m68k.org>");
|
||||
MODULE_DESCRIPTION("m68k beeper driver");
|
||||
MODULE_LICENSE("GPL");
|
||||
|
||||
static struct platform_device *m68kspkr_platform_device;
|
||||
|
||||
static int m68kspkr_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
|
||||
{
|
||||
unsigned int count = 0;
|
||||
|
||||
if (type != EV_SND)
|
||||
return -1;
|
||||
|
||||
switch (code) {
|
||||
case SND_BELL: if (value) value = 1000;
|
||||
case SND_TONE: break;
|
||||
default: return -1;
|
||||
}
|
||||
|
||||
if (value > 20 && value < 32767)
|
||||
count = 1193182 / value;
|
||||
|
||||
mach_beep(count, -1);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int __devinit m68kspkr_probe(struct platform_device *dev)
|
||||
{
|
||||
struct input_dev *input_dev;
|
||||
int err;
|
||||
|
||||
input_dev = input_allocate_device();
|
||||
if (!input_dev)
|
||||
return -ENOMEM;
|
||||
|
||||
input_dev->name = "m68k beeper";
|
||||
input_dev->phys = "m68k/generic";
|
||||
input_dev->id.bustype = BUS_HOST;
|
||||
input_dev->id.vendor = 0x001f;
|
||||
input_dev->id.product = 0x0001;
|
||||
input_dev->id.version = 0x0100;
|
||||
input_dev->cdev.dev = &dev->dev;
|
||||
|
||||
input_dev->evbit[0] = BIT(EV_SND);
|
||||
input_dev->sndbit[0] = BIT(SND_BELL) | BIT(SND_TONE);
|
||||
input_dev->event = m68kspkr_event;
|
||||
|
||||
err = input_register_device(input_dev);
|
||||
if (err) {
|
||||
input_free_device(input_dev);
|
||||
return err;
|
||||
}
|
||||
|
||||
platform_set_drvdata(dev, input_dev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int __devexit m68kspkr_remove(struct platform_device *dev)
|
||||
{
|
||||
struct input_dev *input_dev = platform_get_drvdata(dev);
|
||||
|
||||
input_unregister_device(input_dev);
|
||||
platform_set_drvdata(dev, NULL);
|
||||
/* turn off the speaker */
|
||||
m68kspkr_event(NULL, EV_SND, SND_BELL, 0);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void m68kspkr_shutdown(struct platform_device *dev)
|
||||
{
|
||||
/* turn off the speaker */
|
||||
m68kspkr_event(NULL, EV_SND, SND_BELL, 0);
|
||||
}
|
||||
|
||||
static struct platform_driver m68kspkr_platform_driver = {
|
||||
.driver = {
|
||||
.name = "m68kspkr",
|
||||
.owner = THIS_MODULE,
|
||||
},
|
||||
.probe = m68kspkr_probe,
|
||||
.remove = __devexit_p(m68kspkr_remove),
|
||||
.shutdown = m68kspkr_shutdown,
|
||||
};
|
||||
|
||||
static int __init m68kspkr_init(void)
|
||||
{
|
||||
int err;
|
||||
|
||||
if (!mach_beep) {
|
||||
printk(KERN_INFO "m68kspkr: no lowlevel beep support\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
err = platform_driver_register(&m68kspkr_platform_driver);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
m68kspkr_platform_device = platform_device_alloc("m68kspkr", -1);
|
||||
if (!m68kspkr_platform_device) {
|
||||
err = -ENOMEM;
|
||||
goto err_unregister_driver;
|
||||
}
|
||||
|
||||
err = platform_device_add(m68kspkr_platform_device);
|
||||
if (err)
|
||||
goto err_free_device;
|
||||
|
||||
return 0;
|
||||
|
||||
err_free_device:
|
||||
platform_device_put(m68kspkr_platform_device);
|
||||
err_unregister_driver:
|
||||
platform_driver_unregister(&m68kspkr_platform_driver);
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
static void __exit m68kspkr_exit(void)
|
||||
{
|
||||
platform_device_unregister(m68kspkr_platform_device);
|
||||
platform_driver_unregister(&m68kspkr_platform_driver);
|
||||
}
|
||||
|
||||
module_init(m68kspkr_init);
|
||||
module_exit(m68kspkr_exit);
|
||||
146
drivers/input/misc/pcspkr.c
Normal file
146
drivers/input/misc/pcspkr.c
Normal file
@@ -0,0 +1,146 @@
|
||||
/*
|
||||
* PC Speaker beeper driver for Linux
|
||||
*
|
||||
* Copyright (c) 2002 Vojtech Pavlik
|
||||
* Copyright (c) 1992 Orest Zborowski
|
||||
*
|
||||
*/
|
||||
|
||||
/*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License version 2 as published by
|
||||
* the Free Software Foundation
|
||||
*/
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/input.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <asm/8253pit.h>
|
||||
#include <asm/io.h>
|
||||
|
||||
MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
|
||||
MODULE_DESCRIPTION("PC Speaker beeper driver");
|
||||
MODULE_LICENSE("GPL");
|
||||
|
||||
static DEFINE_SPINLOCK(i8253_beep_lock);
|
||||
|
||||
static int pcspkr_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
|
||||
{
|
||||
unsigned int count = 0;
|
||||
unsigned long flags;
|
||||
|
||||
if (type != EV_SND)
|
||||
return -1;
|
||||
|
||||
switch (code) {
|
||||
case SND_BELL: if (value) value = 1000;
|
||||
case SND_TONE: break;
|
||||
default: return -1;
|
||||
}
|
||||
|
||||
if (value > 20 && value < 32767)
|
||||
count = PIT_TICK_RATE / value;
|
||||
|
||||
spin_lock_irqsave(&i8253_beep_lock, flags);
|
||||
|
||||
if (count) {
|
||||
/* enable counter 2 */
|
||||
outb_p(inb_p(0x61) | 3, 0x61);
|
||||
/* set command for counter 2, 2 byte write */
|
||||
outb_p(0xB6, 0x43);
|
||||
/* select desired HZ */
|
||||
outb_p(count & 0xff, 0x42);
|
||||
outb((count >> 8) & 0xff, 0x42);
|
||||
} else {
|
||||
/* disable counter 2 */
|
||||
outb(inb_p(0x61) & 0xFC, 0x61);
|
||||
}
|
||||
|
||||
spin_unlock_irqrestore(&i8253_beep_lock, flags);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int __devinit pcspkr_probe(struct platform_device *dev)
|
||||
{
|
||||
struct input_dev *pcspkr_dev;
|
||||
int err;
|
||||
|
||||
pcspkr_dev = input_allocate_device();
|
||||
if (!pcspkr_dev)
|
||||
return -ENOMEM;
|
||||
|
||||
pcspkr_dev->name = "PC Speaker";
|
||||
pcspkr_dev->phys = "isa0061/input0";
|
||||
pcspkr_dev->id.bustype = BUS_ISA;
|
||||
pcspkr_dev->id.vendor = 0x001f;
|
||||
pcspkr_dev->id.product = 0x0001;
|
||||
pcspkr_dev->id.version = 0x0100;
|
||||
pcspkr_dev->cdev.dev = &dev->dev;
|
||||
|
||||
pcspkr_dev->evbit[0] = BIT(EV_SND);
|
||||
pcspkr_dev->sndbit[0] = BIT(SND_BELL) | BIT(SND_TONE);
|
||||
pcspkr_dev->event = pcspkr_event;
|
||||
|
||||
err = input_register_device(pcspkr_dev);
|
||||
if (err) {
|
||||
input_free_device(pcspkr_dev);
|
||||
return err;
|
||||
}
|
||||
|
||||
platform_set_drvdata(dev, pcspkr_dev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int __devexit pcspkr_remove(struct platform_device *dev)
|
||||
{
|
||||
struct input_dev *pcspkr_dev = platform_get_drvdata(dev);
|
||||
|
||||
input_unregister_device(pcspkr_dev);
|
||||
platform_set_drvdata(dev, NULL);
|
||||
/* turn off the speaker */
|
||||
pcspkr_event(NULL, EV_SND, SND_BELL, 0);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int pcspkr_suspend(struct platform_device *dev, pm_message_t state)
|
||||
{
|
||||
pcspkr_event(NULL, EV_SND, SND_BELL, 0);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void pcspkr_shutdown(struct platform_device *dev)
|
||||
{
|
||||
/* turn off the speaker */
|
||||
pcspkr_event(NULL, EV_SND, SND_BELL, 0);
|
||||
}
|
||||
|
||||
static struct platform_driver pcspkr_platform_driver = {
|
||||
.driver = {
|
||||
.name = "pcspkr",
|
||||
.owner = THIS_MODULE,
|
||||
},
|
||||
.probe = pcspkr_probe,
|
||||
.remove = __devexit_p(pcspkr_remove),
|
||||
.suspend = pcspkr_suspend,
|
||||
.shutdown = pcspkr_shutdown,
|
||||
};
|
||||
|
||||
|
||||
static int __init pcspkr_init(void)
|
||||
{
|
||||
return platform_driver_register(&pcspkr_platform_driver);
|
||||
}
|
||||
|
||||
static void __exit pcspkr_exit(void)
|
||||
{
|
||||
platform_driver_unregister(&pcspkr_platform_driver);
|
||||
}
|
||||
|
||||
module_init(pcspkr_init);
|
||||
module_exit(pcspkr_exit);
|
||||
263
drivers/input/misc/sparcspkr.c
Normal file
263
drivers/input/misc/sparcspkr.c
Normal file
@@ -0,0 +1,263 @@
|
||||
/*
|
||||
* Driver for PC-speaker like devices found on various Sparc systems.
|
||||
*
|
||||
* Copyright (c) 2002 Vojtech Pavlik
|
||||
* Copyright (c) 2002, 2006 David S. Miller (davem@davemloft.net)
|
||||
*/
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/input.h>
|
||||
#include <linux/platform_device.h>
|
||||
|
||||
#include <asm/io.h>
|
||||
#include <asm/ebus.h>
|
||||
#include <asm/isa.h>
|
||||
|
||||
MODULE_AUTHOR("David S. Miller <davem@davemloft.net>");
|
||||
MODULE_DESCRIPTION("Sparc Speaker beeper driver");
|
||||
MODULE_LICENSE("GPL");
|
||||
|
||||
struct sparcspkr_state {
|
||||
const char *name;
|
||||
unsigned long iobase;
|
||||
int (*event)(struct input_dev *dev, unsigned int type, unsigned int code, int value);
|
||||
spinlock_t lock;
|
||||
struct input_dev *input_dev;
|
||||
};
|
||||
|
||||
static int ebus_spkr_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
|
||||
{
|
||||
struct sparcspkr_state *state = dev_get_drvdata(dev->cdev.dev);
|
||||
unsigned int count = 0;
|
||||
unsigned long flags;
|
||||
|
||||
if (type != EV_SND)
|
||||
return -1;
|
||||
|
||||
switch (code) {
|
||||
case SND_BELL: if (value) value = 1000;
|
||||
case SND_TONE: break;
|
||||
default: return -1;
|
||||
}
|
||||
|
||||
if (value > 20 && value < 32767)
|
||||
count = 1193182 / value;
|
||||
|
||||
spin_lock_irqsave(&state->lock, flags);
|
||||
|
||||
/* EBUS speaker only has on/off state, the frequency does not
|
||||
* appear to be programmable.
|
||||
*/
|
||||
if (state->iobase & 0x2UL)
|
||||
outb(!!count, state->iobase);
|
||||
else
|
||||
outl(!!count, state->iobase);
|
||||
|
||||
spin_unlock_irqrestore(&state->lock, flags);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int isa_spkr_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
|
||||
{
|
||||
struct sparcspkr_state *state = dev_get_drvdata(dev->cdev.dev);
|
||||
unsigned int count = 0;
|
||||
unsigned long flags;
|
||||
|
||||
if (type != EV_SND)
|
||||
return -1;
|
||||
|
||||
switch (code) {
|
||||
case SND_BELL: if (value) value = 1000;
|
||||
case SND_TONE: break;
|
||||
default: return -1;
|
||||
}
|
||||
|
||||
if (value > 20 && value < 32767)
|
||||
count = 1193182 / value;
|
||||
|
||||
spin_lock_irqsave(&state->lock, flags);
|
||||
|
||||
if (count) {
|
||||
/* enable counter 2 */
|
||||
outb(inb(state->iobase + 0x61) | 3, state->iobase + 0x61);
|
||||
/* set command for counter 2, 2 byte write */
|
||||
outb(0xB6, state->iobase + 0x43);
|
||||
/* select desired HZ */
|
||||
outb(count & 0xff, state->iobase + 0x42);
|
||||
outb((count >> 8) & 0xff, state->iobase + 0x42);
|
||||
} else {
|
||||
/* disable counter 2 */
|
||||
outb(inb_p(state->iobase + 0x61) & 0xFC, state->iobase + 0x61);
|
||||
}
|
||||
|
||||
spin_unlock_irqrestore(&state->lock, flags);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int __devinit sparcspkr_probe(struct device *dev)
|
||||
{
|
||||
struct sparcspkr_state *state = dev_get_drvdata(dev);
|
||||
struct input_dev *input_dev;
|
||||
int error;
|
||||
|
||||
input_dev = input_allocate_device();
|
||||
if (!input_dev)
|
||||
return -ENOMEM;
|
||||
|
||||
input_dev->name = state->name;
|
||||
input_dev->phys = "sparc/input0";
|
||||
input_dev->id.bustype = BUS_ISA;
|
||||
input_dev->id.vendor = 0x001f;
|
||||
input_dev->id.product = 0x0001;
|
||||
input_dev->id.version = 0x0100;
|
||||
input_dev->cdev.dev = dev;
|
||||
|
||||
input_dev->evbit[0] = BIT(EV_SND);
|
||||
input_dev->sndbit[0] = BIT(SND_BELL) | BIT(SND_TONE);
|
||||
|
||||
input_dev->event = state->event;
|
||||
|
||||
error = input_register_device(input_dev);
|
||||
if (error) {
|
||||
input_free_device(input_dev);
|
||||
return error;
|
||||
}
|
||||
|
||||
state->input_dev = input_dev;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int __devexit sparcspkr_remove(struct of_device *dev)
|
||||
{
|
||||
struct sparcspkr_state *state = dev_get_drvdata(&dev->dev);
|
||||
struct input_dev *input_dev = state->input_dev;
|
||||
|
||||
/* turn off the speaker */
|
||||
state->event(input_dev, EV_SND, SND_BELL, 0);
|
||||
|
||||
input_unregister_device(input_dev);
|
||||
|
||||
dev_set_drvdata(&dev->dev, NULL);
|
||||
kfree(state);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int sparcspkr_shutdown(struct of_device *dev)
|
||||
{
|
||||
struct sparcspkr_state *state = dev_get_drvdata(&dev->dev);
|
||||
struct input_dev *input_dev = state->input_dev;
|
||||
|
||||
/* turn off the speaker */
|
||||
state->event(input_dev, EV_SND, SND_BELL, 0);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int __devinit ebus_beep_probe(struct of_device *dev, const struct of_device_id *match)
|
||||
{
|
||||
struct linux_ebus_device *edev = to_ebus_device(&dev->dev);
|
||||
struct sparcspkr_state *state;
|
||||
int err;
|
||||
|
||||
state = kzalloc(sizeof(*state), GFP_KERNEL);
|
||||
if (!state)
|
||||
return -ENOMEM;
|
||||
|
||||
state->name = "Sparc EBUS Speaker";
|
||||
state->iobase = edev->resource[0].start;
|
||||
state->event = ebus_spkr_event;
|
||||
spin_lock_init(&state->lock);
|
||||
|
||||
dev_set_drvdata(&dev->dev, state);
|
||||
|
||||
err = sparcspkr_probe(&dev->dev);
|
||||
if (err) {
|
||||
dev_set_drvdata(&dev->dev, NULL);
|
||||
kfree(state);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct of_device_id ebus_beep_match[] = {
|
||||
{
|
||||
.name = "beep",
|
||||
},
|
||||
{},
|
||||
};
|
||||
|
||||
static struct of_platform_driver ebus_beep_driver = {
|
||||
.name = "beep",
|
||||
.match_table = ebus_beep_match,
|
||||
.probe = ebus_beep_probe,
|
||||
.remove = sparcspkr_remove,
|
||||
.shutdown = sparcspkr_shutdown,
|
||||
};
|
||||
|
||||
static int __devinit isa_beep_probe(struct of_device *dev, const struct of_device_id *match)
|
||||
{
|
||||
struct sparc_isa_device *idev = to_isa_device(&dev->dev);
|
||||
struct sparcspkr_state *state;
|
||||
int err;
|
||||
|
||||
state = kzalloc(sizeof(*state), GFP_KERNEL);
|
||||
if (!state)
|
||||
return -ENOMEM;
|
||||
|
||||
state->name = "Sparc ISA Speaker";
|
||||
state->iobase = idev->resource.start;
|
||||
state->event = isa_spkr_event;
|
||||
spin_lock_init(&state->lock);
|
||||
|
||||
dev_set_drvdata(&dev->dev, state);
|
||||
|
||||
err = sparcspkr_probe(&dev->dev);
|
||||
if (err) {
|
||||
dev_set_drvdata(&dev->dev, NULL);
|
||||
kfree(state);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct of_device_id isa_beep_match[] = {
|
||||
{
|
||||
.name = "dma",
|
||||
},
|
||||
{},
|
||||
};
|
||||
|
||||
static struct of_platform_driver isa_beep_driver = {
|
||||
.name = "beep",
|
||||
.match_table = isa_beep_match,
|
||||
.probe = isa_beep_probe,
|
||||
.remove = sparcspkr_remove,
|
||||
.shutdown = sparcspkr_shutdown,
|
||||
};
|
||||
|
||||
static int __init sparcspkr_init(void)
|
||||
{
|
||||
int err = of_register_driver(&ebus_beep_driver, &ebus_bus_type);
|
||||
|
||||
if (!err) {
|
||||
err = of_register_driver(&isa_beep_driver, &isa_bus_type);
|
||||
if (err)
|
||||
of_unregister_driver(&ebus_beep_driver);
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
static void __exit sparcspkr_exit(void)
|
||||
{
|
||||
of_unregister_driver(&ebus_beep_driver);
|
||||
of_unregister_driver(&isa_beep_driver);
|
||||
}
|
||||
|
||||
module_init(sparcspkr_init);
|
||||
module_exit(sparcspkr_exit);
|
||||
663
drivers/input/misc/uinput.c
Normal file
663
drivers/input/misc/uinput.c
Normal file
@@ -0,0 +1,663 @@
|
||||
/*
|
||||
* User level driver support for input subsystem
|
||||
*
|
||||
* Heavily based on evdev.c by Vojtech Pavlik
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program; if not, write to the Free Software
|
||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
||||
*
|
||||
* Author: Aristeu Sergio Rozanski Filho <aris@cathedrallabs.org>
|
||||
*
|
||||
* Changes/Revisions:
|
||||
* 0.3 09/04/2006 (Anssi Hannula <anssi.hannula@gmail.com>)
|
||||
* - updated ff support for the changes in kernel interface
|
||||
* - added MODULE_VERSION
|
||||
* 0.2 16/10/2004 (Micah Dowty <micah@navi.cx>)
|
||||
* - added force feedback support
|
||||
* - added UI_SET_PHYS
|
||||
* 0.1 20/06/2002
|
||||
* - first public version
|
||||
*/
|
||||
#include <linux/poll.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/input.h>
|
||||
#include <linux/smp_lock.h>
|
||||
#include <linux/fs.h>
|
||||
#include <linux/miscdevice.h>
|
||||
#include <linux/uinput.h>
|
||||
|
||||
static int uinput_dev_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
|
||||
{
|
||||
struct uinput_device *udev;
|
||||
|
||||
udev = dev->private;
|
||||
|
||||
udev->buff[udev->head].type = type;
|
||||
udev->buff[udev->head].code = code;
|
||||
udev->buff[udev->head].value = value;
|
||||
do_gettimeofday(&udev->buff[udev->head].time);
|
||||
udev->head = (udev->head + 1) % UINPUT_BUFFER_SIZE;
|
||||
|
||||
wake_up_interruptible(&udev->waitq);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int uinput_request_alloc_id(struct uinput_device *udev, struct uinput_request *request)
|
||||
{
|
||||
/* Atomically allocate an ID for the given request. Returns 0 on success. */
|
||||
int id;
|
||||
int err = -1;
|
||||
|
||||
spin_lock(&udev->requests_lock);
|
||||
|
||||
for (id = 0; id < UINPUT_NUM_REQUESTS; id++)
|
||||
if (!udev->requests[id]) {
|
||||
request->id = id;
|
||||
udev->requests[id] = request;
|
||||
err = 0;
|
||||
break;
|
||||
}
|
||||
|
||||
spin_unlock(&udev->requests_lock);
|
||||
return err;
|
||||
}
|
||||
|
||||
static struct uinput_request* uinput_request_find(struct uinput_device *udev, int id)
|
||||
{
|
||||
/* Find an input request, by ID. Returns NULL if the ID isn't valid. */
|
||||
if (id >= UINPUT_NUM_REQUESTS || id < 0)
|
||||
return NULL;
|
||||
return udev->requests[id];
|
||||
}
|
||||
|
||||
static inline int uinput_request_reserve_slot(struct uinput_device *udev, struct uinput_request *request)
|
||||
{
|
||||
/* Allocate slot. If none are available right away, wait. */
|
||||
return wait_event_interruptible(udev->requests_waitq,
|
||||
!uinput_request_alloc_id(udev, request));
|
||||
}
|
||||
|
||||
static void uinput_request_done(struct uinput_device *udev, struct uinput_request *request)
|
||||
{
|
||||
/* Mark slot as available */
|
||||
udev->requests[request->id] = NULL;
|
||||
wake_up(&udev->requests_waitq);
|
||||
|
||||
complete(&request->done);
|
||||
}
|
||||
|
||||
static int uinput_request_submit(struct input_dev *dev, struct uinput_request *request)
|
||||
{
|
||||
/* Tell our userspace app about this new request by queueing an input event */
|
||||
uinput_dev_event(dev, EV_UINPUT, request->code, request->id);
|
||||
|
||||
/* Wait for the request to complete */
|
||||
wait_for_completion(&request->done);
|
||||
return request->retval;
|
||||
}
|
||||
|
||||
static void uinput_dev_set_gain(struct input_dev *dev, u16 gain)
|
||||
{
|
||||
uinput_dev_event(dev, EV_FF, FF_GAIN, gain);
|
||||
}
|
||||
|
||||
static void uinput_dev_set_autocenter(struct input_dev *dev, u16 magnitude)
|
||||
{
|
||||
uinput_dev_event(dev, EV_FF, FF_AUTOCENTER, magnitude);
|
||||
}
|
||||
|
||||
static int uinput_dev_playback(struct input_dev *dev, int effect_id, int value)
|
||||
{
|
||||
return uinput_dev_event(dev, EV_FF, effect_id, value);
|
||||
}
|
||||
|
||||
static int uinput_dev_upload_effect(struct input_dev *dev, struct ff_effect *effect, struct ff_effect *old)
|
||||
{
|
||||
struct uinput_request request;
|
||||
int retval;
|
||||
|
||||
request.id = -1;
|
||||
init_completion(&request.done);
|
||||
request.code = UI_FF_UPLOAD;
|
||||
request.u.upload.effect = effect;
|
||||
request.u.upload.old = old;
|
||||
|
||||
retval = uinput_request_reserve_slot(dev->private, &request);
|
||||
if (!retval)
|
||||
retval = uinput_request_submit(dev, &request);
|
||||
|
||||
return retval;
|
||||
}
|
||||
|
||||
static int uinput_dev_erase_effect(struct input_dev *dev, int effect_id)
|
||||
{
|
||||
struct uinput_request request;
|
||||
int retval;
|
||||
|
||||
if (!test_bit(EV_FF, dev->evbit))
|
||||
return -ENOSYS;
|
||||
|
||||
request.id = -1;
|
||||
init_completion(&request.done);
|
||||
request.code = UI_FF_ERASE;
|
||||
request.u.effect_id = effect_id;
|
||||
|
||||
retval = uinput_request_reserve_slot(dev->private, &request);
|
||||
if (!retval)
|
||||
retval = uinput_request_submit(dev, &request);
|
||||
|
||||
return retval;
|
||||
}
|
||||
|
||||
static void uinput_destroy_device(struct uinput_device *udev)
|
||||
{
|
||||
const char *name, *phys;
|
||||
|
||||
if (udev->dev) {
|
||||
name = udev->dev->name;
|
||||
phys = udev->dev->phys;
|
||||
if (udev->state == UIST_CREATED)
|
||||
input_unregister_device(udev->dev);
|
||||
else
|
||||
input_free_device(udev->dev);
|
||||
kfree(name);
|
||||
kfree(phys);
|
||||
udev->dev = NULL;
|
||||
}
|
||||
|
||||
udev->state = UIST_NEW_DEVICE;
|
||||
}
|
||||
|
||||
static int uinput_create_device(struct uinput_device *udev)
|
||||
{
|
||||
struct input_dev *dev = udev->dev;
|
||||
int error;
|
||||
|
||||
if (udev->state != UIST_SETUP_COMPLETE) {
|
||||
printk(KERN_DEBUG "%s: write device info first\n", UINPUT_NAME);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
if (udev->ff_effects_max) {
|
||||
error = input_ff_create(dev, udev->ff_effects_max);
|
||||
if (error)
|
||||
goto fail1;
|
||||
|
||||
dev->ff->upload = uinput_dev_upload_effect;
|
||||
dev->ff->erase = uinput_dev_erase_effect;
|
||||
dev->ff->playback = uinput_dev_playback;
|
||||
dev->ff->set_gain = uinput_dev_set_gain;
|
||||
dev->ff->set_autocenter = uinput_dev_set_autocenter;
|
||||
}
|
||||
|
||||
error = input_register_device(udev->dev);
|
||||
if (error)
|
||||
goto fail2;
|
||||
|
||||
udev->state = UIST_CREATED;
|
||||
|
||||
return 0;
|
||||
|
||||
fail2: input_ff_destroy(dev);
|
||||
fail1: uinput_destroy_device(udev);
|
||||
return error;
|
||||
}
|
||||
|
||||
static int uinput_open(struct inode *inode, struct file *file)
|
||||
{
|
||||
struct uinput_device *newdev;
|
||||
|
||||
newdev = kzalloc(sizeof(struct uinput_device), GFP_KERNEL);
|
||||
if (!newdev)
|
||||
return -ENOMEM;
|
||||
|
||||
mutex_init(&newdev->mutex);
|
||||
spin_lock_init(&newdev->requests_lock);
|
||||
init_waitqueue_head(&newdev->requests_waitq);
|
||||
init_waitqueue_head(&newdev->waitq);
|
||||
newdev->state = UIST_NEW_DEVICE;
|
||||
|
||||
file->private_data = newdev;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int uinput_validate_absbits(struct input_dev *dev)
|
||||
{
|
||||
unsigned int cnt;
|
||||
int retval = 0;
|
||||
|
||||
for (cnt = 0; cnt < ABS_MAX + 1; cnt++) {
|
||||
if (!test_bit(cnt, dev->absbit))
|
||||
continue;
|
||||
|
||||
if ((dev->absmax[cnt] <= dev->absmin[cnt])) {
|
||||
printk(KERN_DEBUG
|
||||
"%s: invalid abs[%02x] min:%d max:%d\n",
|
||||
UINPUT_NAME, cnt,
|
||||
dev->absmin[cnt], dev->absmax[cnt]);
|
||||
retval = -EINVAL;
|
||||
break;
|
||||
}
|
||||
|
||||
if (dev->absflat[cnt] > (dev->absmax[cnt] - dev->absmin[cnt])) {
|
||||
printk(KERN_DEBUG
|
||||
"%s: absflat[%02x] out of range: %d "
|
||||
"(min:%d/max:%d)\n",
|
||||
UINPUT_NAME, cnt, dev->absflat[cnt],
|
||||
dev->absmin[cnt], dev->absmax[cnt]);
|
||||
retval = -EINVAL;
|
||||
break;
|
||||
}
|
||||
}
|
||||
return retval;
|
||||
}
|
||||
|
||||
static int uinput_allocate_device(struct uinput_device *udev)
|
||||
{
|
||||
udev->dev = input_allocate_device();
|
||||
if (!udev->dev)
|
||||
return -ENOMEM;
|
||||
|
||||
udev->dev->event = uinput_dev_event;
|
||||
udev->dev->private = udev;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int uinput_setup_device(struct uinput_device *udev, const char __user *buffer, size_t count)
|
||||
{
|
||||
struct uinput_user_dev *user_dev;
|
||||
struct input_dev *dev;
|
||||
char *name;
|
||||
int size;
|
||||
int retval;
|
||||
|
||||
if (count != sizeof(struct uinput_user_dev))
|
||||
return -EINVAL;
|
||||
|
||||
if (!udev->dev) {
|
||||
retval = uinput_allocate_device(udev);
|
||||
if (retval)
|
||||
return retval;
|
||||
}
|
||||
|
||||
dev = udev->dev;
|
||||
|
||||
user_dev = kmalloc(sizeof(struct uinput_user_dev), GFP_KERNEL);
|
||||
if (!user_dev)
|
||||
return -ENOMEM;
|
||||
|
||||
if (copy_from_user(user_dev, buffer, sizeof(struct uinput_user_dev))) {
|
||||
retval = -EFAULT;
|
||||
goto exit;
|
||||
}
|
||||
|
||||
udev->ff_effects_max = user_dev->ff_effects_max;
|
||||
|
||||
size = strnlen(user_dev->name, UINPUT_MAX_NAME_SIZE) + 1;
|
||||
if (!size) {
|
||||
retval = -EINVAL;
|
||||
goto exit;
|
||||
}
|
||||
|
||||
kfree(dev->name);
|
||||
dev->name = name = kmalloc(size, GFP_KERNEL);
|
||||
if (!name) {
|
||||
retval = -ENOMEM;
|
||||
goto exit;
|
||||
}
|
||||
strlcpy(name, user_dev->name, size);
|
||||
|
||||
dev->id.bustype = user_dev->id.bustype;
|
||||
dev->id.vendor = user_dev->id.vendor;
|
||||
dev->id.product = user_dev->id.product;
|
||||
dev->id.version = user_dev->id.version;
|
||||
|
||||
size = sizeof(int) * (ABS_MAX + 1);
|
||||
memcpy(dev->absmax, user_dev->absmax, size);
|
||||
memcpy(dev->absmin, user_dev->absmin, size);
|
||||
memcpy(dev->absfuzz, user_dev->absfuzz, size);
|
||||
memcpy(dev->absflat, user_dev->absflat, size);
|
||||
|
||||
/* check if absmin/absmax/absfuzz/absflat are filled as
|
||||
* told in Documentation/input/input-programming.txt */
|
||||
if (test_bit(EV_ABS, dev->evbit)) {
|
||||
retval = uinput_validate_absbits(dev);
|
||||
if (retval < 0)
|
||||
goto exit;
|
||||
}
|
||||
|
||||
udev->state = UIST_SETUP_COMPLETE;
|
||||
retval = count;
|
||||
|
||||
exit:
|
||||
kfree(user_dev);
|
||||
return retval;
|
||||
}
|
||||
|
||||
static inline ssize_t uinput_inject_event(struct uinput_device *udev, const char __user *buffer, size_t count)
|
||||
{
|
||||
struct input_event ev;
|
||||
|
||||
if (count != sizeof(struct input_event))
|
||||
return -EINVAL;
|
||||
|
||||
if (copy_from_user(&ev, buffer, sizeof(struct input_event)))
|
||||
return -EFAULT;
|
||||
|
||||
input_event(udev->dev, ev.type, ev.code, ev.value);
|
||||
|
||||
return sizeof(struct input_event);
|
||||
}
|
||||
|
||||
static ssize_t uinput_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
|
||||
{
|
||||
struct uinput_device *udev = file->private_data;
|
||||
int retval;
|
||||
|
||||
retval = mutex_lock_interruptible(&udev->mutex);
|
||||
if (retval)
|
||||
return retval;
|
||||
|
||||
retval = udev->state == UIST_CREATED ?
|
||||
uinput_inject_event(udev, buffer, count) :
|
||||
uinput_setup_device(udev, buffer, count);
|
||||
|
||||
mutex_unlock(&udev->mutex);
|
||||
|
||||
return retval;
|
||||
}
|
||||
|
||||
static ssize_t uinput_read(struct file *file, char __user *buffer, size_t count, loff_t *ppos)
|
||||
{
|
||||
struct uinput_device *udev = file->private_data;
|
||||
int retval = 0;
|
||||
|
||||
if (udev->state != UIST_CREATED)
|
||||
return -ENODEV;
|
||||
|
||||
if (udev->head == udev->tail && (file->f_flags & O_NONBLOCK))
|
||||
return -EAGAIN;
|
||||
|
||||
retval = wait_event_interruptible(udev->waitq,
|
||||
udev->head != udev->tail || udev->state != UIST_CREATED);
|
||||
if (retval)
|
||||
return retval;
|
||||
|
||||
retval = mutex_lock_interruptible(&udev->mutex);
|
||||
if (retval)
|
||||
return retval;
|
||||
|
||||
if (udev->state != UIST_CREATED) {
|
||||
retval = -ENODEV;
|
||||
goto out;
|
||||
}
|
||||
|
||||
while (udev->head != udev->tail && retval + sizeof(struct input_event) <= count) {
|
||||
if (copy_to_user(buffer + retval, &udev->buff[udev->tail], sizeof(struct input_event))) {
|
||||
retval = -EFAULT;
|
||||
goto out;
|
||||
}
|
||||
udev->tail = (udev->tail + 1) % UINPUT_BUFFER_SIZE;
|
||||
retval += sizeof(struct input_event);
|
||||
}
|
||||
|
||||
out:
|
||||
mutex_unlock(&udev->mutex);
|
||||
|
||||
return retval;
|
||||
}
|
||||
|
||||
static unsigned int uinput_poll(struct file *file, poll_table *wait)
|
||||
{
|
||||
struct uinput_device *udev = file->private_data;
|
||||
|
||||
poll_wait(file, &udev->waitq, wait);
|
||||
|
||||
if (udev->head != udev->tail)
|
||||
return POLLIN | POLLRDNORM;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int uinput_release(struct inode *inode, struct file *file)
|
||||
{
|
||||
struct uinput_device *udev = file->private_data;
|
||||
|
||||
uinput_destroy_device(udev);
|
||||
kfree(udev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
#define uinput_set_bit(_arg, _bit, _max) \
|
||||
({ \
|
||||
int __ret = 0; \
|
||||
if (udev->state == UIST_CREATED) \
|
||||
__ret = -EINVAL; \
|
||||
else if ((_arg) > (_max)) \
|
||||
__ret = -EINVAL; \
|
||||
else set_bit((_arg), udev->dev->_bit); \
|
||||
__ret; \
|
||||
})
|
||||
|
||||
static long uinput_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
|
||||
{
|
||||
int retval;
|
||||
struct uinput_device *udev;
|
||||
void __user *p = (void __user *)arg;
|
||||
struct uinput_ff_upload ff_up;
|
||||
struct uinput_ff_erase ff_erase;
|
||||
struct uinput_request *req;
|
||||
int length;
|
||||
char *phys;
|
||||
|
||||
udev = file->private_data;
|
||||
|
||||
retval = mutex_lock_interruptible(&udev->mutex);
|
||||
if (retval)
|
||||
return retval;
|
||||
|
||||
if (!udev->dev) {
|
||||
retval = uinput_allocate_device(udev);
|
||||
if (retval)
|
||||
goto out;
|
||||
}
|
||||
|
||||
switch (cmd) {
|
||||
case UI_DEV_CREATE:
|
||||
retval = uinput_create_device(udev);
|
||||
break;
|
||||
|
||||
case UI_DEV_DESTROY:
|
||||
uinput_destroy_device(udev);
|
||||
break;
|
||||
|
||||
case UI_SET_EVBIT:
|
||||
retval = uinput_set_bit(arg, evbit, EV_MAX);
|
||||
break;
|
||||
|
||||
case UI_SET_KEYBIT:
|
||||
retval = uinput_set_bit(arg, keybit, KEY_MAX);
|
||||
break;
|
||||
|
||||
case UI_SET_RELBIT:
|
||||
retval = uinput_set_bit(arg, relbit, REL_MAX);
|
||||
break;
|
||||
|
||||
case UI_SET_ABSBIT:
|
||||
retval = uinput_set_bit(arg, absbit, ABS_MAX);
|
||||
break;
|
||||
|
||||
case UI_SET_MSCBIT:
|
||||
retval = uinput_set_bit(arg, mscbit, MSC_MAX);
|
||||
break;
|
||||
|
||||
case UI_SET_LEDBIT:
|
||||
retval = uinput_set_bit(arg, ledbit, LED_MAX);
|
||||
break;
|
||||
|
||||
case UI_SET_SNDBIT:
|
||||
retval = uinput_set_bit(arg, sndbit, SND_MAX);
|
||||
break;
|
||||
|
||||
case UI_SET_FFBIT:
|
||||
retval = uinput_set_bit(arg, ffbit, FF_MAX);
|
||||
break;
|
||||
|
||||
case UI_SET_SWBIT:
|
||||
retval = uinput_set_bit(arg, swbit, SW_MAX);
|
||||
break;
|
||||
|
||||
case UI_SET_PHYS:
|
||||
if (udev->state == UIST_CREATED) {
|
||||
retval = -EINVAL;
|
||||
goto out;
|
||||
}
|
||||
length = strnlen_user(p, 1024);
|
||||
if (length <= 0) {
|
||||
retval = -EFAULT;
|
||||
break;
|
||||
}
|
||||
kfree(udev->dev->phys);
|
||||
udev->dev->phys = phys = kmalloc(length, GFP_KERNEL);
|
||||
if (!phys) {
|
||||
retval = -ENOMEM;
|
||||
break;
|
||||
}
|
||||
if (copy_from_user(phys, p, length)) {
|
||||
udev->dev->phys = NULL;
|
||||
kfree(phys);
|
||||
retval = -EFAULT;
|
||||
break;
|
||||
}
|
||||
phys[length - 1] = '\0';
|
||||
break;
|
||||
|
||||
case UI_BEGIN_FF_UPLOAD:
|
||||
if (copy_from_user(&ff_up, p, sizeof(ff_up))) {
|
||||
retval = -EFAULT;
|
||||
break;
|
||||
}
|
||||
req = uinput_request_find(udev, ff_up.request_id);
|
||||
if (!(req && req->code == UI_FF_UPLOAD && req->u.upload.effect)) {
|
||||
retval = -EINVAL;
|
||||
break;
|
||||
}
|
||||
ff_up.retval = 0;
|
||||
memcpy(&ff_up.effect, req->u.upload.effect, sizeof(struct ff_effect));
|
||||
if (req->u.upload.old)
|
||||
memcpy(&ff_up.old, req->u.upload.old, sizeof(struct ff_effect));
|
||||
else
|
||||
memset(&ff_up.old, 0, sizeof(struct ff_effect));
|
||||
|
||||
if (copy_to_user(p, &ff_up, sizeof(ff_up))) {
|
||||
retval = -EFAULT;
|
||||
break;
|
||||
}
|
||||
break;
|
||||
|
||||
case UI_BEGIN_FF_ERASE:
|
||||
if (copy_from_user(&ff_erase, p, sizeof(ff_erase))) {
|
||||
retval = -EFAULT;
|
||||
break;
|
||||
}
|
||||
req = uinput_request_find(udev, ff_erase.request_id);
|
||||
if (!(req && req->code == UI_FF_ERASE)) {
|
||||
retval = -EINVAL;
|
||||
break;
|
||||
}
|
||||
ff_erase.retval = 0;
|
||||
ff_erase.effect_id = req->u.effect_id;
|
||||
if (copy_to_user(p, &ff_erase, sizeof(ff_erase))) {
|
||||
retval = -EFAULT;
|
||||
break;
|
||||
}
|
||||
break;
|
||||
|
||||
case UI_END_FF_UPLOAD:
|
||||
if (copy_from_user(&ff_up, p, sizeof(ff_up))) {
|
||||
retval = -EFAULT;
|
||||
break;
|
||||
}
|
||||
req = uinput_request_find(udev, ff_up.request_id);
|
||||
if (!(req && req->code == UI_FF_UPLOAD && req->u.upload.effect)) {
|
||||
retval = -EINVAL;
|
||||
break;
|
||||
}
|
||||
req->retval = ff_up.retval;
|
||||
uinput_request_done(udev, req);
|
||||
break;
|
||||
|
||||
case UI_END_FF_ERASE:
|
||||
if (copy_from_user(&ff_erase, p, sizeof(ff_erase))) {
|
||||
retval = -EFAULT;
|
||||
break;
|
||||
}
|
||||
req = uinput_request_find(udev, ff_erase.request_id);
|
||||
if (!(req && req->code == UI_FF_ERASE)) {
|
||||
retval = -EINVAL;
|
||||
break;
|
||||
}
|
||||
req->retval = ff_erase.retval;
|
||||
uinput_request_done(udev, req);
|
||||
break;
|
||||
|
||||
default:
|
||||
retval = -EINVAL;
|
||||
}
|
||||
|
||||
out:
|
||||
mutex_unlock(&udev->mutex);
|
||||
return retval;
|
||||
}
|
||||
|
||||
static const struct file_operations uinput_fops = {
|
||||
.owner = THIS_MODULE,
|
||||
.open = uinput_open,
|
||||
.release = uinput_release,
|
||||
.read = uinput_read,
|
||||
.write = uinput_write,
|
||||
.poll = uinput_poll,
|
||||
.unlocked_ioctl = uinput_ioctl,
|
||||
};
|
||||
|
||||
static struct miscdevice uinput_misc = {
|
||||
.fops = &uinput_fops,
|
||||
.minor = UINPUT_MINOR,
|
||||
.name = UINPUT_NAME,
|
||||
};
|
||||
|
||||
static int __init uinput_init(void)
|
||||
{
|
||||
return misc_register(&uinput_misc);
|
||||
}
|
||||
|
||||
static void __exit uinput_exit(void)
|
||||
{
|
||||
misc_deregister(&uinput_misc);
|
||||
}
|
||||
|
||||
MODULE_AUTHOR("Aristeu Sergio Rozanski Filho");
|
||||
MODULE_DESCRIPTION("User level driver support for input subsystem");
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_VERSION("0.3");
|
||||
|
||||
module_init(uinput_init);
|
||||
module_exit(uinput_exit);
|
||||
|
||||
696
drivers/input/misc/wistron_btns.c
Normal file
696
drivers/input/misc/wistron_btns.c
Normal file
@@ -0,0 +1,696 @@
|
||||
/*
|
||||
* Wistron laptop button driver
|
||||
* Copyright (C) 2005 Miloslav Trmac <mitr@volny.cz>
|
||||
* Copyright (C) 2005 Bernhard Rosenkraenzer <bero@arklinux.org>
|
||||
* Copyright (C) 2005 Dmitry Torokhov <dtor@mail.ru>
|
||||
*
|
||||
* You can redistribute and/or modify this program under the terms of the
|
||||
* GNU General Public License version 2 as published by the Free Software
|
||||
* Foundation.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful, but
|
||||
* WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General
|
||||
* Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License along
|
||||
* with this program; if not, write to the Free Software Foundation, Inc.,
|
||||
* 59 Temple Place Suite 330, Boston, MA 02111-1307, USA.
|
||||
*/
|
||||
#include <linux/io.h>
|
||||
#include <linux/dmi.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/input.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/mc146818rtc.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/preempt.h>
|
||||
#include <linux/string.h>
|
||||
#include <linux/timer.h>
|
||||
#include <linux/types.h>
|
||||
#include <linux/platform_device.h>
|
||||
|
||||
/*
|
||||
* Number of attempts to read data from queue per poll;
|
||||
* the queue can hold up to 31 entries
|
||||
*/
|
||||
#define MAX_POLL_ITERATIONS 64
|
||||
|
||||
#define POLL_FREQUENCY 10 /* Number of polls per second */
|
||||
|
||||
#if POLL_FREQUENCY > HZ
|
||||
#error "POLL_FREQUENCY too high"
|
||||
#endif
|
||||
|
||||
/* BIOS subsystem IDs */
|
||||
#define WIFI 0x35
|
||||
#define BLUETOOTH 0x34
|
||||
|
||||
MODULE_AUTHOR("Miloslav Trmac <mitr@volny.cz>");
|
||||
MODULE_DESCRIPTION("Wistron laptop button driver");
|
||||
MODULE_LICENSE("GPL v2");
|
||||
MODULE_VERSION("0.1");
|
||||
|
||||
static int force; /* = 0; */
|
||||
module_param(force, bool, 0);
|
||||
MODULE_PARM_DESC(force, "Load even if computer is not in database");
|
||||
|
||||
static char *keymap_name; /* = NULL; */
|
||||
module_param_named(keymap, keymap_name, charp, 0);
|
||||
MODULE_PARM_DESC(keymap, "Keymap name, if it can't be autodetected");
|
||||
|
||||
static struct platform_device *wistron_device;
|
||||
|
||||
/* BIOS interface implementation */
|
||||
|
||||
static void __iomem *bios_entry_point; /* BIOS routine entry point */
|
||||
static void __iomem *bios_code_map_base;
|
||||
static void __iomem *bios_data_map_base;
|
||||
|
||||
static u8 cmos_address;
|
||||
|
||||
struct regs {
|
||||
u32 eax, ebx, ecx;
|
||||
};
|
||||
|
||||
static void call_bios(struct regs *regs)
|
||||
{
|
||||
unsigned long flags;
|
||||
|
||||
preempt_disable();
|
||||
local_irq_save(flags);
|
||||
asm volatile ("pushl %%ebp;"
|
||||
"movl %7, %%ebp;"
|
||||
"call *%6;"
|
||||
"popl %%ebp"
|
||||
: "=a" (regs->eax), "=b" (regs->ebx), "=c" (regs->ecx)
|
||||
: "0" (regs->eax), "1" (regs->ebx), "2" (regs->ecx),
|
||||
"m" (bios_entry_point), "m" (bios_data_map_base)
|
||||
: "edx", "edi", "esi", "memory");
|
||||
local_irq_restore(flags);
|
||||
preempt_enable();
|
||||
}
|
||||
|
||||
static ssize_t __init locate_wistron_bios(void __iomem *base)
|
||||
{
|
||||
static unsigned char __initdata signature[] =
|
||||
{ 0x42, 0x21, 0x55, 0x30 };
|
||||
ssize_t offset;
|
||||
|
||||
for (offset = 0; offset < 0x10000; offset += 0x10) {
|
||||
if (check_signature(base + offset, signature,
|
||||
sizeof(signature)) != 0)
|
||||
return offset;
|
||||
}
|
||||
return -1;
|
||||
}
|
||||
|
||||
static int __init map_bios(void)
|
||||
{
|
||||
void __iomem *base;
|
||||
ssize_t offset;
|
||||
u32 entry_point;
|
||||
|
||||
base = ioremap(0xF0000, 0x10000); /* Can't fail */
|
||||
offset = locate_wistron_bios(base);
|
||||
if (offset < 0) {
|
||||
printk(KERN_ERR "wistron_btns: BIOS entry point not found\n");
|
||||
iounmap(base);
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
entry_point = readl(base + offset + 5);
|
||||
printk(KERN_DEBUG
|
||||
"wistron_btns: BIOS signature found at %p, entry point %08X\n",
|
||||
base + offset, entry_point);
|
||||
|
||||
if (entry_point >= 0xF0000) {
|
||||
bios_code_map_base = base;
|
||||
bios_entry_point = bios_code_map_base + (entry_point & 0xFFFF);
|
||||
} else {
|
||||
iounmap(base);
|
||||
bios_code_map_base = ioremap(entry_point & ~0x3FFF, 0x4000);
|
||||
if (bios_code_map_base == NULL) {
|
||||
printk(KERN_ERR
|
||||
"wistron_btns: Can't map BIOS code at %08X\n",
|
||||
entry_point & ~0x3FFF);
|
||||
goto err;
|
||||
}
|
||||
bios_entry_point = bios_code_map_base + (entry_point & 0x3FFF);
|
||||
}
|
||||
/* The Windows driver maps 0x10000 bytes, we keep only one page... */
|
||||
bios_data_map_base = ioremap(0x400, 0xc00);
|
||||
if (bios_data_map_base == NULL) {
|
||||
printk(KERN_ERR "wistron_btns: Can't map BIOS data\n");
|
||||
goto err_code;
|
||||
}
|
||||
return 0;
|
||||
|
||||
err_code:
|
||||
iounmap(bios_code_map_base);
|
||||
err:
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
static inline void unmap_bios(void)
|
||||
{
|
||||
iounmap(bios_code_map_base);
|
||||
iounmap(bios_data_map_base);
|
||||
}
|
||||
|
||||
/* BIOS calls */
|
||||
|
||||
static u16 bios_pop_queue(void)
|
||||
{
|
||||
struct regs regs;
|
||||
|
||||
memset(®s, 0, sizeof (regs));
|
||||
regs.eax = 0x9610;
|
||||
regs.ebx = 0x061C;
|
||||
regs.ecx = 0x0000;
|
||||
call_bios(®s);
|
||||
|
||||
return regs.eax;
|
||||
}
|
||||
|
||||
static void __devinit bios_attach(void)
|
||||
{
|
||||
struct regs regs;
|
||||
|
||||
memset(®s, 0, sizeof (regs));
|
||||
regs.eax = 0x9610;
|
||||
regs.ebx = 0x012E;
|
||||
call_bios(®s);
|
||||
}
|
||||
|
||||
static void bios_detach(void)
|
||||
{
|
||||
struct regs regs;
|
||||
|
||||
memset(®s, 0, sizeof (regs));
|
||||
regs.eax = 0x9610;
|
||||
regs.ebx = 0x002E;
|
||||
call_bios(®s);
|
||||
}
|
||||
|
||||
static u8 __devinit bios_get_cmos_address(void)
|
||||
{
|
||||
struct regs regs;
|
||||
|
||||
memset(®s, 0, sizeof (regs));
|
||||
regs.eax = 0x9610;
|
||||
regs.ebx = 0x051C;
|
||||
call_bios(®s);
|
||||
|
||||
return regs.ecx;
|
||||
}
|
||||
|
||||
static u16 __devinit bios_get_default_setting(u8 subsys)
|
||||
{
|
||||
struct regs regs;
|
||||
|
||||
memset(®s, 0, sizeof (regs));
|
||||
regs.eax = 0x9610;
|
||||
regs.ebx = 0x0200 | subsys;
|
||||
call_bios(®s);
|
||||
|
||||
return regs.eax;
|
||||
}
|
||||
|
||||
static void bios_set_state(u8 subsys, int enable)
|
||||
{
|
||||
struct regs regs;
|
||||
|
||||
memset(®s, 0, sizeof (regs));
|
||||
regs.eax = 0x9610;
|
||||
regs.ebx = (enable ? 0x0100 : 0x0000) | subsys;
|
||||
call_bios(®s);
|
||||
}
|
||||
|
||||
/* Hardware database */
|
||||
|
||||
struct key_entry {
|
||||
char type; /* See KE_* below */
|
||||
u8 code;
|
||||
unsigned keycode; /* For KE_KEY */
|
||||
};
|
||||
|
||||
enum { KE_END, KE_KEY, KE_WIFI, KE_BLUETOOTH };
|
||||
|
||||
static const struct key_entry *keymap; /* = NULL; Current key map */
|
||||
static int have_wifi;
|
||||
static int have_bluetooth;
|
||||
|
||||
static int __init dmi_matched(struct dmi_system_id *dmi)
|
||||
{
|
||||
const struct key_entry *key;
|
||||
|
||||
keymap = dmi->driver_data;
|
||||
for (key = keymap; key->type != KE_END; key++) {
|
||||
if (key->type == KE_WIFI)
|
||||
have_wifi = 1;
|
||||
else if (key->type == KE_BLUETOOTH)
|
||||
have_bluetooth = 1;
|
||||
}
|
||||
return 1;
|
||||
}
|
||||
|
||||
static struct key_entry keymap_empty[] = {
|
||||
{ KE_END, 0 }
|
||||
};
|
||||
|
||||
static struct key_entry keymap_fs_amilo_pro_v2000[] = {
|
||||
{ KE_KEY, 0x01, KEY_HELP },
|
||||
{ KE_KEY, 0x11, KEY_PROG1 },
|
||||
{ KE_KEY, 0x12, KEY_PROG2 },
|
||||
{ KE_WIFI, 0x30, 0 },
|
||||
{ KE_KEY, 0x31, KEY_MAIL },
|
||||
{ KE_KEY, 0x36, KEY_WWW },
|
||||
{ KE_END, 0 }
|
||||
};
|
||||
|
||||
static struct key_entry keymap_fujitsu_n3510[] = {
|
||||
{ KE_KEY, 0x11, KEY_PROG1 },
|
||||
{ KE_KEY, 0x12, KEY_PROG2 },
|
||||
{ KE_KEY, 0x36, KEY_WWW },
|
||||
{ KE_KEY, 0x31, KEY_MAIL },
|
||||
{ KE_KEY, 0x71, KEY_STOPCD },
|
||||
{ KE_KEY, 0x72, KEY_PLAYPAUSE },
|
||||
{ KE_KEY, 0x74, KEY_REWIND },
|
||||
{ KE_KEY, 0x78, KEY_FORWARD },
|
||||
{ KE_END, 0 }
|
||||
};
|
||||
|
||||
static struct key_entry keymap_wistron_ms2111[] = {
|
||||
{ KE_KEY, 0x11, KEY_PROG1 },
|
||||
{ KE_KEY, 0x12, KEY_PROG2 },
|
||||
{ KE_KEY, 0x13, KEY_PROG3 },
|
||||
{ KE_KEY, 0x31, KEY_MAIL },
|
||||
{ KE_KEY, 0x36, KEY_WWW },
|
||||
{ KE_END, 0 }
|
||||
};
|
||||
|
||||
static struct key_entry keymap_wistron_ms2141[] = {
|
||||
{ KE_KEY, 0x11, KEY_PROG1 },
|
||||
{ KE_KEY, 0x12, KEY_PROG2 },
|
||||
{ KE_WIFI, 0x30, 0 },
|
||||
{ KE_KEY, 0x22, KEY_REWIND },
|
||||
{ KE_KEY, 0x23, KEY_FORWARD },
|
||||
{ KE_KEY, 0x24, KEY_PLAYPAUSE },
|
||||
{ KE_KEY, 0x25, KEY_STOPCD },
|
||||
{ KE_KEY, 0x31, KEY_MAIL },
|
||||
{ KE_KEY, 0x36, KEY_WWW },
|
||||
{ KE_END, 0 }
|
||||
};
|
||||
|
||||
static struct key_entry keymap_acer_aspire_1500[] = {
|
||||
{ KE_KEY, 0x11, KEY_PROG1 },
|
||||
{ KE_KEY, 0x12, KEY_PROG2 },
|
||||
{ KE_WIFI, 0x30, 0 },
|
||||
{ KE_KEY, 0x31, KEY_MAIL },
|
||||
{ KE_KEY, 0x36, KEY_WWW },
|
||||
{ KE_BLUETOOTH, 0x44, 0 },
|
||||
{ KE_END, 0 }
|
||||
};
|
||||
|
||||
static struct key_entry keymap_acer_travelmate_240[] = {
|
||||
{ KE_KEY, 0x31, KEY_MAIL },
|
||||
{ KE_KEY, 0x36, KEY_WWW },
|
||||
{ KE_KEY, 0x11, KEY_PROG1 },
|
||||
{ KE_KEY, 0x12, KEY_PROG2 },
|
||||
{ KE_BLUETOOTH, 0x44, 0 },
|
||||
{ KE_WIFI, 0x30, 0 },
|
||||
{ KE_END, 0 }
|
||||
};
|
||||
|
||||
static struct key_entry keymap_aopen_1559as[] = {
|
||||
{ KE_KEY, 0x01, KEY_HELP },
|
||||
{ KE_KEY, 0x06, KEY_PROG3 },
|
||||
{ KE_KEY, 0x11, KEY_PROG1 },
|
||||
{ KE_KEY, 0x12, KEY_PROG2 },
|
||||
{ KE_WIFI, 0x30, 0 },
|
||||
{ KE_KEY, 0x31, KEY_MAIL },
|
||||
{ KE_KEY, 0x36, KEY_WWW },
|
||||
{ KE_END, 0 },
|
||||
};
|
||||
|
||||
static struct key_entry keymap_fs_amilo_d88x0[] = {
|
||||
{ KE_KEY, 0x01, KEY_HELP },
|
||||
{ KE_KEY, 0x08, KEY_MUTE },
|
||||
{ KE_KEY, 0x31, KEY_MAIL },
|
||||
{ KE_KEY, 0x36, KEY_WWW },
|
||||
{ KE_KEY, 0x11, KEY_PROG1 },
|
||||
{ KE_KEY, 0x12, KEY_PROG2 },
|
||||
{ KE_KEY, 0x13, KEY_PROG3 },
|
||||
{ KE_END, 0 }
|
||||
};
|
||||
|
||||
/*
|
||||
* If your machine is not here (which is currently rather likely), please send
|
||||
* a list of buttons and their key codes (reported when loading this module
|
||||
* with force=1) and the output of dmidecode to $MODULE_AUTHOR.
|
||||
*/
|
||||
static struct dmi_system_id dmi_ids[] __initdata = {
|
||||
{
|
||||
.callback = dmi_matched,
|
||||
.ident = "Fujitsu-Siemens Amilo Pro V2000",
|
||||
.matches = {
|
||||
DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
|
||||
DMI_MATCH(DMI_PRODUCT_NAME, "AMILO Pro V2000"),
|
||||
},
|
||||
.driver_data = keymap_fs_amilo_pro_v2000
|
||||
},
|
||||
{
|
||||
.callback = dmi_matched,
|
||||
.ident = "Fujitsu-Siemens Amilo M7400",
|
||||
.matches = {
|
||||
DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
|
||||
DMI_MATCH(DMI_PRODUCT_NAME, "AMILO M "),
|
||||
},
|
||||
.driver_data = keymap_fs_amilo_pro_v2000
|
||||
},
|
||||
{
|
||||
.callback = dmi_matched,
|
||||
.ident = "Fujitsu N3510",
|
||||
.matches = {
|
||||
DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU"),
|
||||
DMI_MATCH(DMI_PRODUCT_NAME, "N3510"),
|
||||
},
|
||||
.driver_data = keymap_fujitsu_n3510
|
||||
},
|
||||
{
|
||||
.callback = dmi_matched,
|
||||
.ident = "Acer Aspire 1500",
|
||||
.matches = {
|
||||
DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
|
||||
DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 1500"),
|
||||
},
|
||||
.driver_data = keymap_acer_aspire_1500
|
||||
},
|
||||
{
|
||||
.callback = dmi_matched,
|
||||
.ident = "Acer TravelMate 240",
|
||||
.matches = {
|
||||
DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
|
||||
DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 240"),
|
||||
},
|
||||
.driver_data = keymap_acer_travelmate_240
|
||||
},
|
||||
{
|
||||
.callback = dmi_matched,
|
||||
.ident = "Acer TravelMate 2424NWXCi",
|
||||
.matches = {
|
||||
DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
|
||||
DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 2420"),
|
||||
},
|
||||
.driver_data = keymap_acer_travelmate_240
|
||||
},
|
||||
{
|
||||
.callback = dmi_matched,
|
||||
.ident = "AOpen 1559AS",
|
||||
.matches = {
|
||||
DMI_MATCH(DMI_PRODUCT_NAME, "E2U"),
|
||||
DMI_MATCH(DMI_BOARD_NAME, "E2U"),
|
||||
},
|
||||
.driver_data = keymap_aopen_1559as
|
||||
},
|
||||
{
|
||||
.callback = dmi_matched,
|
||||
.ident = "Medion MD 9783",
|
||||
.matches = {
|
||||
DMI_MATCH(DMI_SYS_VENDOR, "MEDIONNB"),
|
||||
DMI_MATCH(DMI_PRODUCT_NAME, "MD 9783"),
|
||||
},
|
||||
.driver_data = keymap_wistron_ms2111
|
||||
},
|
||||
{
|
||||
.callback = dmi_matched,
|
||||
.ident = "Fujitsu Siemens Amilo D88x0",
|
||||
.matches = {
|
||||
DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
|
||||
DMI_MATCH(DMI_PRODUCT_NAME, "AMILO D"),
|
||||
},
|
||||
.driver_data = keymap_fs_amilo_d88x0
|
||||
},
|
||||
{ NULL, }
|
||||
};
|
||||
|
||||
static int __init select_keymap(void)
|
||||
{
|
||||
if (keymap_name != NULL) {
|
||||
if (strcmp (keymap_name, "1557/MS2141") == 0)
|
||||
keymap = keymap_wistron_ms2141;
|
||||
else {
|
||||
printk(KERN_ERR "wistron_btns: Keymap unknown\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
dmi_check_system(dmi_ids);
|
||||
if (keymap == NULL) {
|
||||
if (!force) {
|
||||
printk(KERN_ERR "wistron_btns: System unknown\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
keymap = keymap_empty;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* Input layer interface */
|
||||
|
||||
static struct input_dev *input_dev;
|
||||
|
||||
static int __devinit setup_input_dev(void)
|
||||
{
|
||||
const struct key_entry *key;
|
||||
int error;
|
||||
|
||||
input_dev = input_allocate_device();
|
||||
if (!input_dev)
|
||||
return -ENOMEM;
|
||||
|
||||
input_dev->name = "Wistron laptop buttons";
|
||||
input_dev->phys = "wistron/input0";
|
||||
input_dev->id.bustype = BUS_HOST;
|
||||
input_dev->cdev.dev = &wistron_device->dev;
|
||||
|
||||
for (key = keymap; key->type != KE_END; key++) {
|
||||
if (key->type == KE_KEY) {
|
||||
input_dev->evbit[LONG(EV_KEY)] = BIT(EV_KEY);
|
||||
set_bit(key->keycode, input_dev->keybit);
|
||||
}
|
||||
}
|
||||
|
||||
error = input_register_device(input_dev);
|
||||
if (error) {
|
||||
input_free_device(input_dev);
|
||||
return error;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void report_key(unsigned keycode)
|
||||
{
|
||||
input_report_key(input_dev, keycode, 1);
|
||||
input_sync(input_dev);
|
||||
input_report_key(input_dev, keycode, 0);
|
||||
input_sync(input_dev);
|
||||
}
|
||||
|
||||
/* Driver core */
|
||||
|
||||
static int wifi_enabled;
|
||||
static int bluetooth_enabled;
|
||||
|
||||
static void poll_bios(unsigned long);
|
||||
|
||||
static struct timer_list poll_timer = TIMER_INITIALIZER(poll_bios, 0, 0);
|
||||
|
||||
static void handle_key(u8 code)
|
||||
{
|
||||
const struct key_entry *key;
|
||||
|
||||
for (key = keymap; key->type != KE_END; key++) {
|
||||
if (code == key->code) {
|
||||
switch (key->type) {
|
||||
case KE_KEY:
|
||||
report_key(key->keycode);
|
||||
break;
|
||||
|
||||
case KE_WIFI:
|
||||
if (have_wifi) {
|
||||
wifi_enabled = !wifi_enabled;
|
||||
bios_set_state(WIFI, wifi_enabled);
|
||||
}
|
||||
break;
|
||||
|
||||
case KE_BLUETOOTH:
|
||||
if (have_bluetooth) {
|
||||
bluetooth_enabled = !bluetooth_enabled;
|
||||
bios_set_state(BLUETOOTH, bluetooth_enabled);
|
||||
}
|
||||
break;
|
||||
|
||||
case KE_END:
|
||||
default:
|
||||
BUG();
|
||||
}
|
||||
return;
|
||||
}
|
||||
}
|
||||
printk(KERN_NOTICE "wistron_btns: Unknown key code %02X\n", code);
|
||||
}
|
||||
|
||||
static void poll_bios(unsigned long discard)
|
||||
{
|
||||
u8 qlen;
|
||||
u16 val;
|
||||
|
||||
for (;;) {
|
||||
qlen = CMOS_READ(cmos_address);
|
||||
if (qlen == 0)
|
||||
break;
|
||||
val = bios_pop_queue();
|
||||
if (val != 0 && !discard)
|
||||
handle_key((u8)val);
|
||||
}
|
||||
|
||||
mod_timer(&poll_timer, jiffies + HZ / POLL_FREQUENCY);
|
||||
}
|
||||
|
||||
static int __devinit wistron_probe(struct platform_device *dev)
|
||||
{
|
||||
int err = setup_input_dev();
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
bios_attach();
|
||||
cmos_address = bios_get_cmos_address();
|
||||
|
||||
if (have_wifi) {
|
||||
u16 wifi = bios_get_default_setting(WIFI);
|
||||
if (wifi & 1)
|
||||
wifi_enabled = (wifi & 2) ? 1 : 0;
|
||||
else
|
||||
have_wifi = 0;
|
||||
|
||||
if (have_wifi)
|
||||
bios_set_state(WIFI, wifi_enabled);
|
||||
}
|
||||
|
||||
if (have_bluetooth) {
|
||||
u16 bt = bios_get_default_setting(BLUETOOTH);
|
||||
if (bt & 1)
|
||||
bluetooth_enabled = (bt & 2) ? 1 : 0;
|
||||
else
|
||||
have_bluetooth = 0;
|
||||
|
||||
if (have_bluetooth)
|
||||
bios_set_state(BLUETOOTH, bluetooth_enabled);
|
||||
}
|
||||
|
||||
poll_bios(1); /* Flush stale event queue and arm timer */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int __devexit wistron_remove(struct platform_device *dev)
|
||||
{
|
||||
del_timer_sync(&poll_timer);
|
||||
input_unregister_device(input_dev);
|
||||
bios_detach();
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
#ifdef CONFIG_PM
|
||||
static int wistron_suspend(struct platform_device *dev, pm_message_t state)
|
||||
{
|
||||
del_timer_sync(&poll_timer);
|
||||
|
||||
if (have_wifi)
|
||||
bios_set_state(WIFI, 0);
|
||||
|
||||
if (have_bluetooth)
|
||||
bios_set_state(BLUETOOTH, 0);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int wistron_resume(struct platform_device *dev)
|
||||
{
|
||||
if (have_wifi)
|
||||
bios_set_state(WIFI, wifi_enabled);
|
||||
|
||||
if (have_bluetooth)
|
||||
bios_set_state(BLUETOOTH, bluetooth_enabled);
|
||||
|
||||
poll_bios(1);
|
||||
|
||||
return 0;
|
||||
}
|
||||
#else
|
||||
#define wistron_suspend NULL
|
||||
#define wistron_resume NULL
|
||||
#endif
|
||||
|
||||
static struct platform_driver wistron_driver = {
|
||||
.driver = {
|
||||
.name = "wistron-bios",
|
||||
.owner = THIS_MODULE,
|
||||
},
|
||||
.probe = wistron_probe,
|
||||
.remove = __devexit_p(wistron_remove),
|
||||
.suspend = wistron_suspend,
|
||||
.resume = wistron_resume,
|
||||
};
|
||||
|
||||
static int __init wb_module_init(void)
|
||||
{
|
||||
int err;
|
||||
|
||||
err = select_keymap();
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
err = map_bios();
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
err = platform_driver_register(&wistron_driver);
|
||||
if (err)
|
||||
goto err_unmap_bios;
|
||||
|
||||
wistron_device = platform_device_alloc("wistron-bios", -1);
|
||||
if (!wistron_device) {
|
||||
err = -ENOMEM;
|
||||
goto err_unregister_driver;
|
||||
}
|
||||
|
||||
err = platform_device_add(wistron_device);
|
||||
if (err)
|
||||
goto err_free_device;
|
||||
|
||||
return 0;
|
||||
|
||||
err_free_device:
|
||||
platform_device_put(wistron_device);
|
||||
err_unregister_driver:
|
||||
platform_driver_unregister(&wistron_driver);
|
||||
err_unmap_bios:
|
||||
unmap_bios();
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
static void __exit wb_module_exit(void)
|
||||
{
|
||||
platform_device_unregister(wistron_device);
|
||||
platform_driver_unregister(&wistron_driver);
|
||||
unmap_bios();
|
||||
}
|
||||
|
||||
module_init(wb_module_init);
|
||||
module_exit(wb_module_exit);
|
||||
Reference in New Issue
Block a user