2007-01-13 22:04:31 +00:00
|
|
|
/*
|
2007-04-09 17:26:03 +00:00
|
|
|
* ACPI Sony Notebook Control Driver (SNC and SPIC)
|
2007-01-13 22:04:31 +00:00
|
|
|
*
|
|
|
|
* Copyright (C) 2004-2005 Stelian Pop <stelian@popies.net>
|
2009-03-26 12:58:24 +00:00
|
|
|
* Copyright (C) 2007-2009 Mattia Dongili <malattia@linux.it>
|
2007-01-13 22:04:31 +00:00
|
|
|
*
|
|
|
|
* Parts of this driver inspired from asus_acpi.c and ibm_acpi.c
|
|
|
|
* which are copyrighted by their respective authors.
|
|
|
|
*
|
2007-04-09 17:26:03 +00:00
|
|
|
* The SNY6001 driver part is based on the sonypi driver which includes
|
|
|
|
* material from:
|
|
|
|
*
|
|
|
|
* Copyright (C) 2001-2005 Stelian Pop <stelian@popies.net>
|
|
|
|
*
|
|
|
|
* Copyright (C) 2005 Narayanan R S <nars@kadamba.org>
|
|
|
|
*
|
2007-10-19 21:22:11 +00:00
|
|
|
* Copyright (C) 2001-2002 Alcôve <www.alcove.com>
|
2007-04-09 17:26:03 +00:00
|
|
|
*
|
|
|
|
* Copyright (C) 2001 Michael Ashley <m.ashley@unsw.edu.au>
|
|
|
|
*
|
|
|
|
* Copyright (C) 2001 Junichi Morita <jun1m@mars.dti.ne.jp>
|
|
|
|
*
|
|
|
|
* Copyright (C) 2000 Takaya Kinjo <t-kinjo@tc4.so-net.ne.jp>
|
|
|
|
*
|
|
|
|
* Copyright (C) 2000 Andrew Tridgell <tridge@valinux.com>
|
|
|
|
*
|
|
|
|
* Earlier work by Werner Almesberger, Paul `Rusty' Russell and Paul Mackerras.
|
|
|
|
*
|
2007-01-13 22:04:31 +00:00
|
|
|
* 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., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/moduleparam.h>
|
|
|
|
#include <linux/init.h>
|
|
|
|
#include <linux/types.h>
|
2007-01-13 22:04:34 +00:00
|
|
|
#include <linux/backlight.h>
|
2007-02-07 19:01:54 +00:00
|
|
|
#include <linux/platform_device.h>
|
2007-01-13 22:04:34 +00:00
|
|
|
#include <linux/err.h>
|
2007-04-09 17:26:03 +00:00
|
|
|
#include <linux/dmi.h>
|
|
|
|
#include <linux/pci.h>
|
|
|
|
#include <linux/interrupt.h>
|
|
|
|
#include <linux/delay.h>
|
|
|
|
#include <linux/input.h>
|
|
|
|
#include <linux/kfifo.h>
|
|
|
|
#include <linux/workqueue.h>
|
|
|
|
#include <linux/acpi.h>
|
include cleanup: Update gfp.h and slab.h includes to prepare for breaking implicit slab.h inclusion from percpu.h
percpu.h is included by sched.h and module.h and thus ends up being
included when building most .c files. percpu.h includes slab.h which
in turn includes gfp.h making everything defined by the two files
universally available and complicating inclusion dependencies.
percpu.h -> slab.h dependency is about to be removed. Prepare for
this change by updating users of gfp and slab facilities include those
headers directly instead of assuming availability. As this conversion
needs to touch large number of source files, the following script is
used as the basis of conversion.
http://userweb.kernel.org/~tj/misc/slabh-sweep.py
The script does the followings.
* Scan files for gfp and slab usages and update includes such that
only the necessary includes are there. ie. if only gfp is used,
gfp.h, if slab is used, slab.h.
* When the script inserts a new include, it looks at the include
blocks and try to put the new include such that its order conforms
to its surrounding. It's put in the include block which contains
core kernel includes, in the same order that the rest are ordered -
alphabetical, Christmas tree, rev-Xmas-tree or at the end if there
doesn't seem to be any matching order.
* If the script can't find a place to put a new include (mostly
because the file doesn't have fitting include block), it prints out
an error message indicating which .h file needs to be added to the
file.
The conversion was done in the following steps.
1. The initial automatic conversion of all .c files updated slightly
over 4000 files, deleting around 700 includes and adding ~480 gfp.h
and ~3000 slab.h inclusions. The script emitted errors for ~400
files.
2. Each error was manually checked. Some didn't need the inclusion,
some needed manual addition while adding it to implementation .h or
embedding .c file was more appropriate for others. This step added
inclusions to around 150 files.
3. The script was run again and the output was compared to the edits
from #2 to make sure no file was left behind.
4. Several build tests were done and a couple of problems were fixed.
e.g. lib/decompress_*.c used malloc/free() wrappers around slab
APIs requiring slab.h to be added manually.
5. The script was run on all .h files but without automatically
editing them as sprinkling gfp.h and slab.h inclusions around .h
files could easily lead to inclusion dependency hell. Most gfp.h
inclusion directives were ignored as stuff from gfp.h was usually
wildly available and often used in preprocessor macros. Each
slab.h inclusion directive was examined and added manually as
necessary.
6. percpu.h was updated not to include slab.h.
7. Build test were done on the following configurations and failures
were fixed. CONFIG_GCOV_KERNEL was turned off for all tests (as my
distributed build env didn't work with gcov compiles) and a few
more options had to be turned off depending on archs to make things
build (like ipr on powerpc/64 which failed due to missing writeq).
* x86 and x86_64 UP and SMP allmodconfig and a custom test config.
* powerpc and powerpc64 SMP allmodconfig
* sparc and sparc64 SMP allmodconfig
* ia64 SMP allmodconfig
* s390 SMP allmodconfig
* alpha SMP allmodconfig
* um on x86_64 SMP allmodconfig
8. percpu.h modifications were reverted so that it could be applied as
a separate patch and serve as bisection point.
Given the fact that I had only a couple of failures from tests on step
6, I'm fairly confident about the coverage of this conversion patch.
If there is a breakage, it's likely to be something in one of the arch
headers which should be easily discoverable easily on most builds of
the specific arch.
Signed-off-by: Tejun Heo <tj@kernel.org>
Guess-its-ok-by: Christoph Lameter <cl@linux-foundation.org>
Cc: Ingo Molnar <mingo@redhat.com>
Cc: Lee Schermerhorn <Lee.Schermerhorn@hp.com>
2010-03-24 08:04:11 +00:00
|
|
|
#include <linux/slab.h>
|
2007-01-13 22:04:31 +00:00
|
|
|
#include <acpi/acpi_drivers.h>
|
|
|
|
#include <acpi/acpi_bus.h>
|
|
|
|
#include <asm/uaccess.h>
|
2007-04-09 17:26:03 +00:00
|
|
|
#include <linux/sonypi.h>
|
2007-04-28 14:34:36 +00:00
|
|
|
#include <linux/sony-laptop.h>
|
2009-03-26 12:58:15 +00:00
|
|
|
#include <linux/rfkill.h>
|
2007-05-01 02:19:53 +00:00
|
|
|
#ifdef CONFIG_SONYPI_COMPAT
|
2007-04-09 17:31:25 +00:00
|
|
|
#include <linux/poll.h>
|
|
|
|
#include <linux/miscdevice.h>
|
|
|
|
#endif
|
2007-01-13 22:04:31 +00:00
|
|
|
|
2007-04-09 17:26:03 +00:00
|
|
|
#define DRV_PFX "sony-laptop: "
|
2011-02-19 02:52:28 +00:00
|
|
|
#define dprintk(msg...) do { \
|
|
|
|
if (debug) \
|
|
|
|
pr_warn(DRV_PFX msg); \
|
2007-04-09 08:19:06 +00:00
|
|
|
} while (0)
|
|
|
|
|
2008-01-14 09:05:44 +00:00
|
|
|
#define SONY_LAPTOP_DRIVER_VERSION "0.6"
|
2007-04-09 17:26:03 +00:00
|
|
|
|
|
|
|
#define SONY_NC_CLASS "sony-nc"
|
2007-04-09 08:19:04 +00:00
|
|
|
#define SONY_NC_HID "SNY5001"
|
2007-04-09 17:31:06 +00:00
|
|
|
#define SONY_NC_DRIVER_NAME "Sony Notebook Control Driver"
|
2007-01-13 22:04:34 +00:00
|
|
|
|
2007-04-09 17:26:03 +00:00
|
|
|
#define SONY_PIC_CLASS "sony-pic"
|
|
|
|
#define SONY_PIC_HID "SNY6001"
|
2007-04-09 17:31:06 +00:00
|
|
|
#define SONY_PIC_DRIVER_NAME "Sony Programmable IO Control Driver"
|
2007-01-13 22:04:31 +00:00
|
|
|
|
2007-02-07 19:01:54 +00:00
|
|
|
MODULE_AUTHOR("Stelian Pop, Mattia Dongili");
|
2007-04-09 17:26:03 +00:00
|
|
|
MODULE_DESCRIPTION("Sony laptop extras driver (SPIC and SNC ACPI device)");
|
2007-01-13 22:04:31 +00:00
|
|
|
MODULE_LICENSE("GPL");
|
2007-04-09 17:26:03 +00:00
|
|
|
MODULE_VERSION(SONY_LAPTOP_DRIVER_VERSION);
|
2007-01-13 22:04:31 +00:00
|
|
|
|
|
|
|
static int debug;
|
|
|
|
module_param(debug, int, 0);
|
|
|
|
MODULE_PARM_DESC(debug, "set this to 1 (and RTFM) if you want to help "
|
2007-02-07 20:34:02 +00:00
|
|
|
"the development of this driver");
|
2007-01-13 22:04:31 +00:00
|
|
|
|
2007-04-09 17:26:03 +00:00
|
|
|
static int no_spic; /* = 0 */
|
|
|
|
module_param(no_spic, int, 0444);
|
|
|
|
MODULE_PARM_DESC(no_spic,
|
|
|
|
"set this if you don't want to enable the SPIC device");
|
|
|
|
|
|
|
|
static int compat; /* = 0 */
|
|
|
|
module_param(compat, int, 0444);
|
|
|
|
MODULE_PARM_DESC(compat,
|
2007-04-09 17:31:25 +00:00
|
|
|
"set this if you want to enable backward compatibility mode");
|
2007-04-09 17:26:03 +00:00
|
|
|
|
|
|
|
static unsigned long mask = 0xffffffff;
|
|
|
|
module_param(mask, ulong, 0644);
|
|
|
|
MODULE_PARM_DESC(mask,
|
|
|
|
"set this to the mask of event you want to enable (see doc)");
|
|
|
|
|
2007-04-28 14:18:45 +00:00
|
|
|
static int camera; /* = 0 */
|
|
|
|
module_param(camera, int, 0444);
|
|
|
|
MODULE_PARM_DESC(camera,
|
|
|
|
"set this to 1 to enable Motion Eye camera controls "
|
|
|
|
"(only use it if you have a C1VE or C1VN model)");
|
|
|
|
|
2007-05-01 02:19:53 +00:00
|
|
|
#ifdef CONFIG_SONYPI_COMPAT
|
2007-04-09 17:31:25 +00:00
|
|
|
static int minor = -1;
|
|
|
|
module_param(minor, int, 0);
|
|
|
|
MODULE_PARM_DESC(minor,
|
|
|
|
"minor number of the misc device for the SPIC compatibility code, "
|
|
|
|
"default is -1 (automatic)");
|
|
|
|
#endif
|
|
|
|
|
2011-02-19 02:52:31 +00:00
|
|
|
static int kbd_backlight; /* = 1 */
|
|
|
|
module_param(kbd_backlight, int, 0444);
|
|
|
|
MODULE_PARM_DESC(kbd_backlight,
|
|
|
|
"set this to 0 to disable keyboard backlight, "
|
|
|
|
"1 to enable it (default: 0)");
|
|
|
|
|
|
|
|
static int kbd_backlight_timeout; /* = 0 */
|
|
|
|
module_param(kbd_backlight_timeout, int, 0444);
|
|
|
|
MODULE_PARM_DESC(kbd_backlight_timeout,
|
|
|
|
"set this to 0 to set the default 10 seconds timeout, "
|
|
|
|
"1 for 30 seconds, 2 for 60 seconds and 3 to disable timeout "
|
|
|
|
"(default: 0)");
|
|
|
|
|
2009-03-26 12:58:15 +00:00
|
|
|
enum sony_nc_rfkill {
|
|
|
|
SONY_WIFI,
|
|
|
|
SONY_BLUETOOTH,
|
|
|
|
SONY_WWAN,
|
|
|
|
SONY_WIMAX,
|
2009-06-02 11:01:37 +00:00
|
|
|
N_SONY_RFKILL,
|
2009-03-26 12:58:15 +00:00
|
|
|
};
|
|
|
|
|
2009-12-16 15:08:35 +00:00
|
|
|
static int sony_rfkill_handle;
|
2009-06-02 11:01:37 +00:00
|
|
|
static struct rfkill *sony_rfkill_devices[N_SONY_RFKILL];
|
|
|
|
static int sony_rfkill_address[N_SONY_RFKILL] = {0x300, 0x500, 0x700, 0x900};
|
2009-03-26 12:58:15 +00:00
|
|
|
static void sony_nc_rfkill_update(void);
|
|
|
|
|
2007-04-09 08:19:08 +00:00
|
|
|
/*********** Input Devices ***********/
|
|
|
|
|
|
|
|
#define SONY_LAPTOP_BUF_SIZE 128
|
|
|
|
struct sony_laptop_input_s {
|
|
|
|
atomic_t users;
|
|
|
|
struct input_dev *jog_dev;
|
|
|
|
struct input_dev *key_dev;
|
kfifo: move struct kfifo in place
This is a new generic kernel FIFO implementation.
The current kernel fifo API is not very widely used, because it has to
many constrains. Only 17 files in the current 2.6.31-rc5 used it.
FIFO's are like list's a very basic thing and a kfifo API which handles
the most use case would save a lot of development time and memory
resources.
I think this are the reasons why kfifo is not in use:
- The API is to simple, important functions are missing
- A fifo can be only allocated dynamically
- There is a requirement of a spinlock whether you need it or not
- There is no support for data records inside a fifo
So I decided to extend the kfifo in a more generic way without blowing up
the API to much. The new API has the following benefits:
- Generic usage: For kernel internal use and/or device driver.
- Provide an API for the most use case.
- Slim API: The whole API provides 25 functions.
- Linux style habit.
- DECLARE_KFIFO, DEFINE_KFIFO and INIT_KFIFO Macros
- Direct copy_to_user from the fifo and copy_from_user into the fifo.
- The kfifo itself is an in place member of the using data structure, this save an
indirection access and does not waste the kernel allocator.
- Lockless access: if only one reader and one writer is active on the fifo,
which is the common use case, no additional locking is necessary.
- Remove spinlock - give the user the freedom of choice what kind of locking to use if
one is required.
- Ability to handle records. Three type of records are supported:
- Variable length records between 0-255 bytes, with a record size
field of 1 bytes.
- Variable length records between 0-65535 bytes, with a record size
field of 2 bytes.
- Fixed size records, which no record size field.
- Preserve memory resource.
- Performance!
- Easy to use!
This patch:
Since most users want to have the kfifo as part of another object,
reorganize the code to allow including struct kfifo in another data
structure. This requires changing the kfifo_alloc and kfifo_init
prototypes so that we pass an existing kfifo pointer into them. This
patch changes the implementation and all existing users.
[akpm@linux-foundation.org: fix warning]
Signed-off-by: Stefani Seibold <stefani@seibold.net>
Acked-by: Greg Kroah-Hartman <gregkh@suse.de>
Acked-by: Mauro Carvalho Chehab <mchehab@redhat.com>
Acked-by: Andi Kleen <ak@linux.intel.com>
Acked-by: Arnd Bergmann <arnd@arndb.de>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
2009-12-21 22:37:26 +00:00
|
|
|
struct kfifo fifo;
|
2007-04-09 08:19:08 +00:00
|
|
|
spinlock_t fifo_lock;
|
2009-12-24 08:02:30 +00:00
|
|
|
struct timer_list release_key_timer;
|
2007-04-09 08:19:08 +00:00
|
|
|
};
|
2009-03-26 12:58:15 +00:00
|
|
|
|
2007-04-09 08:19:08 +00:00
|
|
|
static struct sony_laptop_input_s sony_laptop_input = {
|
|
|
|
.users = ATOMIC_INIT(0),
|
|
|
|
};
|
|
|
|
|
|
|
|
struct sony_laptop_keypress {
|
|
|
|
struct input_dev *dev;
|
|
|
|
int key;
|
|
|
|
};
|
|
|
|
|
2007-07-19 17:01:57 +00:00
|
|
|
/* Correspondance table between sonypi events
|
|
|
|
* and input layer indexes in the keymap
|
|
|
|
*/
|
|
|
|
static int sony_laptop_input_index[] = {
|
2008-01-14 09:05:45 +00:00
|
|
|
-1, /* 0 no event */
|
|
|
|
-1, /* 1 SONYPI_EVENT_JOGDIAL_DOWN */
|
|
|
|
-1, /* 2 SONYPI_EVENT_JOGDIAL_UP */
|
|
|
|
-1, /* 3 SONYPI_EVENT_JOGDIAL_DOWN_PRESSED */
|
|
|
|
-1, /* 4 SONYPI_EVENT_JOGDIAL_UP_PRESSED */
|
|
|
|
-1, /* 5 SONYPI_EVENT_JOGDIAL_PRESSED */
|
|
|
|
-1, /* 6 SONYPI_EVENT_JOGDIAL_RELEASED */
|
|
|
|
0, /* 7 SONYPI_EVENT_CAPTURE_PRESSED */
|
|
|
|
1, /* 8 SONYPI_EVENT_CAPTURE_RELEASED */
|
|
|
|
2, /* 9 SONYPI_EVENT_CAPTURE_PARTIALPRESSED */
|
|
|
|
3, /* 10 SONYPI_EVENT_CAPTURE_PARTIALRELEASED */
|
|
|
|
4, /* 11 SONYPI_EVENT_FNKEY_ESC */
|
|
|
|
5, /* 12 SONYPI_EVENT_FNKEY_F1 */
|
|
|
|
6, /* 13 SONYPI_EVENT_FNKEY_F2 */
|
|
|
|
7, /* 14 SONYPI_EVENT_FNKEY_F3 */
|
|
|
|
8, /* 15 SONYPI_EVENT_FNKEY_F4 */
|
|
|
|
9, /* 16 SONYPI_EVENT_FNKEY_F5 */
|
|
|
|
10, /* 17 SONYPI_EVENT_FNKEY_F6 */
|
|
|
|
11, /* 18 SONYPI_EVENT_FNKEY_F7 */
|
|
|
|
12, /* 19 SONYPI_EVENT_FNKEY_F8 */
|
|
|
|
13, /* 20 SONYPI_EVENT_FNKEY_F9 */
|
|
|
|
14, /* 21 SONYPI_EVENT_FNKEY_F10 */
|
|
|
|
15, /* 22 SONYPI_EVENT_FNKEY_F11 */
|
|
|
|
16, /* 23 SONYPI_EVENT_FNKEY_F12 */
|
|
|
|
17, /* 24 SONYPI_EVENT_FNKEY_1 */
|
|
|
|
18, /* 25 SONYPI_EVENT_FNKEY_2 */
|
|
|
|
19, /* 26 SONYPI_EVENT_FNKEY_D */
|
|
|
|
20, /* 27 SONYPI_EVENT_FNKEY_E */
|
|
|
|
21, /* 28 SONYPI_EVENT_FNKEY_F */
|
|
|
|
22, /* 29 SONYPI_EVENT_FNKEY_S */
|
|
|
|
23, /* 30 SONYPI_EVENT_FNKEY_B */
|
|
|
|
24, /* 31 SONYPI_EVENT_BLUETOOTH_PRESSED */
|
|
|
|
25, /* 32 SONYPI_EVENT_PKEY_P1 */
|
|
|
|
26, /* 33 SONYPI_EVENT_PKEY_P2 */
|
|
|
|
27, /* 34 SONYPI_EVENT_PKEY_P3 */
|
|
|
|
28, /* 35 SONYPI_EVENT_BACK_PRESSED */
|
|
|
|
-1, /* 36 SONYPI_EVENT_LID_CLOSED */
|
|
|
|
-1, /* 37 SONYPI_EVENT_LID_OPENED */
|
|
|
|
29, /* 38 SONYPI_EVENT_BLUETOOTH_ON */
|
|
|
|
30, /* 39 SONYPI_EVENT_BLUETOOTH_OFF */
|
|
|
|
31, /* 40 SONYPI_EVENT_HELP_PRESSED */
|
|
|
|
32, /* 41 SONYPI_EVENT_FNKEY_ONLY */
|
|
|
|
33, /* 42 SONYPI_EVENT_JOGDIAL_FAST_DOWN */
|
|
|
|
34, /* 43 SONYPI_EVENT_JOGDIAL_FAST_UP */
|
|
|
|
35, /* 44 SONYPI_EVENT_JOGDIAL_FAST_DOWN_PRESSED */
|
|
|
|
36, /* 45 SONYPI_EVENT_JOGDIAL_FAST_UP_PRESSED */
|
|
|
|
37, /* 46 SONYPI_EVENT_JOGDIAL_VFAST_DOWN */
|
|
|
|
38, /* 47 SONYPI_EVENT_JOGDIAL_VFAST_UP */
|
|
|
|
39, /* 48 SONYPI_EVENT_JOGDIAL_VFAST_DOWN_PRESSED */
|
|
|
|
40, /* 49 SONYPI_EVENT_JOGDIAL_VFAST_UP_PRESSED */
|
|
|
|
41, /* 50 SONYPI_EVENT_ZOOM_PRESSED */
|
|
|
|
42, /* 51 SONYPI_EVENT_THUMBPHRASE_PRESSED */
|
|
|
|
43, /* 52 SONYPI_EVENT_MEYE_FACE */
|
|
|
|
44, /* 53 SONYPI_EVENT_MEYE_OPPOSITE */
|
|
|
|
45, /* 54 SONYPI_EVENT_MEMORYSTICK_INSERT */
|
|
|
|
46, /* 55 SONYPI_EVENT_MEMORYSTICK_EJECT */
|
|
|
|
-1, /* 56 SONYPI_EVENT_ANYBUTTON_RELEASED */
|
|
|
|
-1, /* 57 SONYPI_EVENT_BATTERY_INSERT */
|
|
|
|
-1, /* 58 SONYPI_EVENT_BATTERY_REMOVE */
|
|
|
|
-1, /* 59 SONYPI_EVENT_FNKEY_RELEASED */
|
|
|
|
47, /* 60 SONYPI_EVENT_WIRELESS_ON */
|
|
|
|
48, /* 61 SONYPI_EVENT_WIRELESS_OFF */
|
|
|
|
49, /* 62 SONYPI_EVENT_ZOOM_IN_PRESSED */
|
|
|
|
50, /* 63 SONYPI_EVENT_ZOOM_OUT_PRESSED */
|
2009-03-26 12:58:14 +00:00
|
|
|
51, /* 64 SONYPI_EVENT_CD_EJECT_PRESSED */
|
2009-03-26 12:58:16 +00:00
|
|
|
52, /* 65 SONYPI_EVENT_MODEKEY_PRESSED */
|
|
|
|
53, /* 66 SONYPI_EVENT_PKEY_P4 */
|
|
|
|
54, /* 67 SONYPI_EVENT_PKEY_P5 */
|
|
|
|
55, /* 68 SONYPI_EVENT_SETTINGKEY_PRESSED */
|
2009-03-26 12:58:18 +00:00
|
|
|
56, /* 69 SONYPI_EVENT_VOLUME_INC_PRESSED */
|
|
|
|
57, /* 70 SONYPI_EVENT_VOLUME_DEC_PRESSED */
|
|
|
|
-1, /* 71 SONYPI_EVENT_BRIGHTNESS_PRESSED */
|
2009-12-16 15:08:33 +00:00
|
|
|
58, /* 72 SONYPI_EVENT_MEDIA_PRESSED */
|
2011-01-08 09:47:29 +00:00
|
|
|
59, /* 72 SONYPI_EVENT_VENDOR_PRESSED */
|
2007-07-19 17:01:57 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
static int sony_laptop_input_keycode_map[] = {
|
|
|
|
KEY_CAMERA, /* 0 SONYPI_EVENT_CAPTURE_PRESSED */
|
|
|
|
KEY_RESERVED, /* 1 SONYPI_EVENT_CAPTURE_RELEASED */
|
|
|
|
KEY_RESERVED, /* 2 SONYPI_EVENT_CAPTURE_PARTIALPRESSED */
|
|
|
|
KEY_RESERVED, /* 3 SONYPI_EVENT_CAPTURE_PARTIALRELEASED */
|
|
|
|
KEY_FN_ESC, /* 4 SONYPI_EVENT_FNKEY_ESC */
|
|
|
|
KEY_FN_F1, /* 5 SONYPI_EVENT_FNKEY_F1 */
|
|
|
|
KEY_FN_F2, /* 6 SONYPI_EVENT_FNKEY_F2 */
|
|
|
|
KEY_FN_F3, /* 7 SONYPI_EVENT_FNKEY_F3 */
|
|
|
|
KEY_FN_F4, /* 8 SONYPI_EVENT_FNKEY_F4 */
|
|
|
|
KEY_FN_F5, /* 9 SONYPI_EVENT_FNKEY_F5 */
|
|
|
|
KEY_FN_F6, /* 10 SONYPI_EVENT_FNKEY_F6 */
|
|
|
|
KEY_FN_F7, /* 11 SONYPI_EVENT_FNKEY_F7 */
|
|
|
|
KEY_FN_F8, /* 12 SONYPI_EVENT_FNKEY_F8 */
|
|
|
|
KEY_FN_F9, /* 13 SONYPI_EVENT_FNKEY_F9 */
|
|
|
|
KEY_FN_F10, /* 14 SONYPI_EVENT_FNKEY_F10 */
|
|
|
|
KEY_FN_F11, /* 15 SONYPI_EVENT_FNKEY_F11 */
|
|
|
|
KEY_FN_F12, /* 16 SONYPI_EVENT_FNKEY_F12 */
|
|
|
|
KEY_FN_F1, /* 17 SONYPI_EVENT_FNKEY_1 */
|
|
|
|
KEY_FN_F2, /* 18 SONYPI_EVENT_FNKEY_2 */
|
|
|
|
KEY_FN_D, /* 19 SONYPI_EVENT_FNKEY_D */
|
|
|
|
KEY_FN_E, /* 20 SONYPI_EVENT_FNKEY_E */
|
|
|
|
KEY_FN_F, /* 21 SONYPI_EVENT_FNKEY_F */
|
|
|
|
KEY_FN_S, /* 22 SONYPI_EVENT_FNKEY_S */
|
|
|
|
KEY_FN_B, /* 23 SONYPI_EVENT_FNKEY_B */
|
|
|
|
KEY_BLUETOOTH, /* 24 SONYPI_EVENT_BLUETOOTH_PRESSED */
|
|
|
|
KEY_PROG1, /* 25 SONYPI_EVENT_PKEY_P1 */
|
|
|
|
KEY_PROG2, /* 26 SONYPI_EVENT_PKEY_P2 */
|
|
|
|
KEY_PROG3, /* 27 SONYPI_EVENT_PKEY_P3 */
|
|
|
|
KEY_BACK, /* 28 SONYPI_EVENT_BACK_PRESSED */
|
|
|
|
KEY_BLUETOOTH, /* 29 SONYPI_EVENT_BLUETOOTH_ON */
|
|
|
|
KEY_BLUETOOTH, /* 30 SONYPI_EVENT_BLUETOOTH_OFF */
|
|
|
|
KEY_HELP, /* 31 SONYPI_EVENT_HELP_PRESSED */
|
|
|
|
KEY_FN, /* 32 SONYPI_EVENT_FNKEY_ONLY */
|
|
|
|
KEY_RESERVED, /* 33 SONYPI_EVENT_JOGDIAL_FAST_DOWN */
|
|
|
|
KEY_RESERVED, /* 34 SONYPI_EVENT_JOGDIAL_FAST_UP */
|
|
|
|
KEY_RESERVED, /* 35 SONYPI_EVENT_JOGDIAL_FAST_DOWN_PRESSED */
|
|
|
|
KEY_RESERVED, /* 36 SONYPI_EVENT_JOGDIAL_FAST_UP_PRESSED */
|
|
|
|
KEY_RESERVED, /* 37 SONYPI_EVENT_JOGDIAL_VFAST_DOWN */
|
|
|
|
KEY_RESERVED, /* 38 SONYPI_EVENT_JOGDIAL_VFAST_UP */
|
|
|
|
KEY_RESERVED, /* 39 SONYPI_EVENT_JOGDIAL_VFAST_DOWN_PRESSED */
|
|
|
|
KEY_RESERVED, /* 40 SONYPI_EVENT_JOGDIAL_VFAST_UP_PRESSED */
|
|
|
|
KEY_ZOOM, /* 41 SONYPI_EVENT_ZOOM_PRESSED */
|
|
|
|
BTN_THUMB, /* 42 SONYPI_EVENT_THUMBPHRASE_PRESSED */
|
|
|
|
KEY_RESERVED, /* 43 SONYPI_EVENT_MEYE_FACE */
|
|
|
|
KEY_RESERVED, /* 44 SONYPI_EVENT_MEYE_OPPOSITE */
|
|
|
|
KEY_RESERVED, /* 45 SONYPI_EVENT_MEMORYSTICK_INSERT */
|
|
|
|
KEY_RESERVED, /* 46 SONYPI_EVENT_MEMORYSTICK_EJECT */
|
|
|
|
KEY_WLAN, /* 47 SONYPI_EVENT_WIRELESS_ON */
|
|
|
|
KEY_WLAN, /* 48 SONYPI_EVENT_WIRELESS_OFF */
|
2008-01-14 09:05:45 +00:00
|
|
|
KEY_ZOOMIN, /* 49 SONYPI_EVENT_ZOOM_IN_PRESSED */
|
2009-03-26 12:58:14 +00:00
|
|
|
KEY_ZOOMOUT, /* 50 SONYPI_EVENT_ZOOM_OUT_PRESSED */
|
2009-03-26 12:58:16 +00:00
|
|
|
KEY_EJECTCD, /* 51 SONYPI_EVENT_CD_EJECT_PRESSED */
|
|
|
|
KEY_F13, /* 52 SONYPI_EVENT_MODEKEY_PRESSED */
|
|
|
|
KEY_PROG4, /* 53 SONYPI_EVENT_PKEY_P4 */
|
|
|
|
KEY_F14, /* 54 SONYPI_EVENT_PKEY_P5 */
|
|
|
|
KEY_F15, /* 55 SONYPI_EVENT_SETTINGKEY_PRESSED */
|
2009-03-26 12:58:18 +00:00
|
|
|
KEY_VOLUMEUP, /* 56 SONYPI_EVENT_VOLUME_INC_PRESSED */
|
|
|
|
KEY_VOLUMEDOWN, /* 57 SONYPI_EVENT_VOLUME_DEC_PRESSED */
|
2009-12-16 15:08:33 +00:00
|
|
|
KEY_MEDIA, /* 58 SONYPI_EVENT_MEDIA_PRESSED */
|
2011-01-08 09:47:29 +00:00
|
|
|
KEY_VENDOR, /* 59 SONYPI_EVENT_VENDOR_PRESSED */
|
2007-04-09 08:19:08 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
/* release buttons after a short delay if pressed */
|
2009-12-24 08:02:30 +00:00
|
|
|
static void do_sony_laptop_release_key(unsigned long unused)
|
2007-04-09 08:19:08 +00:00
|
|
|
{
|
|
|
|
struct sony_laptop_keypress kp;
|
2009-12-24 08:02:16 +00:00
|
|
|
unsigned long flags;
|
2007-04-09 08:19:08 +00:00
|
|
|
|
2009-12-24 08:02:16 +00:00
|
|
|
spin_lock_irqsave(&sony_laptop_input.fifo_lock, flags);
|
|
|
|
|
|
|
|
if (kfifo_out(&sony_laptop_input.fifo,
|
|
|
|
(unsigned char *)&kp, sizeof(kp)) == sizeof(kp)) {
|
2007-04-09 08:19:08 +00:00
|
|
|
input_report_key(kp.dev, kp.key, 0);
|
|
|
|
input_sync(kp.dev);
|
|
|
|
}
|
2009-12-24 08:02:16 +00:00
|
|
|
|
|
|
|
/* If there is something in the fifo schedule next release. */
|
|
|
|
if (kfifo_len(&sony_laptop_input.fifo) != 0)
|
2009-12-24 08:02:30 +00:00
|
|
|
mod_timer(&sony_laptop_input.release_key_timer,
|
|
|
|
jiffies + msecs_to_jiffies(10));
|
2009-12-24 08:02:16 +00:00
|
|
|
|
|
|
|
spin_unlock_irqrestore(&sony_laptop_input.fifo_lock, flags);
|
2007-04-09 08:19:08 +00:00
|
|
|
}
|
|
|
|
|
2007-10-19 21:10:43 +00:00
|
|
|
/* forward event to the input subsystem */
|
2007-04-09 08:19:08 +00:00
|
|
|
static void sony_laptop_report_input_event(u8 event)
|
|
|
|
{
|
|
|
|
struct input_dev *jog_dev = sony_laptop_input.jog_dev;
|
|
|
|
struct input_dev *key_dev = sony_laptop_input.key_dev;
|
|
|
|
struct sony_laptop_keypress kp = { NULL };
|
|
|
|
|
2009-04-12 11:26:28 +00:00
|
|
|
if (event == SONYPI_EVENT_FNKEY_RELEASED ||
|
|
|
|
event == SONYPI_EVENT_ANYBUTTON_RELEASED) {
|
2007-04-09 08:19:08 +00:00
|
|
|
/* Nothing, not all VAIOs generate this event */
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* report events */
|
|
|
|
switch (event) {
|
|
|
|
/* jog_dev events */
|
|
|
|
case SONYPI_EVENT_JOGDIAL_UP:
|
|
|
|
case SONYPI_EVENT_JOGDIAL_UP_PRESSED:
|
|
|
|
input_report_rel(jog_dev, REL_WHEEL, 1);
|
|
|
|
input_sync(jog_dev);
|
|
|
|
return;
|
|
|
|
|
|
|
|
case SONYPI_EVENT_JOGDIAL_DOWN:
|
|
|
|
case SONYPI_EVENT_JOGDIAL_DOWN_PRESSED:
|
|
|
|
input_report_rel(jog_dev, REL_WHEEL, -1);
|
|
|
|
input_sync(jog_dev);
|
|
|
|
return;
|
|
|
|
|
|
|
|
/* key_dev events */
|
|
|
|
case SONYPI_EVENT_JOGDIAL_PRESSED:
|
|
|
|
kp.key = BTN_MIDDLE;
|
|
|
|
kp.dev = jog_dev;
|
|
|
|
break;
|
|
|
|
|
|
|
|
default:
|
2008-02-19 22:59:03 +00:00
|
|
|
if (event >= ARRAY_SIZE(sony_laptop_input_index)) {
|
2007-07-19 17:01:57 +00:00
|
|
|
dprintk("sony_laptop_report_input_event, event not known: %d\n", event);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
if (sony_laptop_input_index[event] != -1) {
|
|
|
|
kp.key = sony_laptop_input_keycode_map[sony_laptop_input_index[event]];
|
|
|
|
if (kp.key != KEY_UNKNOWN)
|
2007-04-09 08:19:08 +00:00
|
|
|
kp.dev = key_dev;
|
2007-07-19 17:01:57 +00:00
|
|
|
}
|
2007-04-09 08:19:08 +00:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (kp.dev) {
|
|
|
|
input_report_key(kp.dev, kp.key, 1);
|
2007-07-19 17:01:57 +00:00
|
|
|
/* we emit the scancode so we can always remap the key */
|
|
|
|
input_event(kp.dev, EV_MSC, MSC_SCAN, event);
|
2007-04-09 08:19:08 +00:00
|
|
|
input_sync(kp.dev);
|
|
|
|
|
2009-12-24 08:02:16 +00:00
|
|
|
/* schedule key release */
|
|
|
|
kfifo_in_locked(&sony_laptop_input.fifo,
|
|
|
|
(unsigned char *)&kp, sizeof(kp),
|
|
|
|
&sony_laptop_input.fifo_lock);
|
2009-12-24 08:02:30 +00:00
|
|
|
mod_timer(&sony_laptop_input.release_key_timer,
|
|
|
|
jiffies + msecs_to_jiffies(10));
|
2007-04-09 08:19:08 +00:00
|
|
|
} else
|
|
|
|
dprintk("unknown input event %.2x\n", event);
|
|
|
|
}
|
|
|
|
|
2007-11-21 19:15:53 +00:00
|
|
|
static int sony_laptop_setup_input(struct acpi_device *acpi_device)
|
2007-04-09 08:19:08 +00:00
|
|
|
{
|
|
|
|
struct input_dev *jog_dev;
|
|
|
|
struct input_dev *key_dev;
|
|
|
|
int i;
|
|
|
|
int error;
|
|
|
|
|
|
|
|
/* don't run again if already initialized */
|
|
|
|
if (atomic_add_return(1, &sony_laptop_input.users) > 1)
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
/* kfifo */
|
|
|
|
spin_lock_init(&sony_laptop_input.fifo_lock);
|
2009-12-24 08:02:16 +00:00
|
|
|
error = kfifo_alloc(&sony_laptop_input.fifo,
|
|
|
|
SONY_LAPTOP_BUF_SIZE, GFP_KERNEL);
|
kfifo: move struct kfifo in place
This is a new generic kernel FIFO implementation.
The current kernel fifo API is not very widely used, because it has to
many constrains. Only 17 files in the current 2.6.31-rc5 used it.
FIFO's are like list's a very basic thing and a kfifo API which handles
the most use case would save a lot of development time and memory
resources.
I think this are the reasons why kfifo is not in use:
- The API is to simple, important functions are missing
- A fifo can be only allocated dynamically
- There is a requirement of a spinlock whether you need it or not
- There is no support for data records inside a fifo
So I decided to extend the kfifo in a more generic way without blowing up
the API to much. The new API has the following benefits:
- Generic usage: For kernel internal use and/or device driver.
- Provide an API for the most use case.
- Slim API: The whole API provides 25 functions.
- Linux style habit.
- DECLARE_KFIFO, DEFINE_KFIFO and INIT_KFIFO Macros
- Direct copy_to_user from the fifo and copy_from_user into the fifo.
- The kfifo itself is an in place member of the using data structure, this save an
indirection access and does not waste the kernel allocator.
- Lockless access: if only one reader and one writer is active on the fifo,
which is the common use case, no additional locking is necessary.
- Remove spinlock - give the user the freedom of choice what kind of locking to use if
one is required.
- Ability to handle records. Three type of records are supported:
- Variable length records between 0-255 bytes, with a record size
field of 1 bytes.
- Variable length records between 0-65535 bytes, with a record size
field of 2 bytes.
- Fixed size records, which no record size field.
- Preserve memory resource.
- Performance!
- Easy to use!
This patch:
Since most users want to have the kfifo as part of another object,
reorganize the code to allow including struct kfifo in another data
structure. This requires changing the kfifo_alloc and kfifo_init
prototypes so that we pass an existing kfifo pointer into them. This
patch changes the implementation and all existing users.
[akpm@linux-foundation.org: fix warning]
Signed-off-by: Stefani Seibold <stefani@seibold.net>
Acked-by: Greg Kroah-Hartman <gregkh@suse.de>
Acked-by: Mauro Carvalho Chehab <mchehab@redhat.com>
Acked-by: Andi Kleen <ak@linux.intel.com>
Acked-by: Arnd Bergmann <arnd@arndb.de>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
2009-12-21 22:37:26 +00:00
|
|
|
if (error) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_err(DRV_PFX "kfifo_alloc failed\n");
|
2007-04-09 08:19:08 +00:00
|
|
|
goto err_dec_users;
|
|
|
|
}
|
|
|
|
|
2009-12-24 08:02:30 +00:00
|
|
|
setup_timer(&sony_laptop_input.release_key_timer,
|
|
|
|
do_sony_laptop_release_key, 0);
|
2007-04-09 08:19:08 +00:00
|
|
|
|
|
|
|
/* input keys */
|
|
|
|
key_dev = input_allocate_device();
|
|
|
|
if (!key_dev) {
|
|
|
|
error = -ENOMEM;
|
2009-12-24 08:02:16 +00:00
|
|
|
goto err_free_kfifo;
|
2007-04-09 08:19:08 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
key_dev->name = "Sony Vaio Keys";
|
|
|
|
key_dev->id.bustype = BUS_ISA;
|
|
|
|
key_dev->id.vendor = PCI_VENDOR_ID_SONY;
|
2007-11-21 19:15:53 +00:00
|
|
|
key_dev->dev.parent = &acpi_device->dev;
|
2007-04-09 08:19:08 +00:00
|
|
|
|
|
|
|
/* Initialize the Input Drivers: special keys */
|
2009-12-24 08:02:23 +00:00
|
|
|
input_set_capability(key_dev, EV_MSC, MSC_SCAN);
|
|
|
|
|
|
|
|
__set_bit(EV_KEY, key_dev->evbit);
|
2007-07-19 17:01:57 +00:00
|
|
|
key_dev->keycodesize = sizeof(sony_laptop_input_keycode_map[0]);
|
|
|
|
key_dev->keycodemax = ARRAY_SIZE(sony_laptop_input_keycode_map);
|
|
|
|
key_dev->keycode = &sony_laptop_input_keycode_map;
|
2009-12-24 08:02:23 +00:00
|
|
|
for (i = 0; i < ARRAY_SIZE(sony_laptop_input_keycode_map); i++)
|
|
|
|
__set_bit(sony_laptop_input_keycode_map[i], key_dev->keybit);
|
|
|
|
__clear_bit(KEY_RESERVED, key_dev->keybit);
|
2007-04-09 08:19:08 +00:00
|
|
|
|
|
|
|
error = input_register_device(key_dev);
|
|
|
|
if (error)
|
|
|
|
goto err_free_keydev;
|
|
|
|
|
|
|
|
sony_laptop_input.key_dev = key_dev;
|
|
|
|
|
|
|
|
/* jogdial */
|
|
|
|
jog_dev = input_allocate_device();
|
|
|
|
if (!jog_dev) {
|
|
|
|
error = -ENOMEM;
|
|
|
|
goto err_unregister_keydev;
|
|
|
|
}
|
|
|
|
|
|
|
|
jog_dev->name = "Sony Vaio Jogdial";
|
|
|
|
jog_dev->id.bustype = BUS_ISA;
|
|
|
|
jog_dev->id.vendor = PCI_VENDOR_ID_SONY;
|
2007-11-21 19:15:53 +00:00
|
|
|
key_dev->dev.parent = &acpi_device->dev;
|
2007-04-09 08:19:08 +00:00
|
|
|
|
2009-12-24 08:02:23 +00:00
|
|
|
input_set_capability(jog_dev, EV_KEY, BTN_MIDDLE);
|
|
|
|
input_set_capability(jog_dev, EV_REL, REL_WHEEL);
|
2007-04-09 08:19:08 +00:00
|
|
|
|
|
|
|
error = input_register_device(jog_dev);
|
|
|
|
if (error)
|
|
|
|
goto err_free_jogdev;
|
|
|
|
|
|
|
|
sony_laptop_input.jog_dev = jog_dev;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
err_free_jogdev:
|
|
|
|
input_free_device(jog_dev);
|
|
|
|
|
|
|
|
err_unregister_keydev:
|
|
|
|
input_unregister_device(key_dev);
|
|
|
|
/* to avoid kref underflow below at input_free_device */
|
|
|
|
key_dev = NULL;
|
|
|
|
|
|
|
|
err_free_keydev:
|
|
|
|
input_free_device(key_dev);
|
|
|
|
|
|
|
|
err_free_kfifo:
|
kfifo: move struct kfifo in place
This is a new generic kernel FIFO implementation.
The current kernel fifo API is not very widely used, because it has to
many constrains. Only 17 files in the current 2.6.31-rc5 used it.
FIFO's are like list's a very basic thing and a kfifo API which handles
the most use case would save a lot of development time and memory
resources.
I think this are the reasons why kfifo is not in use:
- The API is to simple, important functions are missing
- A fifo can be only allocated dynamically
- There is a requirement of a spinlock whether you need it or not
- There is no support for data records inside a fifo
So I decided to extend the kfifo in a more generic way without blowing up
the API to much. The new API has the following benefits:
- Generic usage: For kernel internal use and/or device driver.
- Provide an API for the most use case.
- Slim API: The whole API provides 25 functions.
- Linux style habit.
- DECLARE_KFIFO, DEFINE_KFIFO and INIT_KFIFO Macros
- Direct copy_to_user from the fifo and copy_from_user into the fifo.
- The kfifo itself is an in place member of the using data structure, this save an
indirection access and does not waste the kernel allocator.
- Lockless access: if only one reader and one writer is active on the fifo,
which is the common use case, no additional locking is necessary.
- Remove spinlock - give the user the freedom of choice what kind of locking to use if
one is required.
- Ability to handle records. Three type of records are supported:
- Variable length records between 0-255 bytes, with a record size
field of 1 bytes.
- Variable length records between 0-65535 bytes, with a record size
field of 2 bytes.
- Fixed size records, which no record size field.
- Preserve memory resource.
- Performance!
- Easy to use!
This patch:
Since most users want to have the kfifo as part of another object,
reorganize the code to allow including struct kfifo in another data
structure. This requires changing the kfifo_alloc and kfifo_init
prototypes so that we pass an existing kfifo pointer into them. This
patch changes the implementation and all existing users.
[akpm@linux-foundation.org: fix warning]
Signed-off-by: Stefani Seibold <stefani@seibold.net>
Acked-by: Greg Kroah-Hartman <gregkh@suse.de>
Acked-by: Mauro Carvalho Chehab <mchehab@redhat.com>
Acked-by: Andi Kleen <ak@linux.intel.com>
Acked-by: Arnd Bergmann <arnd@arndb.de>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
2009-12-21 22:37:26 +00:00
|
|
|
kfifo_free(&sony_laptop_input.fifo);
|
2007-04-09 08:19:08 +00:00
|
|
|
|
|
|
|
err_dec_users:
|
|
|
|
atomic_dec(&sony_laptop_input.users);
|
|
|
|
return error;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void sony_laptop_remove_input(void)
|
|
|
|
{
|
2009-12-24 08:02:16 +00:00
|
|
|
struct sony_laptop_keypress kp = { NULL };
|
|
|
|
|
|
|
|
/* Cleanup only after the last user has gone */
|
2007-04-09 08:19:08 +00:00
|
|
|
if (!atomic_dec_and_test(&sony_laptop_input.users))
|
|
|
|
return;
|
|
|
|
|
2009-12-24 08:02:30 +00:00
|
|
|
del_timer_sync(&sony_laptop_input.release_key_timer);
|
2009-12-24 08:02:16 +00:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Generate key-up events for remaining keys. Note that we don't
|
|
|
|
* need locking since nobody is adding new events to the kfifo.
|
|
|
|
*/
|
|
|
|
while (kfifo_out(&sony_laptop_input.fifo,
|
|
|
|
(unsigned char *)&kp, sizeof(kp)) == sizeof(kp)) {
|
|
|
|
input_report_key(kp.dev, kp.key, 0);
|
|
|
|
input_sync(kp.dev);
|
|
|
|
}
|
2007-04-09 08:19:08 +00:00
|
|
|
|
|
|
|
/* destroy input devs */
|
|
|
|
input_unregister_device(sony_laptop_input.key_dev);
|
|
|
|
sony_laptop_input.key_dev = NULL;
|
|
|
|
|
|
|
|
if (sony_laptop_input.jog_dev) {
|
|
|
|
input_unregister_device(sony_laptop_input.jog_dev);
|
|
|
|
sony_laptop_input.jog_dev = NULL;
|
|
|
|
}
|
|
|
|
|
kfifo: move struct kfifo in place
This is a new generic kernel FIFO implementation.
The current kernel fifo API is not very widely used, because it has to
many constrains. Only 17 files in the current 2.6.31-rc5 used it.
FIFO's are like list's a very basic thing and a kfifo API which handles
the most use case would save a lot of development time and memory
resources.
I think this are the reasons why kfifo is not in use:
- The API is to simple, important functions are missing
- A fifo can be only allocated dynamically
- There is a requirement of a spinlock whether you need it or not
- There is no support for data records inside a fifo
So I decided to extend the kfifo in a more generic way without blowing up
the API to much. The new API has the following benefits:
- Generic usage: For kernel internal use and/or device driver.
- Provide an API for the most use case.
- Slim API: The whole API provides 25 functions.
- Linux style habit.
- DECLARE_KFIFO, DEFINE_KFIFO and INIT_KFIFO Macros
- Direct copy_to_user from the fifo and copy_from_user into the fifo.
- The kfifo itself is an in place member of the using data structure, this save an
indirection access and does not waste the kernel allocator.
- Lockless access: if only one reader and one writer is active on the fifo,
which is the common use case, no additional locking is necessary.
- Remove spinlock - give the user the freedom of choice what kind of locking to use if
one is required.
- Ability to handle records. Three type of records are supported:
- Variable length records between 0-255 bytes, with a record size
field of 1 bytes.
- Variable length records between 0-65535 bytes, with a record size
field of 2 bytes.
- Fixed size records, which no record size field.
- Preserve memory resource.
- Performance!
- Easy to use!
This patch:
Since most users want to have the kfifo as part of another object,
reorganize the code to allow including struct kfifo in another data
structure. This requires changing the kfifo_alloc and kfifo_init
prototypes so that we pass an existing kfifo pointer into them. This
patch changes the implementation and all existing users.
[akpm@linux-foundation.org: fix warning]
Signed-off-by: Stefani Seibold <stefani@seibold.net>
Acked-by: Greg Kroah-Hartman <gregkh@suse.de>
Acked-by: Mauro Carvalho Chehab <mchehab@redhat.com>
Acked-by: Andi Kleen <ak@linux.intel.com>
Acked-by: Arnd Bergmann <arnd@arndb.de>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
2009-12-21 22:37:26 +00:00
|
|
|
kfifo_free(&sony_laptop_input.fifo);
|
2007-04-09 08:19:08 +00:00
|
|
|
}
|
|
|
|
|
2007-04-09 08:19:05 +00:00
|
|
|
/*********** Platform Device ***********/
|
|
|
|
|
|
|
|
static atomic_t sony_pf_users = ATOMIC_INIT(0);
|
|
|
|
static struct platform_driver sony_pf_driver = {
|
|
|
|
.driver = {
|
|
|
|
.name = "sony-laptop",
|
|
|
|
.owner = THIS_MODULE,
|
|
|
|
}
|
|
|
|
};
|
|
|
|
static struct platform_device *sony_pf_device;
|
|
|
|
|
|
|
|
static int sony_pf_add(void)
|
|
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
|
|
|
|
/* don't run again if already initialized */
|
|
|
|
if (atomic_add_return(1, &sony_pf_users) > 1)
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
ret = platform_driver_register(&sony_pf_driver);
|
|
|
|
if (ret)
|
|
|
|
goto out;
|
|
|
|
|
|
|
|
sony_pf_device = platform_device_alloc("sony-laptop", -1);
|
|
|
|
if (!sony_pf_device) {
|
|
|
|
ret = -ENOMEM;
|
|
|
|
goto out_platform_registered;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = platform_device_add(sony_pf_device);
|
|
|
|
if (ret)
|
|
|
|
goto out_platform_alloced;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
out_platform_alloced:
|
|
|
|
platform_device_put(sony_pf_device);
|
|
|
|
sony_pf_device = NULL;
|
|
|
|
out_platform_registered:
|
|
|
|
platform_driver_unregister(&sony_pf_driver);
|
|
|
|
out:
|
|
|
|
atomic_dec(&sony_pf_users);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void sony_pf_remove(void)
|
|
|
|
{
|
|
|
|
/* deregister only after the last user has gone */
|
|
|
|
if (!atomic_dec_and_test(&sony_pf_users))
|
|
|
|
return;
|
|
|
|
|
2010-07-01 02:18:01 +00:00
|
|
|
platform_device_unregister(sony_pf_device);
|
2007-04-09 08:19:05 +00:00
|
|
|
platform_driver_unregister(&sony_pf_driver);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*********** SNC (SNY5001) Device ***********/
|
|
|
|
|
2007-04-09 17:26:03 +00:00
|
|
|
/* the device uses 1-based values, while the backlight subsystem uses
|
|
|
|
0-based values */
|
|
|
|
#define SONY_MAX_BRIGHTNESS 8
|
|
|
|
|
|
|
|
#define SNC_VALIDATE_IN 0
|
|
|
|
#define SNC_VALIDATE_OUT 1
|
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
static ssize_t sony_nc_sysfs_show(struct device *, struct device_attribute *,
|
2007-02-07 20:34:02 +00:00
|
|
|
char *);
|
2007-04-09 08:19:04 +00:00
|
|
|
static ssize_t sony_nc_sysfs_store(struct device *, struct device_attribute *,
|
2007-02-07 20:34:02 +00:00
|
|
|
const char *, size_t);
|
2007-02-12 21:01:07 +00:00
|
|
|
static int boolean_validate(const int, const int);
|
|
|
|
static int brightness_default_validate(const int, const int);
|
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
struct sony_nc_value {
|
2007-02-07 20:34:02 +00:00
|
|
|
char *name; /* name of the entry */
|
|
|
|
char **acpiget; /* names of the ACPI get function */
|
|
|
|
char **acpiset; /* names of the ACPI set function */
|
2007-02-12 21:01:07 +00:00
|
|
|
int (*validate)(const int, const int); /* input/output validation */
|
2007-02-07 20:34:02 +00:00
|
|
|
int value; /* current setting */
|
|
|
|
int valid; /* Has ever been set */
|
|
|
|
int debug; /* active only in debug mode ? */
|
|
|
|
struct device_attribute devattr; /* sysfs atribute */
|
2007-02-07 19:01:54 +00:00
|
|
|
};
|
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
#define SNC_HANDLE_NAMES(_name, _values...) \
|
2007-02-07 19:01:54 +00:00
|
|
|
static char *snc_##_name[] = { _values, NULL }
|
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
#define SNC_HANDLE(_name, _getters, _setters, _validate, _debug) \
|
2007-02-07 19:01:54 +00:00
|
|
|
{ \
|
|
|
|
.name = __stringify(_name), \
|
|
|
|
.acpiget = _getters, \
|
|
|
|
.acpiset = _setters, \
|
2007-02-12 21:01:07 +00:00
|
|
|
.validate = _validate, \
|
2007-02-07 19:01:54 +00:00
|
|
|
.debug = _debug, \
|
2007-04-09 08:19:04 +00:00
|
|
|
.devattr = __ATTR(_name, 0, sony_nc_sysfs_show, sony_nc_sysfs_store), \
|
2007-01-13 22:04:31 +00:00
|
|
|
}
|
2007-02-07 19:01:54 +00:00
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
#define SNC_HANDLE_NULL { .name = NULL }
|
2007-02-07 19:01:54 +00:00
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
SNC_HANDLE_NAMES(fnkey_get, "GHKE");
|
2007-02-07 19:01:54 +00:00
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
SNC_HANDLE_NAMES(brightness_def_get, "GPBR");
|
|
|
|
SNC_HANDLE_NAMES(brightness_def_set, "SPBR");
|
2007-02-07 19:01:54 +00:00
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
SNC_HANDLE_NAMES(cdpower_get, "GCDP");
|
|
|
|
SNC_HANDLE_NAMES(cdpower_set, "SCDP", "CDPW");
|
2007-02-07 19:01:54 +00:00
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
SNC_HANDLE_NAMES(audiopower_get, "GAZP");
|
|
|
|
SNC_HANDLE_NAMES(audiopower_set, "AZPW");
|
2007-02-07 19:01:54 +00:00
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
SNC_HANDLE_NAMES(lanpower_get, "GLNP");
|
|
|
|
SNC_HANDLE_NAMES(lanpower_set, "LNPW");
|
2007-02-07 19:01:54 +00:00
|
|
|
|
2007-07-15 17:34:33 +00:00
|
|
|
SNC_HANDLE_NAMES(lidstate_get, "GLID");
|
|
|
|
|
|
|
|
SNC_HANDLE_NAMES(indicatorlamp_get, "GILS");
|
|
|
|
SNC_HANDLE_NAMES(indicatorlamp_set, "SILS");
|
|
|
|
|
|
|
|
SNC_HANDLE_NAMES(gainbass_get, "GMGB");
|
|
|
|
SNC_HANDLE_NAMES(gainbass_set, "CMGB");
|
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
SNC_HANDLE_NAMES(PID_get, "GPID");
|
2007-02-07 19:01:54 +00:00
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
SNC_HANDLE_NAMES(CTR_get, "GCTR");
|
|
|
|
SNC_HANDLE_NAMES(CTR_set, "SCTR");
|
2007-02-07 19:01:54 +00:00
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
SNC_HANDLE_NAMES(PCR_get, "GPCR");
|
|
|
|
SNC_HANDLE_NAMES(PCR_set, "SPCR");
|
2007-02-07 19:01:54 +00:00
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
SNC_HANDLE_NAMES(CMI_get, "GCMI");
|
|
|
|
SNC_HANDLE_NAMES(CMI_set, "SCMI");
|
2007-02-07 19:01:54 +00:00
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
static struct sony_nc_value sony_nc_values[] = {
|
|
|
|
SNC_HANDLE(brightness_default, snc_brightness_def_get,
|
2007-02-12 21:01:07 +00:00
|
|
|
snc_brightness_def_set, brightness_default_validate, 0),
|
2007-04-09 08:19:04 +00:00
|
|
|
SNC_HANDLE(fnkey, snc_fnkey_get, NULL, NULL, 0),
|
|
|
|
SNC_HANDLE(cdpower, snc_cdpower_get, snc_cdpower_set, boolean_validate, 0),
|
|
|
|
SNC_HANDLE(audiopower, snc_audiopower_get, snc_audiopower_set,
|
2007-02-12 21:01:07 +00:00
|
|
|
boolean_validate, 0),
|
2007-04-09 08:19:04 +00:00
|
|
|
SNC_HANDLE(lanpower, snc_lanpower_get, snc_lanpower_set,
|
2007-02-12 21:01:07 +00:00
|
|
|
boolean_validate, 1),
|
2007-07-15 17:34:33 +00:00
|
|
|
SNC_HANDLE(lidstate, snc_lidstate_get, NULL,
|
|
|
|
boolean_validate, 0),
|
|
|
|
SNC_HANDLE(indicatorlamp, snc_indicatorlamp_get, snc_indicatorlamp_set,
|
|
|
|
boolean_validate, 0),
|
|
|
|
SNC_HANDLE(gainbass, snc_gainbass_get, snc_gainbass_set,
|
|
|
|
boolean_validate, 0),
|
2007-02-07 19:01:54 +00:00
|
|
|
/* unknown methods */
|
2007-04-09 08:19:04 +00:00
|
|
|
SNC_HANDLE(PID, snc_PID_get, NULL, NULL, 1),
|
|
|
|
SNC_HANDLE(CTR, snc_CTR_get, snc_CTR_set, NULL, 1),
|
|
|
|
SNC_HANDLE(PCR, snc_PCR_get, snc_PCR_set, NULL, 1),
|
|
|
|
SNC_HANDLE(CMI, snc_CMI_get, snc_CMI_set, NULL, 1),
|
|
|
|
SNC_HANDLE_NULL
|
2007-01-13 22:04:31 +00:00
|
|
|
};
|
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
static acpi_handle sony_nc_acpi_handle;
|
|
|
|
static struct acpi_device *sony_nc_acpi_device = NULL;
|
2007-02-07 19:01:54 +00:00
|
|
|
|
2007-02-07 19:01:56 +00:00
|
|
|
/*
|
|
|
|
* acpi_evaluate_object wrappers
|
|
|
|
*/
|
2007-01-13 22:04:31 +00:00
|
|
|
static int acpi_callgetfunc(acpi_handle handle, char *name, int *result)
|
|
|
|
{
|
|
|
|
struct acpi_buffer output;
|
|
|
|
union acpi_object out_obj;
|
|
|
|
acpi_status status;
|
|
|
|
|
|
|
|
output.length = sizeof(out_obj);
|
|
|
|
output.pointer = &out_obj;
|
|
|
|
|
|
|
|
status = acpi_evaluate_object(handle, name, NULL, &output);
|
|
|
|
if ((status == AE_OK) && (out_obj.type == ACPI_TYPE_INTEGER)) {
|
|
|
|
*result = out_obj.integer.value;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_warn(DRV_PFX "acpi_callreadfunc failed\n");
|
2007-01-13 22:04:31 +00:00
|
|
|
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int acpi_callsetfunc(acpi_handle handle, char *name, int value,
|
|
|
|
int *result)
|
|
|
|
{
|
|
|
|
struct acpi_object_list params;
|
|
|
|
union acpi_object in_obj;
|
|
|
|
struct acpi_buffer output;
|
|
|
|
union acpi_object out_obj;
|
|
|
|
acpi_status status;
|
|
|
|
|
|
|
|
params.count = 1;
|
|
|
|
params.pointer = &in_obj;
|
|
|
|
in_obj.type = ACPI_TYPE_INTEGER;
|
|
|
|
in_obj.integer.value = value;
|
|
|
|
|
|
|
|
output.length = sizeof(out_obj);
|
|
|
|
output.pointer = &out_obj;
|
|
|
|
|
|
|
|
status = acpi_evaluate_object(handle, name, ¶ms, &output);
|
|
|
|
if (status == AE_OK) {
|
|
|
|
if (result != NULL) {
|
|
|
|
if (out_obj.type != ACPI_TYPE_INTEGER) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_warn(DRV_PFX "acpi_evaluate_object bad "
|
2007-01-13 22:04:31 +00:00
|
|
|
"return type\n");
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
*result = out_obj.integer.value;
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_warn(DRV_PFX "acpi_evaluate_object failed\n");
|
2007-01-13 22:04:31 +00:00
|
|
|
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
2011-02-19 02:52:30 +00:00
|
|
|
struct sony_nc_handles {
|
|
|
|
u16 cap[0x10];
|
|
|
|
struct device_attribute devattr;
|
|
|
|
};
|
|
|
|
|
2011-02-26 12:54:27 +00:00
|
|
|
static struct sony_nc_handles *handles;
|
2011-02-19 02:52:30 +00:00
|
|
|
|
|
|
|
static ssize_t sony_nc_handles_show(struct device *dev,
|
|
|
|
struct device_attribute *attr, char *buffer)
|
|
|
|
{
|
|
|
|
ssize_t len = 0;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
for (i = 0; i < ARRAY_SIZE(handles->cap); i++) {
|
|
|
|
len += snprintf(buffer + len, PAGE_SIZE - len, "0x%.4x ",
|
|
|
|
handles->cap[i]);
|
|
|
|
}
|
|
|
|
len += snprintf(buffer + len, PAGE_SIZE - len, "\n");
|
|
|
|
|
|
|
|
return len;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int sony_nc_handles_setup(struct platform_device *pd)
|
2009-03-26 12:58:12 +00:00
|
|
|
{
|
|
|
|
int i;
|
|
|
|
int result;
|
|
|
|
|
2011-02-19 02:52:30 +00:00
|
|
|
handles = kzalloc(sizeof(*handles), GFP_KERNEL);
|
|
|
|
|
|
|
|
sysfs_attr_init(&handles->devattr.attr);
|
|
|
|
handles->devattr.attr.name = "handles";
|
|
|
|
handles->devattr.attr.mode = S_IRUGO;
|
|
|
|
handles->devattr.show = sony_nc_handles_show;
|
|
|
|
|
|
|
|
for (i = 0; i < ARRAY_SIZE(handles->cap); i++) {
|
|
|
|
if (!acpi_callsetfunc(sony_nc_acpi_handle,
|
|
|
|
"SN00", i + 0x20, &result)) {
|
|
|
|
dprintk("caching handle 0x%.4x (offset: 0x%.2x)\n",
|
|
|
|
result, i);
|
|
|
|
handles->cap[i] = result;
|
2011-02-19 02:52:25 +00:00
|
|
|
}
|
2009-03-26 12:58:12 +00:00
|
|
|
}
|
|
|
|
|
2011-02-19 02:52:30 +00:00
|
|
|
/* allow reading capabilities via sysfs */
|
|
|
|
if (device_create_file(&pd->dev, &handles->devattr)) {
|
|
|
|
kfree(handles);
|
|
|
|
handles = NULL;
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int sony_nc_handles_cleanup(struct platform_device *pd)
|
|
|
|
{
|
|
|
|
if (handles) {
|
|
|
|
device_remove_file(&pd->dev, &handles->devattr);
|
|
|
|
kfree(handles);
|
|
|
|
handles = NULL;
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int sony_find_snc_handle(int handle)
|
|
|
|
{
|
|
|
|
int i;
|
|
|
|
for (i = 0; i < 0x10; i++) {
|
|
|
|
if (handles->cap[i] == handle) {
|
|
|
|
dprintk("found handle 0x%.4x (offset: 0x%.2x)\n",
|
|
|
|
handle, i);
|
|
|
|
return i;
|
|
|
|
}
|
|
|
|
}
|
2011-02-19 02:52:25 +00:00
|
|
|
dprintk("handle 0x%.4x not found\n", handle);
|
2009-03-26 12:58:12 +00:00
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int sony_call_snc_handle(int handle, int argument, int *result)
|
|
|
|
{
|
2011-02-19 02:52:25 +00:00
|
|
|
int ret = 0;
|
2009-03-26 12:58:12 +00:00
|
|
|
int offset = sony_find_snc_handle(handle);
|
|
|
|
|
|
|
|
if (offset < 0)
|
|
|
|
return -1;
|
|
|
|
|
2011-02-19 02:52:25 +00:00
|
|
|
ret = acpi_callsetfunc(sony_nc_acpi_handle, "SN07", offset | argument,
|
|
|
|
result);
|
|
|
|
dprintk("called SN07 with 0x%.4x (result: 0x%.4x)\n", offset | argument,
|
|
|
|
*result);
|
|
|
|
return ret;
|
2009-03-26 12:58:12 +00:00
|
|
|
}
|
|
|
|
|
2007-02-12 21:01:07 +00:00
|
|
|
/*
|
2007-04-09 08:19:04 +00:00
|
|
|
* sony_nc_values input/output validate functions
|
2007-02-12 21:01:07 +00:00
|
|
|
*/
|
|
|
|
|
|
|
|
/* brightness_default_validate:
|
|
|
|
*
|
|
|
|
* manipulate input output values to keep consistency with the
|
|
|
|
* backlight framework for which brightness values are 0-based.
|
|
|
|
*/
|
|
|
|
static int brightness_default_validate(const int direction, const int value)
|
|
|
|
{
|
|
|
|
switch (direction) {
|
|
|
|
case SNC_VALIDATE_OUT:
|
|
|
|
return value - 1;
|
|
|
|
case SNC_VALIDATE_IN:
|
|
|
|
if (value >= 0 && value < SONY_MAX_BRIGHTNESS)
|
|
|
|
return value + 1;
|
|
|
|
}
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* boolean_validate:
|
|
|
|
*
|
|
|
|
* on input validate boolean values 0/1, on output just pass the
|
|
|
|
* received value.
|
|
|
|
*/
|
|
|
|
static int boolean_validate(const int direction, const int value)
|
|
|
|
{
|
|
|
|
if (direction == SNC_VALIDATE_IN) {
|
|
|
|
if (value != 0 && value != 1)
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
return value;
|
|
|
|
}
|
|
|
|
|
2007-02-07 19:01:54 +00:00
|
|
|
/*
|
2007-04-09 08:19:04 +00:00
|
|
|
* Sysfs show/store common to all sony_nc_values
|
2007-02-07 19:01:54 +00:00
|
|
|
*/
|
2007-04-09 08:19:04 +00:00
|
|
|
static ssize_t sony_nc_sysfs_show(struct device *dev, struct device_attribute *attr,
|
2007-02-07 20:34:02 +00:00
|
|
|
char *buffer)
|
2007-01-13 22:04:31 +00:00
|
|
|
{
|
|
|
|
int value;
|
2007-04-09 08:19:04 +00:00
|
|
|
struct sony_nc_value *item =
|
|
|
|
container_of(attr, struct sony_nc_value, devattr);
|
2007-01-13 22:04:31 +00:00
|
|
|
|
2007-02-07 19:01:54 +00:00
|
|
|
if (!*item->acpiget)
|
2007-01-13 22:04:31 +00:00
|
|
|
return -EIO;
|
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
if (acpi_callgetfunc(sony_nc_acpi_handle, *item->acpiget, &value) < 0)
|
2007-01-13 22:04:31 +00:00
|
|
|
return -EIO;
|
|
|
|
|
2007-02-12 21:01:07 +00:00
|
|
|
if (item->validate)
|
|
|
|
value = item->validate(SNC_VALIDATE_OUT, value);
|
|
|
|
|
2007-02-07 19:01:54 +00:00
|
|
|
return snprintf(buffer, PAGE_SIZE, "%d\n", value);
|
2007-01-13 22:04:31 +00:00
|
|
|
}
|
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
static ssize_t sony_nc_sysfs_store(struct device *dev,
|
2007-02-07 20:34:02 +00:00
|
|
|
struct device_attribute *attr,
|
|
|
|
const char *buffer, size_t count)
|
2007-01-13 22:04:31 +00:00
|
|
|
{
|
|
|
|
int value;
|
2007-04-09 08:19:04 +00:00
|
|
|
struct sony_nc_value *item =
|
|
|
|
container_of(attr, struct sony_nc_value, devattr);
|
2007-01-13 22:04:31 +00:00
|
|
|
|
|
|
|
if (!item->acpiset)
|
|
|
|
return -EIO;
|
|
|
|
|
2007-02-07 19:01:54 +00:00
|
|
|
if (count > 31)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
value = simple_strtoul(buffer, NULL, 10);
|
2007-01-13 22:04:31 +00:00
|
|
|
|
2007-02-12 21:01:07 +00:00
|
|
|
if (item->validate)
|
|
|
|
value = item->validate(SNC_VALIDATE_IN, value);
|
|
|
|
|
|
|
|
if (value < 0)
|
|
|
|
return value;
|
2007-01-13 22:04:31 +00:00
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
if (acpi_callsetfunc(sony_nc_acpi_handle, *item->acpiset, value, NULL) < 0)
|
2007-01-13 22:04:31 +00:00
|
|
|
return -EIO;
|
2007-01-13 22:04:32 +00:00
|
|
|
item->value = value;
|
|
|
|
item->valid = 1;
|
2007-01-13 22:04:31 +00:00
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
2007-02-07 19:01:54 +00:00
|
|
|
|
2007-02-07 19:01:56 +00:00
|
|
|
/*
|
|
|
|
* Backlight device
|
|
|
|
*/
|
|
|
|
static int sony_backlight_update_status(struct backlight_device *bd)
|
2007-01-13 22:04:32 +00:00
|
|
|
{
|
2007-04-09 08:19:04 +00:00
|
|
|
return acpi_callsetfunc(sony_nc_acpi_handle, "SBRT",
|
2007-02-10 15:04:08 +00:00
|
|
|
bd->props.brightness + 1, NULL);
|
2007-02-07 19:01:56 +00:00
|
|
|
}
|
2007-01-13 22:04:32 +00:00
|
|
|
|
2007-02-07 19:01:56 +00:00
|
|
|
static int sony_backlight_get_brightness(struct backlight_device *bd)
|
|
|
|
{
|
|
|
|
int value;
|
2007-01-13 22:04:32 +00:00
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
if (acpi_callgetfunc(sony_nc_acpi_handle, "GBRT", &value))
|
2007-02-07 19:01:56 +00:00
|
|
|
return 0;
|
|
|
|
/* brightness levels are 1-based, while backlight ones are 0-based */
|
|
|
|
return value - 1;
|
2007-01-13 22:04:32 +00:00
|
|
|
}
|
|
|
|
|
2011-02-19 02:52:32 +00:00
|
|
|
static int sony_nc_get_brightness_ng(struct backlight_device *bd)
|
|
|
|
{
|
|
|
|
int result;
|
|
|
|
int *handle = (int *)bl_get_data(bd);
|
|
|
|
|
|
|
|
sony_call_snc_handle(*handle, 0x0200, &result);
|
|
|
|
|
|
|
|
return result & 0xff;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int sony_nc_update_status_ng(struct backlight_device *bd)
|
|
|
|
{
|
|
|
|
int value, result;
|
|
|
|
int *handle = (int *)bl_get_data(bd);
|
|
|
|
|
|
|
|
value = bd->props.brightness;
|
|
|
|
sony_call_snc_handle(*handle, 0x0100 | (value << 16), &result);
|
|
|
|
|
|
|
|
return sony_nc_get_brightness_ng(bd);
|
|
|
|
}
|
|
|
|
|
2010-11-16 13:14:02 +00:00
|
|
|
static const struct backlight_ops sony_backlight_ops = {
|
2011-02-19 02:52:32 +00:00
|
|
|
.options = BL_CORE_SUSPENDRESUME,
|
2007-02-07 20:34:02 +00:00
|
|
|
.update_status = sony_backlight_update_status,
|
|
|
|
.get_brightness = sony_backlight_get_brightness,
|
2007-02-07 19:01:56 +00:00
|
|
|
};
|
2011-02-19 02:52:32 +00:00
|
|
|
static const struct backlight_ops sony_backlight_ng_ops = {
|
|
|
|
.options = BL_CORE_SUSPENDRESUME,
|
|
|
|
.update_status = sony_nc_update_status_ng,
|
|
|
|
.get_brightness = sony_nc_get_brightness_ng,
|
|
|
|
};
|
|
|
|
static int backlight_ng_handle;
|
|
|
|
static struct backlight_device *sony_backlight_device;
|
2007-02-07 19:01:56 +00:00
|
|
|
|
2007-07-15 17:34:35 +00:00
|
|
|
/*
|
|
|
|
* New SNC-only Vaios event mapping to driver known keys
|
|
|
|
*/
|
|
|
|
struct sony_nc_event {
|
|
|
|
u8 data;
|
|
|
|
u8 event;
|
|
|
|
};
|
|
|
|
|
2009-03-26 12:58:16 +00:00
|
|
|
static struct sony_nc_event sony_100_events[] = {
|
2009-03-26 12:58:14 +00:00
|
|
|
{ 0x90, SONYPI_EVENT_PKEY_P1 },
|
|
|
|
{ 0x10, SONYPI_EVENT_ANYBUTTON_RELEASED },
|
2009-04-01 13:10:45 +00:00
|
|
|
{ 0x91, SONYPI_EVENT_PKEY_P2 },
|
2009-03-26 12:58:14 +00:00
|
|
|
{ 0x11, SONYPI_EVENT_ANYBUTTON_RELEASED },
|
2007-07-15 17:34:35 +00:00
|
|
|
{ 0x81, SONYPI_EVENT_FNKEY_F1 },
|
|
|
|
{ 0x01, SONYPI_EVENT_FNKEY_RELEASED },
|
2009-03-26 13:44:26 +00:00
|
|
|
{ 0x82, SONYPI_EVENT_FNKEY_F2 },
|
|
|
|
{ 0x02, SONYPI_EVENT_FNKEY_RELEASED },
|
|
|
|
{ 0x83, SONYPI_EVENT_FNKEY_F3 },
|
|
|
|
{ 0x03, SONYPI_EVENT_FNKEY_RELEASED },
|
|
|
|
{ 0x84, SONYPI_EVENT_FNKEY_F4 },
|
|
|
|
{ 0x04, SONYPI_EVENT_FNKEY_RELEASED },
|
2007-07-15 17:34:35 +00:00
|
|
|
{ 0x85, SONYPI_EVENT_FNKEY_F5 },
|
|
|
|
{ 0x05, SONYPI_EVENT_FNKEY_RELEASED },
|
|
|
|
{ 0x86, SONYPI_EVENT_FNKEY_F6 },
|
|
|
|
{ 0x06, SONYPI_EVENT_FNKEY_RELEASED },
|
|
|
|
{ 0x87, SONYPI_EVENT_FNKEY_F7 },
|
|
|
|
{ 0x07, SONYPI_EVENT_FNKEY_RELEASED },
|
2009-03-26 12:58:14 +00:00
|
|
|
{ 0x89, SONYPI_EVENT_FNKEY_F9 },
|
|
|
|
{ 0x09, SONYPI_EVENT_FNKEY_RELEASED },
|
2007-07-15 17:34:35 +00:00
|
|
|
{ 0x8A, SONYPI_EVENT_FNKEY_F10 },
|
|
|
|
{ 0x0A, SONYPI_EVENT_FNKEY_RELEASED },
|
|
|
|
{ 0x8C, SONYPI_EVENT_FNKEY_F12 },
|
|
|
|
{ 0x0C, SONYPI_EVENT_FNKEY_RELEASED },
|
2011-01-08 09:47:29 +00:00
|
|
|
{ 0x9d, SONYPI_EVENT_ZOOM_PRESSED },
|
|
|
|
{ 0x1d, SONYPI_EVENT_ANYBUTTON_RELEASED },
|
2009-03-26 12:58:14 +00:00
|
|
|
{ 0x9f, SONYPI_EVENT_CD_EJECT_PRESSED },
|
|
|
|
{ 0x1f, SONYPI_EVENT_ANYBUTTON_RELEASED },
|
2009-12-16 15:08:33 +00:00
|
|
|
{ 0xa1, SONYPI_EVENT_MEDIA_PRESSED },
|
|
|
|
{ 0x21, SONYPI_EVENT_ANYBUTTON_RELEASED },
|
2011-01-08 09:47:29 +00:00
|
|
|
{ 0xa4, SONYPI_EVENT_CD_EJECT_PRESSED },
|
|
|
|
{ 0x24, SONYPI_EVENT_ANYBUTTON_RELEASED },
|
|
|
|
{ 0xa5, SONYPI_EVENT_VENDOR_PRESSED },
|
|
|
|
{ 0x25, SONYPI_EVENT_ANYBUTTON_RELEASED },
|
|
|
|
{ 0xa6, SONYPI_EVENT_HELP_PRESSED },
|
|
|
|
{ 0x26, SONYPI_EVENT_ANYBUTTON_RELEASED },
|
2007-07-15 17:34:35 +00:00
|
|
|
{ 0, 0 },
|
|
|
|
};
|
|
|
|
|
2009-03-26 12:58:16 +00:00
|
|
|
static struct sony_nc_event sony_127_events[] = {
|
|
|
|
{ 0x81, SONYPI_EVENT_MODEKEY_PRESSED },
|
|
|
|
{ 0x01, SONYPI_EVENT_ANYBUTTON_RELEASED },
|
|
|
|
{ 0x82, SONYPI_EVENT_PKEY_P1 },
|
|
|
|
{ 0x02, SONYPI_EVENT_ANYBUTTON_RELEASED },
|
|
|
|
{ 0x83, SONYPI_EVENT_PKEY_P2 },
|
|
|
|
{ 0x03, SONYPI_EVENT_ANYBUTTON_RELEASED },
|
|
|
|
{ 0x84, SONYPI_EVENT_PKEY_P3 },
|
|
|
|
{ 0x04, SONYPI_EVENT_ANYBUTTON_RELEASED },
|
|
|
|
{ 0x85, SONYPI_EVENT_PKEY_P4 },
|
|
|
|
{ 0x05, SONYPI_EVENT_ANYBUTTON_RELEASED },
|
|
|
|
{ 0x86, SONYPI_EVENT_PKEY_P5 },
|
|
|
|
{ 0x06, SONYPI_EVENT_ANYBUTTON_RELEASED },
|
|
|
|
{ 0x87, SONYPI_EVENT_SETTINGKEY_PRESSED },
|
|
|
|
{ 0x07, SONYPI_EVENT_ANYBUTTON_RELEASED },
|
|
|
|
{ 0, 0 },
|
|
|
|
};
|
|
|
|
|
2007-02-07 19:01:56 +00:00
|
|
|
/*
|
|
|
|
* ACPI callbacks
|
|
|
|
*/
|
2009-04-07 15:37:32 +00:00
|
|
|
static void sony_nc_notify(struct acpi_device *device, u32 event)
|
2007-01-13 22:04:31 +00:00
|
|
|
{
|
2007-07-15 17:34:35 +00:00
|
|
|
u32 ev = event;
|
|
|
|
|
2009-03-26 12:58:14 +00:00
|
|
|
if (ev >= 0x90) {
|
|
|
|
/* New-style event */
|
2009-04-01 13:10:47 +00:00
|
|
|
int result;
|
2009-03-26 12:58:16 +00:00
|
|
|
int key_handle = 0;
|
2009-03-26 12:58:14 +00:00
|
|
|
ev -= 0x90;
|
|
|
|
|
2009-03-26 12:58:16 +00:00
|
|
|
if (sony_find_snc_handle(0x100) == ev)
|
|
|
|
key_handle = 0x100;
|
|
|
|
if (sony_find_snc_handle(0x127) == ev)
|
|
|
|
key_handle = 0x127;
|
|
|
|
|
2009-04-01 13:10:45 +00:00
|
|
|
if (key_handle) {
|
2009-03-26 12:58:16 +00:00
|
|
|
struct sony_nc_event *key_event;
|
2009-03-26 12:58:14 +00:00
|
|
|
|
2009-04-01 13:10:47 +00:00
|
|
|
if (sony_call_snc_handle(key_handle, 0x200, &result)) {
|
2009-04-07 15:37:32 +00:00
|
|
|
dprintk("sony_nc_notify, unable to decode"
|
2009-03-26 12:58:16 +00:00
|
|
|
" event 0x%.2x 0x%.2x\n", key_handle,
|
|
|
|
ev);
|
2009-04-01 13:10:47 +00:00
|
|
|
/* restore the original event */
|
|
|
|
ev = event;
|
|
|
|
} else {
|
2009-03-26 12:58:14 +00:00
|
|
|
ev = result & 0xFF;
|
|
|
|
|
2009-04-01 13:10:47 +00:00
|
|
|
if (key_handle == 0x100)
|
|
|
|
key_event = sony_100_events;
|
|
|
|
else
|
|
|
|
key_event = sony_127_events;
|
2009-03-26 12:58:16 +00:00
|
|
|
|
2009-04-01 13:10:47 +00:00
|
|
|
for (; key_event->data; key_event++) {
|
|
|
|
if (key_event->data == ev) {
|
|
|
|
ev = key_event->event;
|
|
|
|
break;
|
|
|
|
}
|
2009-03-26 12:58:14 +00:00
|
|
|
}
|
2007-07-15 17:34:35 +00:00
|
|
|
|
2009-04-01 13:10:47 +00:00
|
|
|
if (!key_event->data)
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_info(DRV_PFX
|
2009-04-01 13:10:47 +00:00
|
|
|
"Unknown event: 0x%x 0x%x\n",
|
|
|
|
key_handle,
|
|
|
|
ev);
|
|
|
|
else
|
|
|
|
sony_laptop_report_input_event(ev);
|
2009-03-26 12:58:16 +00:00
|
|
|
}
|
2009-12-16 15:08:35 +00:00
|
|
|
} else if (sony_find_snc_handle(sony_rfkill_handle) == ev) {
|
2009-03-26 12:58:15 +00:00
|
|
|
sony_nc_rfkill_update();
|
|
|
|
return;
|
2009-03-26 12:58:14 +00:00
|
|
|
}
|
2009-04-01 13:10:47 +00:00
|
|
|
} else
|
|
|
|
sony_laptop_report_input_event(ev);
|
2009-03-26 12:58:12 +00:00
|
|
|
|
2009-04-07 15:37:32 +00:00
|
|
|
dprintk("sony_nc_notify, event: 0x%.2x\n", ev);
|
2007-08-23 19:20:26 +00:00
|
|
|
acpi_bus_generate_proc_event(sony_nc_acpi_device, 1, ev);
|
2007-01-13 22:04:31 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static acpi_status sony_walk_callback(acpi_handle handle, u32 level,
|
|
|
|
void *context, void **return_value)
|
|
|
|
{
|
2008-12-16 08:59:35 +00:00
|
|
|
struct acpi_device_info *info;
|
2007-01-13 22:04:31 +00:00
|
|
|
|
2009-06-29 05:39:29 +00:00
|
|
|
if (ACPI_SUCCESS(acpi_get_object_info(handle, &info))) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_warn(DRV_PFX "method: name: %4.4s, args %X\n",
|
2008-12-16 08:59:35 +00:00
|
|
|
(char *)&info->name, info->param_count);
|
|
|
|
|
2009-06-29 05:39:29 +00:00
|
|
|
kfree(info);
|
2008-12-16 08:59:35 +00:00
|
|
|
}
|
2007-01-13 22:04:31 +00:00
|
|
|
|
|
|
|
return AE_OK;
|
|
|
|
}
|
|
|
|
|
2007-02-07 19:01:56 +00:00
|
|
|
/*
|
|
|
|
* ACPI device
|
|
|
|
*/
|
2009-03-26 12:58:12 +00:00
|
|
|
static int sony_nc_function_setup(struct acpi_device *device)
|
|
|
|
{
|
|
|
|
int result;
|
|
|
|
|
|
|
|
/* Enable all events */
|
|
|
|
acpi_callsetfunc(sony_nc_acpi_handle, "SN02", 0xffff, &result);
|
|
|
|
|
|
|
|
/* Setup hotkeys */
|
|
|
|
sony_call_snc_handle(0x0100, 0, &result);
|
|
|
|
sony_call_snc_handle(0x0101, 0, &result);
|
|
|
|
sony_call_snc_handle(0x0102, 0x100, &result);
|
2009-04-12 11:26:27 +00:00
|
|
|
sony_call_snc_handle(0x0127, 0, &result);
|
2009-03-26 12:58:12 +00:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
static int sony_nc_resume(struct acpi_device *device)
|
2007-02-07 19:01:56 +00:00
|
|
|
{
|
2007-04-09 08:19:04 +00:00
|
|
|
struct sony_nc_value *item;
|
2009-03-26 12:58:12 +00:00
|
|
|
acpi_handle handle;
|
2007-02-07 19:01:56 +00:00
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
for (item = sony_nc_values; item->name; item++) {
|
2007-02-07 19:01:56 +00:00
|
|
|
int ret;
|
|
|
|
|
|
|
|
if (!item->valid)
|
|
|
|
continue;
|
2007-04-09 08:19:04 +00:00
|
|
|
ret = acpi_callsetfunc(sony_nc_acpi_handle, *item->acpiset,
|
2007-02-07 20:34:02 +00:00
|
|
|
item->value, NULL);
|
2007-02-07 19:01:56 +00:00
|
|
|
if (ret < 0) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_err(DRV_PFX "%s: %d\n", __func__, ret);
|
2007-02-07 19:01:56 +00:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
2007-07-15 17:34:35 +00:00
|
|
|
|
2009-03-26 12:58:13 +00:00
|
|
|
if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle, "ECON",
|
|
|
|
&handle))) {
|
|
|
|
if (acpi_callsetfunc(sony_nc_acpi_handle, "ECON", 1, NULL))
|
|
|
|
dprintk("ECON Method failed\n");
|
|
|
|
}
|
|
|
|
|
2009-03-26 12:58:12 +00:00
|
|
|
if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle, "SN00",
|
|
|
|
&handle))) {
|
|
|
|
dprintk("Doing SNC setup\n");
|
|
|
|
sony_nc_function_setup(device);
|
|
|
|
}
|
|
|
|
|
2009-09-25 09:18:21 +00:00
|
|
|
/* re-read rfkill state */
|
|
|
|
sony_nc_rfkill_update();
|
|
|
|
|
2007-02-07 19:01:56 +00:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2009-03-26 12:58:15 +00:00
|
|
|
static void sony_nc_rfkill_cleanup(void)
|
|
|
|
{
|
|
|
|
int i;
|
|
|
|
|
2009-06-02 11:01:37 +00:00
|
|
|
for (i = 0; i < N_SONY_RFKILL; i++) {
|
|
|
|
if (sony_rfkill_devices[i]) {
|
2009-03-26 12:58:15 +00:00
|
|
|
rfkill_unregister(sony_rfkill_devices[i]);
|
2009-06-02 11:01:37 +00:00
|
|
|
rfkill_destroy(sony_rfkill_devices[i]);
|
|
|
|
}
|
2009-03-26 12:58:15 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2009-06-02 11:01:37 +00:00
|
|
|
static int sony_nc_rfkill_set(void *data, bool blocked)
|
2009-03-26 12:58:15 +00:00
|
|
|
{
|
|
|
|
int result;
|
|
|
|
int argument = sony_rfkill_address[(long) data] + 0x100;
|
|
|
|
|
2009-06-02 11:01:37 +00:00
|
|
|
if (!blocked)
|
2009-03-26 12:58:15 +00:00
|
|
|
argument |= 0xff0000;
|
|
|
|
|
2009-12-16 15:08:35 +00:00
|
|
|
return sony_call_snc_handle(sony_rfkill_handle, argument, &result);
|
2009-03-26 12:58:15 +00:00
|
|
|
}
|
|
|
|
|
2009-06-02 11:01:37 +00:00
|
|
|
static const struct rfkill_ops sony_rfkill_ops = {
|
|
|
|
.set_block = sony_nc_rfkill_set,
|
|
|
|
};
|
2009-03-26 12:58:15 +00:00
|
|
|
|
2009-06-02 11:01:37 +00:00
|
|
|
static int sony_nc_setup_rfkill(struct acpi_device *device,
|
|
|
|
enum sony_nc_rfkill nc_type)
|
2009-03-26 12:58:15 +00:00
|
|
|
{
|
|
|
|
int err = 0;
|
2009-06-02 11:01:37 +00:00
|
|
|
struct rfkill *rfk;
|
|
|
|
enum rfkill_type type;
|
|
|
|
const char *name;
|
2009-09-24 19:15:24 +00:00
|
|
|
int result;
|
|
|
|
bool hwblock;
|
2009-06-02 11:01:37 +00:00
|
|
|
|
|
|
|
switch (nc_type) {
|
|
|
|
case SONY_WIFI:
|
|
|
|
type = RFKILL_TYPE_WLAN;
|
|
|
|
name = "sony-wifi";
|
|
|
|
break;
|
|
|
|
case SONY_BLUETOOTH:
|
|
|
|
type = RFKILL_TYPE_BLUETOOTH;
|
|
|
|
name = "sony-bluetooth";
|
|
|
|
break;
|
|
|
|
case SONY_WWAN:
|
|
|
|
type = RFKILL_TYPE_WWAN;
|
|
|
|
name = "sony-wwan";
|
|
|
|
break;
|
|
|
|
case SONY_WIMAX:
|
|
|
|
type = RFKILL_TYPE_WIMAX;
|
|
|
|
name = "sony-wimax";
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
return -EINVAL;
|
2009-04-12 11:26:31 +00:00
|
|
|
}
|
2009-03-26 12:58:15 +00:00
|
|
|
|
2009-06-02 11:01:37 +00:00
|
|
|
rfk = rfkill_alloc(name, &device->dev, type,
|
|
|
|
&sony_rfkill_ops, (void *)nc_type);
|
|
|
|
if (!rfk)
|
|
|
|
return -ENOMEM;
|
2009-03-26 12:58:15 +00:00
|
|
|
|
2009-12-16 15:08:35 +00:00
|
|
|
sony_call_snc_handle(sony_rfkill_handle, 0x200, &result);
|
2009-09-24 19:15:24 +00:00
|
|
|
hwblock = !(result & 0x1);
|
|
|
|
rfkill_set_hw_state(rfk, hwblock);
|
|
|
|
|
2009-06-02 11:01:37 +00:00
|
|
|
err = rfkill_register(rfk);
|
|
|
|
if (err) {
|
|
|
|
rfkill_destroy(rfk);
|
|
|
|
return err;
|
2009-04-12 11:26:31 +00:00
|
|
|
}
|
2009-06-02 11:01:37 +00:00
|
|
|
sony_rfkill_devices[nc_type] = rfk;
|
2009-03-26 12:58:15 +00:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2011-01-09 03:56:44 +00:00
|
|
|
static void sony_nc_rfkill_update(void)
|
2009-03-26 12:58:15 +00:00
|
|
|
{
|
2009-06-02 11:01:37 +00:00
|
|
|
enum sony_nc_rfkill i;
|
|
|
|
int result;
|
|
|
|
bool hwblock;
|
2009-03-26 12:58:15 +00:00
|
|
|
|
2009-12-16 15:08:35 +00:00
|
|
|
sony_call_snc_handle(sony_rfkill_handle, 0x200, &result);
|
2009-06-02 11:01:37 +00:00
|
|
|
hwblock = !(result & 0x1);
|
2009-03-26 12:58:15 +00:00
|
|
|
|
2009-06-02 11:01:37 +00:00
|
|
|
for (i = 0; i < N_SONY_RFKILL; i++) {
|
|
|
|
int argument = sony_rfkill_address[i];
|
2009-03-26 12:58:15 +00:00
|
|
|
|
2009-06-02 11:01:37 +00:00
|
|
|
if (!sony_rfkill_devices[i])
|
|
|
|
continue;
|
|
|
|
|
|
|
|
if (hwblock) {
|
2009-06-11 10:08:15 +00:00
|
|
|
if (rfkill_set_hw_state(sony_rfkill_devices[i], true)) {
|
|
|
|
/* we already know we're blocked */
|
|
|
|
}
|
2009-06-02 11:01:37 +00:00
|
|
|
continue;
|
2009-03-26 12:58:15 +00:00
|
|
|
}
|
2009-06-02 11:01:37 +00:00
|
|
|
|
2009-12-16 15:08:35 +00:00
|
|
|
sony_call_snc_handle(sony_rfkill_handle, argument, &result);
|
2009-06-02 11:01:37 +00:00
|
|
|
rfkill_set_states(sony_rfkill_devices[i],
|
|
|
|
!(result & 0xf), false);
|
2009-03-26 12:58:15 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2009-12-16 15:08:36 +00:00
|
|
|
static void sony_nc_rfkill_setup(struct acpi_device *device)
|
2009-03-26 12:58:15 +00:00
|
|
|
{
|
2009-12-16 15:08:36 +00:00
|
|
|
int offset;
|
|
|
|
u8 dev_code, i;
|
|
|
|
acpi_status status;
|
|
|
|
struct acpi_object_list params;
|
|
|
|
union acpi_object in_obj;
|
|
|
|
union acpi_object *device_enum;
|
|
|
|
struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
|
2009-03-26 12:58:15 +00:00
|
|
|
|
2009-12-16 15:08:36 +00:00
|
|
|
offset = sony_find_snc_handle(0x124);
|
|
|
|
if (offset == -1) {
|
|
|
|
offset = sony_find_snc_handle(0x135);
|
|
|
|
if (offset == -1)
|
|
|
|
return;
|
2009-12-16 15:08:35 +00:00
|
|
|
else
|
|
|
|
sony_rfkill_handle = 0x135;
|
|
|
|
} else
|
|
|
|
sony_rfkill_handle = 0x124;
|
2009-12-16 15:08:36 +00:00
|
|
|
dprintk("Found rkfill handle: 0x%.4x\n", sony_rfkill_handle);
|
|
|
|
|
|
|
|
/* need to read the whole buffer returned by the acpi call to SN06
|
|
|
|
* here otherwise we may miss some features
|
|
|
|
*/
|
|
|
|
params.count = 1;
|
|
|
|
params.pointer = &in_obj;
|
|
|
|
in_obj.type = ACPI_TYPE_INTEGER;
|
|
|
|
in_obj.integer.value = offset;
|
|
|
|
status = acpi_evaluate_object(sony_nc_acpi_handle, "SN06", ¶ms,
|
|
|
|
&buffer);
|
|
|
|
if (ACPI_FAILURE(status)) {
|
|
|
|
dprintk("Radio device enumeration failed\n");
|
|
|
|
return;
|
|
|
|
}
|
2009-03-26 12:58:15 +00:00
|
|
|
|
2009-12-16 15:08:36 +00:00
|
|
|
device_enum = (union acpi_object *) buffer.pointer;
|
2011-02-19 02:52:28 +00:00
|
|
|
if (!device_enum || device_enum->type != ACPI_TYPE_BUFFER) {
|
|
|
|
pr_err(DRV_PFX "Invalid SN06 return object 0x%.2x\n",
|
|
|
|
device_enum->type);
|
2009-12-16 15:08:36 +00:00
|
|
|
goto out_no_enum;
|
2009-03-26 12:58:15 +00:00
|
|
|
}
|
|
|
|
|
2009-12-16 15:08:36 +00:00
|
|
|
/* the buffer is filled with magic numbers describing the devices
|
|
|
|
* available, 0xff terminates the enumeration
|
|
|
|
*/
|
2010-01-10 08:15:44 +00:00
|
|
|
for (i = 0; i < device_enum->buffer.length; i++) {
|
|
|
|
|
|
|
|
dev_code = *(device_enum->buffer.pointer + i);
|
|
|
|
if (dev_code == 0xff)
|
|
|
|
break;
|
|
|
|
|
2009-12-16 15:08:36 +00:00
|
|
|
dprintk("Radio devices, looking at 0x%.2x\n", dev_code);
|
2009-03-26 12:58:15 +00:00
|
|
|
|
2009-12-16 15:08:36 +00:00
|
|
|
if (dev_code == 0 && !sony_rfkill_devices[SONY_WIFI])
|
|
|
|
sony_nc_setup_rfkill(device, SONY_WIFI);
|
|
|
|
|
|
|
|
if (dev_code == 0x10 && !sony_rfkill_devices[SONY_BLUETOOTH])
|
|
|
|
sony_nc_setup_rfkill(device, SONY_BLUETOOTH);
|
|
|
|
|
|
|
|
if ((0xf0 & dev_code) == 0x20 &&
|
|
|
|
!sony_rfkill_devices[SONY_WWAN])
|
|
|
|
sony_nc_setup_rfkill(device, SONY_WWAN);
|
|
|
|
|
|
|
|
if (dev_code == 0x30 && !sony_rfkill_devices[SONY_WIMAX])
|
|
|
|
sony_nc_setup_rfkill(device, SONY_WIMAX);
|
|
|
|
}
|
|
|
|
|
|
|
|
out_no_enum:
|
|
|
|
kfree(buffer.pointer);
|
|
|
|
return;
|
2009-03-26 12:58:15 +00:00
|
|
|
}
|
|
|
|
|
2011-02-19 02:52:31 +00:00
|
|
|
/* Keyboard backlight feature */
|
|
|
|
#define KBDBL_HANDLER 0x137
|
|
|
|
#define KBDBL_PRESENT 0xB00
|
|
|
|
#define SET_MODE 0xC00
|
|
|
|
#define SET_TIMEOUT 0xE00
|
|
|
|
|
|
|
|
struct kbd_backlight {
|
|
|
|
int mode;
|
|
|
|
int timeout;
|
|
|
|
struct device_attribute mode_attr;
|
|
|
|
struct device_attribute timeout_attr;
|
|
|
|
};
|
|
|
|
|
2011-02-26 12:54:27 +00:00
|
|
|
static struct kbd_backlight *kbdbl_handle;
|
2011-02-19 02:52:31 +00:00
|
|
|
|
|
|
|
static ssize_t __sony_nc_kbd_backlight_mode_set(u8 value)
|
|
|
|
{
|
|
|
|
int result;
|
|
|
|
|
|
|
|
if (value > 1)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
if (sony_call_snc_handle(KBDBL_HANDLER,
|
|
|
|
(value << 0x10) | SET_MODE, &result))
|
|
|
|
return -EIO;
|
|
|
|
|
|
|
|
kbdbl_handle->mode = value;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t sony_nc_kbd_backlight_mode_store(struct device *dev,
|
|
|
|
struct device_attribute *attr,
|
|
|
|
const char *buffer, size_t count)
|
|
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
unsigned long value;
|
|
|
|
|
|
|
|
if (count > 31)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
if (strict_strtoul(buffer, 10, &value))
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
ret = __sony_nc_kbd_backlight_mode_set(value);
|
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t sony_nc_kbd_backlight_mode_show(struct device *dev,
|
|
|
|
struct device_attribute *attr, char *buffer)
|
|
|
|
{
|
|
|
|
ssize_t count = 0;
|
|
|
|
count = snprintf(buffer, PAGE_SIZE, "%d\n", kbdbl_handle->mode);
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int __sony_nc_kbd_backlight_timeout_set(u8 value)
|
|
|
|
{
|
|
|
|
int result;
|
|
|
|
|
|
|
|
if (value > 3)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
if (sony_call_snc_handle(KBDBL_HANDLER,
|
|
|
|
(value << 0x10) | SET_TIMEOUT, &result))
|
|
|
|
return -EIO;
|
|
|
|
|
|
|
|
kbdbl_handle->timeout = value;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t sony_nc_kbd_backlight_timeout_store(struct device *dev,
|
|
|
|
struct device_attribute *attr,
|
|
|
|
const char *buffer, size_t count)
|
|
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
unsigned long value;
|
|
|
|
|
|
|
|
if (count > 31)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
if (strict_strtoul(buffer, 10, &value))
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
ret = __sony_nc_kbd_backlight_timeout_set(value);
|
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t sony_nc_kbd_backlight_timeout_show(struct device *dev,
|
|
|
|
struct device_attribute *attr, char *buffer)
|
|
|
|
{
|
|
|
|
ssize_t count = 0;
|
|
|
|
count = snprintf(buffer, PAGE_SIZE, "%d\n", kbdbl_handle->timeout);
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int sony_nc_kbd_backlight_setup(struct platform_device *pd)
|
|
|
|
{
|
|
|
|
int result;
|
|
|
|
|
|
|
|
if (sony_call_snc_handle(0x137, KBDBL_PRESENT, &result))
|
|
|
|
return 0;
|
|
|
|
if (!(result & 0x02))
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
kbdbl_handle = kzalloc(sizeof(*kbdbl_handle), GFP_KERNEL);
|
|
|
|
|
|
|
|
sysfs_attr_init(&kbdbl_handle->mode_attr.attr);
|
|
|
|
kbdbl_handle->mode_attr.attr.name = "kbd_backlight";
|
|
|
|
kbdbl_handle->mode_attr.attr.mode = S_IRUGO | S_IWUSR;
|
|
|
|
kbdbl_handle->mode_attr.show = sony_nc_kbd_backlight_mode_show;
|
|
|
|
kbdbl_handle->mode_attr.store = sony_nc_kbd_backlight_mode_store;
|
|
|
|
|
|
|
|
sysfs_attr_init(&kbdbl_handle->timeout_attr.attr);
|
|
|
|
kbdbl_handle->timeout_attr.attr.name = "kbd_backlight_timeout";
|
|
|
|
kbdbl_handle->timeout_attr.attr.mode = S_IRUGO | S_IWUSR;
|
|
|
|
kbdbl_handle->timeout_attr.show = sony_nc_kbd_backlight_timeout_show;
|
|
|
|
kbdbl_handle->timeout_attr.store = sony_nc_kbd_backlight_timeout_store;
|
|
|
|
|
|
|
|
if (device_create_file(&pd->dev, &kbdbl_handle->mode_attr))
|
|
|
|
goto outkzalloc;
|
|
|
|
|
|
|
|
if (device_create_file(&pd->dev, &kbdbl_handle->timeout_attr))
|
|
|
|
goto outmode;
|
|
|
|
|
|
|
|
__sony_nc_kbd_backlight_mode_set(kbd_backlight);
|
|
|
|
__sony_nc_kbd_backlight_timeout_set(kbd_backlight_timeout);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
outmode:
|
|
|
|
device_remove_file(&pd->dev, &kbdbl_handle->mode_attr);
|
|
|
|
outkzalloc:
|
|
|
|
kfree(kbdbl_handle);
|
|
|
|
kbdbl_handle = NULL;
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int sony_nc_kbd_backlight_cleanup(struct platform_device *pd)
|
|
|
|
{
|
|
|
|
if (kbdbl_handle) {
|
|
|
|
device_remove_file(&pd->dev, &kbdbl_handle->mode_attr);
|
|
|
|
device_remove_file(&pd->dev, &kbdbl_handle->timeout_attr);
|
|
|
|
kfree(kbdbl_handle);
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2011-02-19 02:52:32 +00:00
|
|
|
static void sony_nc_backlight_setup(void)
|
|
|
|
{
|
|
|
|
acpi_handle unused;
|
|
|
|
int max_brightness = 0;
|
|
|
|
const struct backlight_ops *ops = NULL;
|
|
|
|
struct backlight_properties props;
|
|
|
|
|
|
|
|
if (sony_find_snc_handle(0x12f) != -1) {
|
|
|
|
backlight_ng_handle = 0x12f;
|
|
|
|
ops = &sony_backlight_ng_ops;
|
|
|
|
max_brightness = 0xff;
|
|
|
|
|
|
|
|
} else if (sony_find_snc_handle(0x137) != -1) {
|
|
|
|
backlight_ng_handle = 0x137;
|
|
|
|
ops = &sony_backlight_ng_ops;
|
|
|
|
max_brightness = 0xff;
|
|
|
|
|
|
|
|
} else if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle, "GBRT",
|
|
|
|
&unused))) {
|
|
|
|
ops = &sony_backlight_ops;
|
|
|
|
max_brightness = SONY_MAX_BRIGHTNESS - 1;
|
|
|
|
|
|
|
|
} else
|
|
|
|
return;
|
|
|
|
|
|
|
|
memset(&props, 0, sizeof(struct backlight_properties));
|
|
|
|
props.type = BACKLIGHT_PLATFORM;
|
|
|
|
props.max_brightness = max_brightness;
|
|
|
|
sony_backlight_device = backlight_device_register("sony", NULL,
|
|
|
|
&backlight_ng_handle,
|
|
|
|
ops, &props);
|
|
|
|
|
|
|
|
if (IS_ERR(sony_backlight_device)) {
|
|
|
|
pr_warning(DRV_PFX "unable to register backlight device\n");
|
|
|
|
sony_backlight_device = NULL;
|
|
|
|
} else
|
|
|
|
sony_backlight_device->props.brightness =
|
|
|
|
ops->get_brightness(sony_backlight_device);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void sony_nc_backlight_cleanup(void)
|
|
|
|
{
|
|
|
|
if (sony_backlight_device)
|
|
|
|
backlight_device_unregister(sony_backlight_device);
|
|
|
|
}
|
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
static int sony_nc_add(struct acpi_device *device)
|
2007-01-13 22:04:31 +00:00
|
|
|
{
|
|
|
|
acpi_status status;
|
2007-03-06 10:29:42 +00:00
|
|
|
int result = 0;
|
2007-01-13 22:04:34 +00:00
|
|
|
acpi_handle handle;
|
2007-04-09 08:19:05 +00:00
|
|
|
struct sony_nc_value *item;
|
2007-01-13 22:04:31 +00:00
|
|
|
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_info(DRV_PFX "%s v%s.\n", SONY_NC_DRIVER_NAME,
|
|
|
|
SONY_LAPTOP_DRIVER_VERSION);
|
2007-04-09 17:31:06 +00:00
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
sony_nc_acpi_device = device;
|
2007-04-09 17:26:03 +00:00
|
|
|
strcpy(acpi_device_class(device), "sony/hotkey");
|
2007-01-13 22:04:37 +00:00
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
sony_nc_acpi_handle = device->handle;
|
2007-01-13 22:04:31 +00:00
|
|
|
|
2007-07-15 17:34:36 +00:00
|
|
|
/* read device status */
|
|
|
|
result = acpi_bus_get_status(device);
|
|
|
|
/* bail IFF the above call was successful and the device is not present */
|
|
|
|
if (!result && !device->status.present) {
|
|
|
|
dprintk("Device not present\n");
|
|
|
|
result = -ENODEV;
|
|
|
|
goto outwalk;
|
|
|
|
}
|
|
|
|
|
2011-02-19 02:52:30 +00:00
|
|
|
result = sony_pf_add();
|
|
|
|
if (result)
|
|
|
|
goto outpresent;
|
|
|
|
|
2007-01-13 22:04:31 +00:00
|
|
|
if (debug) {
|
2011-02-19 02:52:28 +00:00
|
|
|
status = acpi_walk_namespace(ACPI_TYPE_METHOD,
|
|
|
|
sony_nc_acpi_handle, 1, sony_walk_callback,
|
|
|
|
NULL, NULL, NULL);
|
2007-01-13 22:04:31 +00:00
|
|
|
if (ACPI_FAILURE(status)) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_warn(DRV_PFX "unable to walk acpi resources\n");
|
2007-01-13 22:04:31 +00:00
|
|
|
result = -ENODEV;
|
2011-02-19 02:52:30 +00:00
|
|
|
goto outpresent;
|
2007-01-13 22:04:31 +00:00
|
|
|
}
|
2007-01-13 22:04:37 +00:00
|
|
|
}
|
2007-01-13 22:04:31 +00:00
|
|
|
|
2009-03-26 12:58:13 +00:00
|
|
|
if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle, "ECON",
|
|
|
|
&handle))) {
|
|
|
|
if (acpi_callsetfunc(sony_nc_acpi_handle, "ECON", 1, NULL))
|
|
|
|
dprintk("ECON Method failed\n");
|
|
|
|
}
|
|
|
|
|
2009-03-26 12:58:12 +00:00
|
|
|
if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle, "SN00",
|
|
|
|
&handle))) {
|
|
|
|
dprintk("Doing SNC setup\n");
|
2011-02-26 12:54:57 +00:00
|
|
|
result = sony_nc_handles_setup(sony_pf_device);
|
|
|
|
if (result)
|
2011-02-19 02:52:30 +00:00
|
|
|
goto outpresent;
|
2011-02-26 12:54:57 +00:00
|
|
|
result = sony_nc_kbd_backlight_setup(sony_pf_device);
|
|
|
|
if (result)
|
2011-02-19 02:52:31 +00:00
|
|
|
goto outsnc;
|
2009-03-26 12:58:12 +00:00
|
|
|
sony_nc_function_setup(device);
|
2009-03-26 12:58:15 +00:00
|
|
|
sony_nc_rfkill_setup(device);
|
2009-03-26 12:58:12 +00:00
|
|
|
}
|
|
|
|
|
2007-04-09 08:19:08 +00:00
|
|
|
/* setup input devices and helper fifo */
|
2007-11-21 19:15:53 +00:00
|
|
|
result = sony_laptop_setup_input(device);
|
2007-04-09 08:19:08 +00:00
|
|
|
if (result) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_err(DRV_PFX "Unable to create input devices.\n");
|
2011-02-19 02:52:31 +00:00
|
|
|
goto outkbdbacklight;
|
2007-04-09 08:19:08 +00:00
|
|
|
}
|
|
|
|
|
2008-11-12 22:03:28 +00:00
|
|
|
if (acpi_video_backlight_support()) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_info(DRV_PFX "brightness ignored, must be "
|
2008-08-01 15:38:02 +00:00
|
|
|
"controlled by ACPI video driver\n");
|
2011-02-19 02:52:32 +00:00
|
|
|
} else {
|
|
|
|
sony_nc_backlight_setup();
|
2007-01-13 22:04:34 +00:00
|
|
|
}
|
2007-01-13 22:04:31 +00:00
|
|
|
|
2007-04-09 08:19:05 +00:00
|
|
|
/* create sony_pf sysfs attributes related to the SNC device */
|
|
|
|
for (item = sony_nc_values; item->name; ++item) {
|
|
|
|
|
|
|
|
if (!debug && item->debug)
|
|
|
|
continue;
|
|
|
|
|
|
|
|
/* find the available acpiget as described in the DSDT */
|
|
|
|
for (; item->acpiget && *item->acpiget; ++item->acpiget) {
|
|
|
|
if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle,
|
|
|
|
*item->acpiget,
|
|
|
|
&handle))) {
|
2007-04-09 08:19:06 +00:00
|
|
|
dprintk("Found %s getter: %s\n",
|
|
|
|
item->name, *item->acpiget);
|
2007-04-09 08:19:05 +00:00
|
|
|
item->devattr.attr.mode |= S_IRUGO;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* find the available acpiset as described in the DSDT */
|
|
|
|
for (; item->acpiset && *item->acpiset; ++item->acpiset) {
|
|
|
|
if (ACPI_SUCCESS(acpi_get_handle(sony_nc_acpi_handle,
|
|
|
|
*item->acpiset,
|
|
|
|
&handle))) {
|
2007-04-09 08:19:06 +00:00
|
|
|
dprintk("Found %s setter: %s\n",
|
|
|
|
item->name, *item->acpiset);
|
2007-04-09 08:19:05 +00:00
|
|
|
item->devattr.attr.mode |= S_IWUSR;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (item->devattr.attr.mode != 0) {
|
|
|
|
result =
|
|
|
|
device_create_file(&sony_pf_device->dev,
|
|
|
|
&item->devattr);
|
|
|
|
if (result)
|
|
|
|
goto out_sysfs;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2007-01-13 22:04:31 +00:00
|
|
|
return 0;
|
|
|
|
|
2007-04-09 08:19:05 +00:00
|
|
|
out_sysfs:
|
|
|
|
for (item = sony_nc_values; item->name; ++item) {
|
|
|
|
device_remove_file(&sony_pf_device->dev, &item->devattr);
|
|
|
|
}
|
2011-02-19 02:52:32 +00:00
|
|
|
sony_nc_backlight_cleanup();
|
2007-01-13 22:04:41 +00:00
|
|
|
|
2007-04-09 08:19:08 +00:00
|
|
|
sony_laptop_remove_input();
|
|
|
|
|
2011-02-19 02:52:31 +00:00
|
|
|
outkbdbacklight:
|
|
|
|
sony_nc_kbd_backlight_cleanup(sony_pf_device);
|
|
|
|
|
2011-02-19 02:52:30 +00:00
|
|
|
outsnc:
|
|
|
|
sony_nc_handles_cleanup(sony_pf_device);
|
|
|
|
|
|
|
|
outpresent:
|
|
|
|
sony_pf_remove();
|
|
|
|
|
2007-02-07 20:34:02 +00:00
|
|
|
outwalk:
|
2009-03-26 12:58:15 +00:00
|
|
|
sony_nc_rfkill_cleanup();
|
2007-01-13 22:04:31 +00:00
|
|
|
return result;
|
|
|
|
}
|
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
static int sony_nc_remove(struct acpi_device *device, int type)
|
2007-01-13 22:04:31 +00:00
|
|
|
{
|
2007-04-09 08:19:05 +00:00
|
|
|
struct sony_nc_value *item;
|
2007-01-13 22:04:31 +00:00
|
|
|
|
2011-02-19 02:52:32 +00:00
|
|
|
sony_nc_backlight_cleanup();
|
2007-01-13 22:04:34 +00:00
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
sony_nc_acpi_device = NULL;
|
2007-01-13 22:04:37 +00:00
|
|
|
|
2007-04-09 08:19:05 +00:00
|
|
|
for (item = sony_nc_values; item->name; ++item) {
|
|
|
|
device_remove_file(&sony_pf_device->dev, &item->devattr);
|
|
|
|
}
|
|
|
|
|
2011-02-19 02:52:31 +00:00
|
|
|
sony_nc_kbd_backlight_cleanup(sony_pf_device);
|
2011-02-19 02:52:30 +00:00
|
|
|
sony_nc_handles_cleanup(sony_pf_device);
|
2007-04-09 08:19:05 +00:00
|
|
|
sony_pf_remove();
|
2007-04-09 08:19:08 +00:00
|
|
|
sony_laptop_remove_input();
|
2009-03-26 12:58:15 +00:00
|
|
|
sony_nc_rfkill_cleanup();
|
2007-04-09 17:31:06 +00:00
|
|
|
dprintk(SONY_NC_DRIVER_NAME " removed.\n");
|
2007-01-13 22:04:31 +00:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2007-07-23 12:44:41 +00:00
|
|
|
static const struct acpi_device_id sony_device_ids[] = {
|
|
|
|
{SONY_NC_HID, 0},
|
|
|
|
{SONY_PIC_HID, 0},
|
|
|
|
{"", 0},
|
|
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(acpi, sony_device_ids);
|
|
|
|
|
|
|
|
static const struct acpi_device_id sony_nc_device_ids[] = {
|
|
|
|
{SONY_NC_HID, 0},
|
|
|
|
{"", 0},
|
|
|
|
};
|
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
static struct acpi_driver sony_nc_driver = {
|
|
|
|
.name = SONY_NC_DRIVER_NAME,
|
|
|
|
.class = SONY_NC_CLASS,
|
2007-07-23 12:44:41 +00:00
|
|
|
.ids = sony_nc_device_ids,
|
2007-04-09 17:26:03 +00:00
|
|
|
.owner = THIS_MODULE,
|
2007-02-07 20:34:02 +00:00
|
|
|
.ops = {
|
2007-04-09 08:19:04 +00:00
|
|
|
.add = sony_nc_add,
|
|
|
|
.remove = sony_nc_remove,
|
|
|
|
.resume = sony_nc_resume,
|
2009-04-07 15:37:32 +00:00
|
|
|
.notify = sony_nc_notify,
|
2007-02-07 20:34:02 +00:00
|
|
|
},
|
2007-01-13 22:04:32 +00:00
|
|
|
};
|
|
|
|
|
2007-04-09 17:26:03 +00:00
|
|
|
/*********** SPIC (SNY6001) Device ***********/
|
|
|
|
|
|
|
|
#define SONYPI_DEVICE_TYPE1 0x00000001
|
|
|
|
#define SONYPI_DEVICE_TYPE2 0x00000002
|
|
|
|
#define SONYPI_DEVICE_TYPE3 0x00000004
|
|
|
|
|
2007-07-15 17:34:39 +00:00
|
|
|
#define SONYPI_TYPE1_OFFSET 0x04
|
|
|
|
#define SONYPI_TYPE2_OFFSET 0x12
|
|
|
|
#define SONYPI_TYPE3_OFFSET 0x12
|
2007-04-09 17:26:03 +00:00
|
|
|
|
|
|
|
struct sony_pic_ioport {
|
2007-08-12 07:20:28 +00:00
|
|
|
struct acpi_resource_io io1;
|
|
|
|
struct acpi_resource_io io2;
|
2007-04-09 17:26:03 +00:00
|
|
|
struct list_head list;
|
|
|
|
};
|
|
|
|
|
|
|
|
struct sony_pic_irq {
|
|
|
|
struct acpi_resource_irq irq;
|
|
|
|
struct list_head list;
|
|
|
|
};
|
|
|
|
|
2008-01-14 09:05:43 +00:00
|
|
|
struct sonypi_eventtypes {
|
|
|
|
u8 data;
|
|
|
|
unsigned long mask;
|
|
|
|
struct sonypi_event *events;
|
|
|
|
};
|
|
|
|
|
2009-09-15 15:05:29 +00:00
|
|
|
struct sony_pic_dev {
|
|
|
|
struct acpi_device *acpi_dev;
|
|
|
|
struct sony_pic_irq *cur_irq;
|
|
|
|
struct sony_pic_ioport *cur_ioport;
|
|
|
|
struct list_head interrupts;
|
|
|
|
struct list_head ioports;
|
|
|
|
struct mutex lock;
|
|
|
|
struct sonypi_eventtypes *event_types;
|
|
|
|
int (*handle_irq)(const u8, const u8);
|
2008-01-14 09:05:43 +00:00
|
|
|
int model;
|
|
|
|
u16 evport_offset;
|
2009-09-15 15:05:29 +00:00
|
|
|
u8 camera_power;
|
|
|
|
u8 bluetooth_power;
|
|
|
|
u8 wwan_power;
|
2007-04-09 17:26:03 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
static struct sony_pic_dev spic_dev = {
|
|
|
|
.interrupts = LIST_HEAD_INIT(spic_dev.interrupts),
|
|
|
|
.ioports = LIST_HEAD_INIT(spic_dev.ioports),
|
|
|
|
};
|
|
|
|
|
2009-09-15 15:05:32 +00:00
|
|
|
static int spic_drv_registered;
|
|
|
|
|
2007-04-09 17:26:03 +00:00
|
|
|
/* Event masks */
|
|
|
|
#define SONYPI_JOGGER_MASK 0x00000001
|
|
|
|
#define SONYPI_CAPTURE_MASK 0x00000002
|
|
|
|
#define SONYPI_FNKEY_MASK 0x00000004
|
|
|
|
#define SONYPI_BLUETOOTH_MASK 0x00000008
|
|
|
|
#define SONYPI_PKEY_MASK 0x00000010
|
|
|
|
#define SONYPI_BACK_MASK 0x00000020
|
|
|
|
#define SONYPI_HELP_MASK 0x00000040
|
|
|
|
#define SONYPI_LID_MASK 0x00000080
|
|
|
|
#define SONYPI_ZOOM_MASK 0x00000100
|
|
|
|
#define SONYPI_THUMBPHRASE_MASK 0x00000200
|
|
|
|
#define SONYPI_MEYE_MASK 0x00000400
|
|
|
|
#define SONYPI_MEMORYSTICK_MASK 0x00000800
|
|
|
|
#define SONYPI_BATTERY_MASK 0x00001000
|
|
|
|
#define SONYPI_WIRELESS_MASK 0x00002000
|
|
|
|
|
|
|
|
struct sonypi_event {
|
|
|
|
u8 data;
|
|
|
|
u8 event;
|
|
|
|
};
|
|
|
|
|
|
|
|
/* The set of possible button release events */
|
|
|
|
static struct sonypi_event sonypi_releaseev[] = {
|
|
|
|
{ 0x00, SONYPI_EVENT_ANYBUTTON_RELEASED },
|
|
|
|
{ 0, 0 }
|
|
|
|
};
|
|
|
|
|
|
|
|
/* The set of possible jogger events */
|
|
|
|
static struct sonypi_event sonypi_joggerev[] = {
|
|
|
|
{ 0x1f, SONYPI_EVENT_JOGDIAL_UP },
|
|
|
|
{ 0x01, SONYPI_EVENT_JOGDIAL_DOWN },
|
|
|
|
{ 0x5f, SONYPI_EVENT_JOGDIAL_UP_PRESSED },
|
|
|
|
{ 0x41, SONYPI_EVENT_JOGDIAL_DOWN_PRESSED },
|
|
|
|
{ 0x1e, SONYPI_EVENT_JOGDIAL_FAST_UP },
|
|
|
|
{ 0x02, SONYPI_EVENT_JOGDIAL_FAST_DOWN },
|
|
|
|
{ 0x5e, SONYPI_EVENT_JOGDIAL_FAST_UP_PRESSED },
|
|
|
|
{ 0x42, SONYPI_EVENT_JOGDIAL_FAST_DOWN_PRESSED },
|
|
|
|
{ 0x1d, SONYPI_EVENT_JOGDIAL_VFAST_UP },
|
|
|
|
{ 0x03, SONYPI_EVENT_JOGDIAL_VFAST_DOWN },
|
|
|
|
{ 0x5d, SONYPI_EVENT_JOGDIAL_VFAST_UP_PRESSED },
|
|
|
|
{ 0x43, SONYPI_EVENT_JOGDIAL_VFAST_DOWN_PRESSED },
|
|
|
|
{ 0x40, SONYPI_EVENT_JOGDIAL_PRESSED },
|
|
|
|
{ 0, 0 }
|
|
|
|
};
|
|
|
|
|
|
|
|
/* The set of possible capture button events */
|
|
|
|
static struct sonypi_event sonypi_captureev[] = {
|
|
|
|
{ 0x05, SONYPI_EVENT_CAPTURE_PARTIALPRESSED },
|
|
|
|
{ 0x07, SONYPI_EVENT_CAPTURE_PRESSED },
|
2008-01-14 09:05:45 +00:00
|
|
|
{ 0x40, SONYPI_EVENT_CAPTURE_PRESSED },
|
2007-04-09 17:26:03 +00:00
|
|
|
{ 0x01, SONYPI_EVENT_CAPTURE_PARTIALRELEASED },
|
|
|
|
{ 0, 0 }
|
|
|
|
};
|
|
|
|
|
|
|
|
/* The set of possible fnkeys events */
|
|
|
|
static struct sonypi_event sonypi_fnkeyev[] = {
|
|
|
|
{ 0x10, SONYPI_EVENT_FNKEY_ESC },
|
|
|
|
{ 0x11, SONYPI_EVENT_FNKEY_F1 },
|
|
|
|
{ 0x12, SONYPI_EVENT_FNKEY_F2 },
|
|
|
|
{ 0x13, SONYPI_EVENT_FNKEY_F3 },
|
|
|
|
{ 0x14, SONYPI_EVENT_FNKEY_F4 },
|
|
|
|
{ 0x15, SONYPI_EVENT_FNKEY_F5 },
|
|
|
|
{ 0x16, SONYPI_EVENT_FNKEY_F6 },
|
|
|
|
{ 0x17, SONYPI_EVENT_FNKEY_F7 },
|
|
|
|
{ 0x18, SONYPI_EVENT_FNKEY_F8 },
|
|
|
|
{ 0x19, SONYPI_EVENT_FNKEY_F9 },
|
|
|
|
{ 0x1a, SONYPI_EVENT_FNKEY_F10 },
|
|
|
|
{ 0x1b, SONYPI_EVENT_FNKEY_F11 },
|
|
|
|
{ 0x1c, SONYPI_EVENT_FNKEY_F12 },
|
|
|
|
{ 0x1f, SONYPI_EVENT_FNKEY_RELEASED },
|
|
|
|
{ 0x21, SONYPI_EVENT_FNKEY_1 },
|
|
|
|
{ 0x22, SONYPI_EVENT_FNKEY_2 },
|
|
|
|
{ 0x31, SONYPI_EVENT_FNKEY_D },
|
|
|
|
{ 0x32, SONYPI_EVENT_FNKEY_E },
|
|
|
|
{ 0x33, SONYPI_EVENT_FNKEY_F },
|
|
|
|
{ 0x34, SONYPI_EVENT_FNKEY_S },
|
|
|
|
{ 0x35, SONYPI_EVENT_FNKEY_B },
|
|
|
|
{ 0x36, SONYPI_EVENT_FNKEY_ONLY },
|
|
|
|
{ 0, 0 }
|
|
|
|
};
|
|
|
|
|
|
|
|
/* The set of possible program key events */
|
|
|
|
static struct sonypi_event sonypi_pkeyev[] = {
|
|
|
|
{ 0x01, SONYPI_EVENT_PKEY_P1 },
|
|
|
|
{ 0x02, SONYPI_EVENT_PKEY_P2 },
|
|
|
|
{ 0x04, SONYPI_EVENT_PKEY_P3 },
|
2009-03-26 12:58:18 +00:00
|
|
|
{ 0x20, SONYPI_EVENT_PKEY_P1 },
|
2007-04-09 17:26:03 +00:00
|
|
|
{ 0, 0 }
|
|
|
|
};
|
|
|
|
|
|
|
|
/* The set of possible bluetooth events */
|
|
|
|
static struct sonypi_event sonypi_blueev[] = {
|
|
|
|
{ 0x55, SONYPI_EVENT_BLUETOOTH_PRESSED },
|
|
|
|
{ 0x59, SONYPI_EVENT_BLUETOOTH_ON },
|
|
|
|
{ 0x5a, SONYPI_EVENT_BLUETOOTH_OFF },
|
|
|
|
{ 0, 0 }
|
|
|
|
};
|
|
|
|
|
|
|
|
/* The set of possible wireless events */
|
|
|
|
static struct sonypi_event sonypi_wlessev[] = {
|
2011-02-19 02:52:27 +00:00
|
|
|
{ 0x59, SONYPI_EVENT_IGNORE },
|
|
|
|
{ 0x5a, SONYPI_EVENT_IGNORE },
|
2007-04-09 17:26:03 +00:00
|
|
|
{ 0, 0 }
|
|
|
|
};
|
|
|
|
|
|
|
|
/* The set of possible back button events */
|
|
|
|
static struct sonypi_event sonypi_backev[] = {
|
|
|
|
{ 0x20, SONYPI_EVENT_BACK_PRESSED },
|
|
|
|
{ 0, 0 }
|
|
|
|
};
|
|
|
|
|
|
|
|
/* The set of possible help button events */
|
|
|
|
static struct sonypi_event sonypi_helpev[] = {
|
|
|
|
{ 0x3b, SONYPI_EVENT_HELP_PRESSED },
|
|
|
|
{ 0, 0 }
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
/* The set of possible lid events */
|
|
|
|
static struct sonypi_event sonypi_lidev[] = {
|
|
|
|
{ 0x51, SONYPI_EVENT_LID_CLOSED },
|
|
|
|
{ 0x50, SONYPI_EVENT_LID_OPENED },
|
|
|
|
{ 0, 0 }
|
|
|
|
};
|
|
|
|
|
|
|
|
/* The set of possible zoom events */
|
|
|
|
static struct sonypi_event sonypi_zoomev[] = {
|
|
|
|
{ 0x39, SONYPI_EVENT_ZOOM_PRESSED },
|
2008-01-14 09:05:45 +00:00
|
|
|
{ 0x10, SONYPI_EVENT_ZOOM_IN_PRESSED },
|
|
|
|
{ 0x20, SONYPI_EVENT_ZOOM_OUT_PRESSED },
|
2009-03-26 12:58:18 +00:00
|
|
|
{ 0x04, SONYPI_EVENT_ZOOM_PRESSED },
|
2007-04-09 17:26:03 +00:00
|
|
|
{ 0, 0 }
|
|
|
|
};
|
|
|
|
|
|
|
|
/* The set of possible thumbphrase events */
|
|
|
|
static struct sonypi_event sonypi_thumbphraseev[] = {
|
|
|
|
{ 0x3a, SONYPI_EVENT_THUMBPHRASE_PRESSED },
|
|
|
|
{ 0, 0 }
|
|
|
|
};
|
|
|
|
|
|
|
|
/* The set of possible motioneye camera events */
|
|
|
|
static struct sonypi_event sonypi_meyeev[] = {
|
|
|
|
{ 0x00, SONYPI_EVENT_MEYE_FACE },
|
|
|
|
{ 0x01, SONYPI_EVENT_MEYE_OPPOSITE },
|
|
|
|
{ 0, 0 }
|
|
|
|
};
|
|
|
|
|
|
|
|
/* The set of possible memorystick events */
|
|
|
|
static struct sonypi_event sonypi_memorystickev[] = {
|
|
|
|
{ 0x53, SONYPI_EVENT_MEMORYSTICK_INSERT },
|
|
|
|
{ 0x54, SONYPI_EVENT_MEMORYSTICK_EJECT },
|
|
|
|
{ 0, 0 }
|
|
|
|
};
|
|
|
|
|
|
|
|
/* The set of possible battery events */
|
|
|
|
static struct sonypi_event sonypi_batteryev[] = {
|
|
|
|
{ 0x20, SONYPI_EVENT_BATTERY_INSERT },
|
|
|
|
{ 0x30, SONYPI_EVENT_BATTERY_REMOVE },
|
|
|
|
{ 0, 0 }
|
|
|
|
};
|
|
|
|
|
2009-03-26 12:58:18 +00:00
|
|
|
/* The set of possible volume events */
|
|
|
|
static struct sonypi_event sonypi_volumeev[] = {
|
|
|
|
{ 0x01, SONYPI_EVENT_VOLUME_INC_PRESSED },
|
|
|
|
{ 0x02, SONYPI_EVENT_VOLUME_DEC_PRESSED },
|
|
|
|
{ 0, 0 }
|
|
|
|
};
|
|
|
|
|
|
|
|
/* The set of possible brightness events */
|
|
|
|
static struct sonypi_event sonypi_brightnessev[] = {
|
|
|
|
{ 0x80, SONYPI_EVENT_BRIGHTNESS_PRESSED },
|
|
|
|
{ 0, 0 }
|
|
|
|
};
|
|
|
|
|
2008-01-14 09:05:43 +00:00
|
|
|
static struct sonypi_eventtypes type1_events[] = {
|
|
|
|
{ 0, 0xffffffff, sonypi_releaseev },
|
|
|
|
{ 0x70, SONYPI_MEYE_MASK, sonypi_meyeev },
|
|
|
|
{ 0x30, SONYPI_LID_MASK, sonypi_lidev },
|
|
|
|
{ 0x60, SONYPI_CAPTURE_MASK, sonypi_captureev },
|
|
|
|
{ 0x10, SONYPI_JOGGER_MASK, sonypi_joggerev },
|
|
|
|
{ 0x20, SONYPI_FNKEY_MASK, sonypi_fnkeyev },
|
|
|
|
{ 0x30, SONYPI_BLUETOOTH_MASK, sonypi_blueev },
|
|
|
|
{ 0x40, SONYPI_PKEY_MASK, sonypi_pkeyev },
|
|
|
|
{ 0x30, SONYPI_MEMORYSTICK_MASK, sonypi_memorystickev },
|
|
|
|
{ 0x40, SONYPI_BATTERY_MASK, sonypi_batteryev },
|
|
|
|
{ 0 },
|
|
|
|
};
|
|
|
|
static struct sonypi_eventtypes type2_events[] = {
|
|
|
|
{ 0, 0xffffffff, sonypi_releaseev },
|
|
|
|
{ 0x38, SONYPI_LID_MASK, sonypi_lidev },
|
|
|
|
{ 0x11, SONYPI_JOGGER_MASK, sonypi_joggerev },
|
|
|
|
{ 0x61, SONYPI_CAPTURE_MASK, sonypi_captureev },
|
|
|
|
{ 0x21, SONYPI_FNKEY_MASK, sonypi_fnkeyev },
|
|
|
|
{ 0x31, SONYPI_BLUETOOTH_MASK, sonypi_blueev },
|
|
|
|
{ 0x08, SONYPI_PKEY_MASK, sonypi_pkeyev },
|
|
|
|
{ 0x11, SONYPI_BACK_MASK, sonypi_backev },
|
|
|
|
{ 0x21, SONYPI_HELP_MASK, sonypi_helpev },
|
|
|
|
{ 0x21, SONYPI_ZOOM_MASK, sonypi_zoomev },
|
|
|
|
{ 0x20, SONYPI_THUMBPHRASE_MASK, sonypi_thumbphraseev },
|
|
|
|
{ 0x31, SONYPI_MEMORYSTICK_MASK, sonypi_memorystickev },
|
|
|
|
{ 0x41, SONYPI_BATTERY_MASK, sonypi_batteryev },
|
|
|
|
{ 0x31, SONYPI_PKEY_MASK, sonypi_pkeyev },
|
|
|
|
{ 0 },
|
|
|
|
};
|
|
|
|
static struct sonypi_eventtypes type3_events[] = {
|
|
|
|
{ 0, 0xffffffff, sonypi_releaseev },
|
|
|
|
{ 0x21, SONYPI_FNKEY_MASK, sonypi_fnkeyev },
|
|
|
|
{ 0x31, SONYPI_WIRELESS_MASK, sonypi_wlessev },
|
|
|
|
{ 0x31, SONYPI_MEMORYSTICK_MASK, sonypi_memorystickev },
|
|
|
|
{ 0x41, SONYPI_BATTERY_MASK, sonypi_batteryev },
|
|
|
|
{ 0x31, SONYPI_PKEY_MASK, sonypi_pkeyev },
|
2008-01-14 09:05:45 +00:00
|
|
|
{ 0x05, SONYPI_PKEY_MASK, sonypi_pkeyev },
|
|
|
|
{ 0x05, SONYPI_ZOOM_MASK, sonypi_zoomev },
|
|
|
|
{ 0x05, SONYPI_CAPTURE_MASK, sonypi_captureev },
|
2009-03-26 12:58:18 +00:00
|
|
|
{ 0x05, SONYPI_PKEY_MASK, sonypi_volumeev },
|
|
|
|
{ 0x05, SONYPI_PKEY_MASK, sonypi_brightnessev },
|
2008-01-14 09:05:45 +00:00
|
|
|
{ 0 },
|
2008-01-14 09:05:43 +00:00
|
|
|
};
|
|
|
|
|
2008-01-14 09:05:45 +00:00
|
|
|
/* low level spic calls */
|
2007-04-09 17:26:03 +00:00
|
|
|
#define ITERATIONS_LONG 10000
|
|
|
|
#define ITERATIONS_SHORT 10
|
|
|
|
#define wait_on_command(command, iterations) { \
|
|
|
|
unsigned int n = iterations; \
|
|
|
|
while (--n && (command)) \
|
|
|
|
udelay(1); \
|
|
|
|
if (!n) \
|
|
|
|
dprintk("command failed at %s : %s (line %d)\n", \
|
2008-04-29 07:59:20 +00:00
|
|
|
__FILE__, __func__, __LINE__); \
|
2007-04-09 17:26:03 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static u8 sony_pic_call1(u8 dev)
|
|
|
|
{
|
|
|
|
u8 v1, v2;
|
|
|
|
|
2007-08-12 07:20:28 +00:00
|
|
|
wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2,
|
2007-04-09 17:26:03 +00:00
|
|
|
ITERATIONS_LONG);
|
2007-08-12 07:20:28 +00:00
|
|
|
outb(dev, spic_dev.cur_ioport->io1.minimum + 4);
|
|
|
|
v1 = inb_p(spic_dev.cur_ioport->io1.minimum + 4);
|
|
|
|
v2 = inb_p(spic_dev.cur_ioport->io1.minimum);
|
2008-01-14 09:05:41 +00:00
|
|
|
dprintk("sony_pic_call1(0x%.2x): 0x%.4x\n", dev, (v2 << 8) | v1);
|
2007-04-09 17:26:03 +00:00
|
|
|
return v2;
|
|
|
|
}
|
|
|
|
|
|
|
|
static u8 sony_pic_call2(u8 dev, u8 fn)
|
|
|
|
{
|
|
|
|
u8 v1;
|
|
|
|
|
2007-08-12 07:20:28 +00:00
|
|
|
wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2,
|
2007-04-09 17:26:03 +00:00
|
|
|
ITERATIONS_LONG);
|
2007-08-12 07:20:28 +00:00
|
|
|
outb(dev, spic_dev.cur_ioport->io1.minimum + 4);
|
|
|
|
wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2,
|
2007-04-09 17:26:03 +00:00
|
|
|
ITERATIONS_LONG);
|
2007-08-12 07:20:28 +00:00
|
|
|
outb(fn, spic_dev.cur_ioport->io1.minimum);
|
|
|
|
v1 = inb_p(spic_dev.cur_ioport->io1.minimum);
|
2008-01-14 09:05:41 +00:00
|
|
|
dprintk("sony_pic_call2(0x%.2x - 0x%.2x): 0x%.4x\n", dev, fn, v1);
|
2007-04-09 17:26:03 +00:00
|
|
|
return v1;
|
|
|
|
}
|
|
|
|
|
2007-04-09 17:28:56 +00:00
|
|
|
static u8 sony_pic_call3(u8 dev, u8 fn, u8 v)
|
|
|
|
{
|
|
|
|
u8 v1;
|
|
|
|
|
2007-08-12 07:20:28 +00:00
|
|
|
wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2, ITERATIONS_LONG);
|
|
|
|
outb(dev, spic_dev.cur_ioport->io1.minimum + 4);
|
|
|
|
wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2, ITERATIONS_LONG);
|
|
|
|
outb(fn, spic_dev.cur_ioport->io1.minimum);
|
|
|
|
wait_on_command(inb_p(spic_dev.cur_ioport->io1.minimum + 4) & 2, ITERATIONS_LONG);
|
|
|
|
outb(v, spic_dev.cur_ioport->io1.minimum);
|
|
|
|
v1 = inb_p(spic_dev.cur_ioport->io1.minimum);
|
2008-01-14 09:05:41 +00:00
|
|
|
dprintk("sony_pic_call3(0x%.2x - 0x%.2x - 0x%.2x): 0x%.4x\n",
|
|
|
|
dev, fn, v, v1);
|
2007-04-09 17:28:56 +00:00
|
|
|
return v1;
|
|
|
|
}
|
|
|
|
|
2008-01-14 09:05:45 +00:00
|
|
|
/*
|
|
|
|
* minidrivers for SPIC models
|
|
|
|
*/
|
2009-03-26 12:58:17 +00:00
|
|
|
static int type3_handle_irq(const u8 data_mask, const u8 ev)
|
2008-01-14 09:05:45 +00:00
|
|
|
{
|
|
|
|
/*
|
|
|
|
* 0x31 could mean we have to take some extra action and wait for
|
2009-03-26 12:58:17 +00:00
|
|
|
* the next irq for some Type3 models, it will generate a new
|
2008-01-14 09:05:45 +00:00
|
|
|
* irq and we can read new data from the device:
|
|
|
|
* - 0x5c and 0x5f requires 0xA0
|
|
|
|
* - 0x61 requires 0xB3
|
|
|
|
*/
|
|
|
|
if (data_mask == 0x31) {
|
|
|
|
if (ev == 0x5c || ev == 0x5f)
|
|
|
|
sony_pic_call1(0xA0);
|
|
|
|
else if (ev == 0x61)
|
|
|
|
sony_pic_call1(0xB3);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void sony_pic_detect_device_type(struct sony_pic_dev *dev)
|
|
|
|
{
|
|
|
|
struct pci_dev *pcidev;
|
|
|
|
|
|
|
|
pcidev = pci_get_device(PCI_VENDOR_ID_INTEL,
|
|
|
|
PCI_DEVICE_ID_INTEL_82371AB_3, NULL);
|
|
|
|
if (pcidev) {
|
2009-09-15 15:05:29 +00:00
|
|
|
dev->model = SONYPI_DEVICE_TYPE1;
|
|
|
|
dev->evport_offset = SONYPI_TYPE1_OFFSET;
|
|
|
|
dev->event_types = type1_events;
|
2008-01-14 09:05:45 +00:00
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
|
|
|
|
pcidev = pci_get_device(PCI_VENDOR_ID_INTEL,
|
|
|
|
PCI_DEVICE_ID_INTEL_ICH6_1, NULL);
|
|
|
|
if (pcidev) {
|
2009-09-15 15:05:29 +00:00
|
|
|
dev->model = SONYPI_DEVICE_TYPE2;
|
|
|
|
dev->evport_offset = SONYPI_TYPE2_OFFSET;
|
|
|
|
dev->event_types = type2_events;
|
2008-01-14 09:05:45 +00:00
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
|
|
|
|
pcidev = pci_get_device(PCI_VENDOR_ID_INTEL,
|
|
|
|
PCI_DEVICE_ID_INTEL_ICH7_1, NULL);
|
|
|
|
if (pcidev) {
|
2009-09-15 15:05:29 +00:00
|
|
|
dev->model = SONYPI_DEVICE_TYPE3;
|
|
|
|
dev->handle_irq = type3_handle_irq;
|
|
|
|
dev->evport_offset = SONYPI_TYPE3_OFFSET;
|
|
|
|
dev->event_types = type3_events;
|
2008-01-14 09:05:45 +00:00
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
|
|
|
|
pcidev = pci_get_device(PCI_VENDOR_ID_INTEL,
|
|
|
|
PCI_DEVICE_ID_INTEL_ICH8_4, NULL);
|
|
|
|
if (pcidev) {
|
2009-09-15 15:05:29 +00:00
|
|
|
dev->model = SONYPI_DEVICE_TYPE3;
|
|
|
|
dev->handle_irq = type3_handle_irq;
|
|
|
|
dev->evport_offset = SONYPI_TYPE3_OFFSET;
|
|
|
|
dev->event_types = type3_events;
|
2008-01-14 09:05:45 +00:00
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
|
2009-03-26 12:58:20 +00:00
|
|
|
pcidev = pci_get_device(PCI_VENDOR_ID_INTEL,
|
|
|
|
PCI_DEVICE_ID_INTEL_ICH9_1, NULL);
|
|
|
|
if (pcidev) {
|
2009-09-15 15:05:29 +00:00
|
|
|
dev->model = SONYPI_DEVICE_TYPE3;
|
|
|
|
dev->handle_irq = type3_handle_irq;
|
|
|
|
dev->evport_offset = SONYPI_TYPE3_OFFSET;
|
|
|
|
dev->event_types = type3_events;
|
2009-03-26 12:58:20 +00:00
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
|
2008-01-14 09:05:45 +00:00
|
|
|
/* default */
|
2009-09-15 15:05:29 +00:00
|
|
|
dev->model = SONYPI_DEVICE_TYPE2;
|
|
|
|
dev->evport_offset = SONYPI_TYPE2_OFFSET;
|
|
|
|
dev->event_types = type2_events;
|
2008-01-14 09:05:45 +00:00
|
|
|
|
|
|
|
out:
|
|
|
|
if (pcidev)
|
|
|
|
pci_dev_put(pcidev);
|
|
|
|
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_info(DRV_PFX "detected Type%d model\n",
|
2009-09-15 15:05:29 +00:00
|
|
|
dev->model == SONYPI_DEVICE_TYPE1 ? 1 :
|
|
|
|
dev->model == SONYPI_DEVICE_TYPE2 ? 2 : 3);
|
2008-01-14 09:05:45 +00:00
|
|
|
}
|
|
|
|
|
2007-04-09 17:28:56 +00:00
|
|
|
/* camera tests and poweron/poweroff */
|
|
|
|
#define SONYPI_CAMERA_PICTURE 5
|
|
|
|
#define SONYPI_CAMERA_CONTROL 0x10
|
2007-04-28 14:34:22 +00:00
|
|
|
|
|
|
|
#define SONYPI_CAMERA_BRIGHTNESS 0
|
|
|
|
#define SONYPI_CAMERA_CONTRAST 1
|
|
|
|
#define SONYPI_CAMERA_HUE 2
|
|
|
|
#define SONYPI_CAMERA_COLOR 3
|
|
|
|
#define SONYPI_CAMERA_SHARPNESS 4
|
|
|
|
|
|
|
|
#define SONYPI_CAMERA_EXPOSURE_MASK 0xC
|
|
|
|
#define SONYPI_CAMERA_WHITE_BALANCE_MASK 0x3
|
|
|
|
#define SONYPI_CAMERA_PICTURE_MODE_MASK 0x30
|
|
|
|
#define SONYPI_CAMERA_MUTE_MASK 0x40
|
|
|
|
|
|
|
|
/* the rest don't need a loop until not 0xff */
|
|
|
|
#define SONYPI_CAMERA_AGC 6
|
|
|
|
#define SONYPI_CAMERA_AGC_MASK 0x30
|
|
|
|
#define SONYPI_CAMERA_SHUTTER_MASK 0x7
|
|
|
|
|
|
|
|
#define SONYPI_CAMERA_SHUTDOWN_REQUEST 7
|
|
|
|
#define SONYPI_CAMERA_CONTROL 0x10
|
|
|
|
|
|
|
|
#define SONYPI_CAMERA_STATUS 7
|
|
|
|
#define SONYPI_CAMERA_STATUS_READY 0x2
|
|
|
|
#define SONYPI_CAMERA_STATUS_POSITION 0x4
|
|
|
|
|
|
|
|
#define SONYPI_DIRECTION_BACKWARDS 0x4
|
|
|
|
|
|
|
|
#define SONYPI_CAMERA_REVISION 8
|
|
|
|
#define SONYPI_CAMERA_ROMVERSION 9
|
2007-04-09 17:28:56 +00:00
|
|
|
|
2007-04-28 14:19:36 +00:00
|
|
|
static int __sony_pic_camera_ready(void)
|
2007-04-09 17:28:56 +00:00
|
|
|
{
|
|
|
|
u8 v;
|
|
|
|
|
|
|
|
v = sony_pic_call2(0x8f, SONYPI_CAMERA_STATUS);
|
|
|
|
return (v != 0xff && (v & SONYPI_CAMERA_STATUS_READY));
|
|
|
|
}
|
|
|
|
|
2007-04-28 14:34:22 +00:00
|
|
|
static int __sony_pic_camera_off(void)
|
2007-04-09 17:28:56 +00:00
|
|
|
{
|
2007-04-28 14:18:45 +00:00
|
|
|
if (!camera) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_warn(DRV_PFX "camera control not enabled\n");
|
2007-04-28 14:18:45 +00:00
|
|
|
return -ENODEV;
|
|
|
|
}
|
|
|
|
|
2007-04-09 17:28:56 +00:00
|
|
|
wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_PICTURE,
|
|
|
|
SONYPI_CAMERA_MUTE_MASK),
|
|
|
|
ITERATIONS_SHORT);
|
|
|
|
|
2007-04-28 14:18:45 +00:00
|
|
|
if (spic_dev.camera_power) {
|
|
|
|
sony_pic_call2(0x91, 0);
|
|
|
|
spic_dev.camera_power = 0;
|
|
|
|
}
|
|
|
|
return 0;
|
2007-04-09 17:28:56 +00:00
|
|
|
}
|
|
|
|
|
2007-04-28 14:34:22 +00:00
|
|
|
static int __sony_pic_camera_on(void)
|
2007-04-09 17:28:56 +00:00
|
|
|
{
|
2007-04-28 14:18:45 +00:00
|
|
|
int i, j, x;
|
|
|
|
|
|
|
|
if (!camera) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_warn(DRV_PFX "camera control not enabled\n");
|
2007-04-28 14:18:45 +00:00
|
|
|
return -ENODEV;
|
|
|
|
}
|
2007-04-09 17:28:56 +00:00
|
|
|
|
|
|
|
if (spic_dev.camera_power)
|
2007-04-28 14:34:22 +00:00
|
|
|
return 0;
|
2007-04-09 17:28:56 +00:00
|
|
|
|
|
|
|
for (j = 5; j > 0; j--) {
|
|
|
|
|
2007-04-28 14:18:45 +00:00
|
|
|
for (x = 0; x < 100 && sony_pic_call2(0x91, 0x1); x++)
|
2007-04-09 17:28:56 +00:00
|
|
|
msleep(10);
|
|
|
|
sony_pic_call1(0x93);
|
|
|
|
|
|
|
|
for (i = 400; i > 0; i--) {
|
2007-04-28 14:19:36 +00:00
|
|
|
if (__sony_pic_camera_ready())
|
2007-04-09 17:28:56 +00:00
|
|
|
break;
|
|
|
|
msleep(10);
|
|
|
|
}
|
|
|
|
if (i)
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (j == 0) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_warn(DRV_PFX "failed to power on camera\n");
|
2007-04-28 14:34:22 +00:00
|
|
|
return -ENODEV;
|
2007-04-09 17:28:56 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_CONTROL,
|
|
|
|
0x5a),
|
|
|
|
ITERATIONS_SHORT);
|
|
|
|
|
|
|
|
spic_dev.camera_power = 1;
|
2007-04-28 14:18:45 +00:00
|
|
|
return 0;
|
2007-04-09 17:28:56 +00:00
|
|
|
}
|
|
|
|
|
2007-04-28 14:34:22 +00:00
|
|
|
/* External camera command (exported to the motion eye v4l driver) */
|
|
|
|
int sony_pic_camera_command(int command, u8 value)
|
|
|
|
{
|
|
|
|
if (!camera)
|
|
|
|
return -EIO;
|
|
|
|
|
|
|
|
mutex_lock(&spic_dev.lock);
|
|
|
|
|
|
|
|
switch (command) {
|
2007-04-28 14:34:36 +00:00
|
|
|
case SONY_PIC_COMMAND_SETCAMERA:
|
2007-04-28 14:34:22 +00:00
|
|
|
if (value)
|
|
|
|
__sony_pic_camera_on();
|
|
|
|
else
|
|
|
|
__sony_pic_camera_off();
|
|
|
|
break;
|
2007-04-28 14:34:36 +00:00
|
|
|
case SONY_PIC_COMMAND_SETCAMERABRIGHTNESS:
|
2007-04-28 14:34:22 +00:00
|
|
|
wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_BRIGHTNESS, value),
|
|
|
|
ITERATIONS_SHORT);
|
|
|
|
break;
|
2007-04-28 14:34:36 +00:00
|
|
|
case SONY_PIC_COMMAND_SETCAMERACONTRAST:
|
2007-04-28 14:34:22 +00:00
|
|
|
wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_CONTRAST, value),
|
|
|
|
ITERATIONS_SHORT);
|
|
|
|
break;
|
2007-04-28 14:34:36 +00:00
|
|
|
case SONY_PIC_COMMAND_SETCAMERAHUE:
|
2007-04-28 14:34:22 +00:00
|
|
|
wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_HUE, value),
|
|
|
|
ITERATIONS_SHORT);
|
|
|
|
break;
|
2007-04-28 14:34:36 +00:00
|
|
|
case SONY_PIC_COMMAND_SETCAMERACOLOR:
|
2007-04-28 14:34:22 +00:00
|
|
|
wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_COLOR, value),
|
|
|
|
ITERATIONS_SHORT);
|
|
|
|
break;
|
2007-04-28 14:34:36 +00:00
|
|
|
case SONY_PIC_COMMAND_SETCAMERASHARPNESS:
|
2007-04-28 14:34:22 +00:00
|
|
|
wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_SHARPNESS, value),
|
|
|
|
ITERATIONS_SHORT);
|
|
|
|
break;
|
2007-04-28 14:34:36 +00:00
|
|
|
case SONY_PIC_COMMAND_SETCAMERAPICTURE:
|
2007-04-28 14:34:22 +00:00
|
|
|
wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_PICTURE, value),
|
|
|
|
ITERATIONS_SHORT);
|
|
|
|
break;
|
2007-04-28 14:34:36 +00:00
|
|
|
case SONY_PIC_COMMAND_SETCAMERAAGC:
|
2007-04-28 14:34:22 +00:00
|
|
|
wait_on_command(sony_pic_call3(0x90, SONYPI_CAMERA_AGC, value),
|
|
|
|
ITERATIONS_SHORT);
|
|
|
|
break;
|
|
|
|
default:
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_err(DRV_PFX "sony_pic_camera_command invalid: %d\n",
|
2007-04-28 14:34:22 +00:00
|
|
|
command);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
mutex_unlock(&spic_dev.lock);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(sony_pic_camera_command);
|
|
|
|
|
2007-04-28 14:21:42 +00:00
|
|
|
/* gprs/edge modem (SZ460N and SZ210P), thanks to Joshua Wise */
|
2009-03-26 12:58:23 +00:00
|
|
|
static void __sony_pic_set_wwanpower(u8 state)
|
2007-04-28 14:21:42 +00:00
|
|
|
{
|
|
|
|
state = !!state;
|
2009-03-26 12:58:23 +00:00
|
|
|
if (spic_dev.wwan_power == state)
|
2007-04-28 14:21:42 +00:00
|
|
|
return;
|
|
|
|
sony_pic_call2(0xB0, state);
|
2009-03-26 12:58:21 +00:00
|
|
|
sony_pic_call1(0x82);
|
2007-04-28 14:21:42 +00:00
|
|
|
spic_dev.wwan_power = state;
|
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t sony_pic_wwanpower_store(struct device *dev,
|
|
|
|
struct device_attribute *attr,
|
|
|
|
const char *buffer, size_t count)
|
|
|
|
{
|
|
|
|
unsigned long value;
|
|
|
|
if (count > 31)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
value = simple_strtoul(buffer, NULL, 10);
|
2009-03-26 12:58:23 +00:00
|
|
|
mutex_lock(&spic_dev.lock);
|
|
|
|
__sony_pic_set_wwanpower(value);
|
|
|
|
mutex_unlock(&spic_dev.lock);
|
2007-04-28 14:21:42 +00:00
|
|
|
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t sony_pic_wwanpower_show(struct device *dev,
|
|
|
|
struct device_attribute *attr, char *buffer)
|
|
|
|
{
|
|
|
|
ssize_t count;
|
|
|
|
mutex_lock(&spic_dev.lock);
|
|
|
|
count = snprintf(buffer, PAGE_SIZE, "%d\n", spic_dev.wwan_power);
|
|
|
|
mutex_unlock(&spic_dev.lock);
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
2007-04-09 17:28:56 +00:00
|
|
|
/* bluetooth subsystem power state */
|
2007-04-28 14:19:36 +00:00
|
|
|
static void __sony_pic_set_bluetoothpower(u8 state)
|
2007-04-09 17:28:56 +00:00
|
|
|
{
|
|
|
|
state = !!state;
|
|
|
|
if (spic_dev.bluetooth_power == state)
|
|
|
|
return;
|
|
|
|
sony_pic_call2(0x96, state);
|
|
|
|
sony_pic_call1(0x82);
|
|
|
|
spic_dev.bluetooth_power = state;
|
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t sony_pic_bluetoothpower_store(struct device *dev,
|
|
|
|
struct device_attribute *attr,
|
|
|
|
const char *buffer, size_t count)
|
|
|
|
{
|
|
|
|
unsigned long value;
|
|
|
|
if (count > 31)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
value = simple_strtoul(buffer, NULL, 10);
|
2007-04-28 14:19:36 +00:00
|
|
|
mutex_lock(&spic_dev.lock);
|
|
|
|
__sony_pic_set_bluetoothpower(value);
|
|
|
|
mutex_unlock(&spic_dev.lock);
|
2007-04-09 17:28:56 +00:00
|
|
|
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t sony_pic_bluetoothpower_show(struct device *dev,
|
|
|
|
struct device_attribute *attr, char *buffer)
|
|
|
|
{
|
2007-04-28 14:19:36 +00:00
|
|
|
ssize_t count = 0;
|
|
|
|
mutex_lock(&spic_dev.lock);
|
|
|
|
count = snprintf(buffer, PAGE_SIZE, "%d\n", spic_dev.bluetooth_power);
|
|
|
|
mutex_unlock(&spic_dev.lock);
|
|
|
|
return count;
|
2007-04-09 17:28:56 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/* fan speed */
|
|
|
|
/* FAN0 information (reverse engineered from ACPI tables) */
|
|
|
|
#define SONY_PIC_FAN0_STATUS 0x93
|
2007-04-09 17:31:25 +00:00
|
|
|
static int sony_pic_set_fanspeed(unsigned long value)
|
|
|
|
{
|
|
|
|
return ec_write(SONY_PIC_FAN0_STATUS, value);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int sony_pic_get_fanspeed(u8 *value)
|
|
|
|
{
|
|
|
|
return ec_read(SONY_PIC_FAN0_STATUS, value);
|
|
|
|
}
|
|
|
|
|
2007-04-09 17:28:56 +00:00
|
|
|
static ssize_t sony_pic_fanspeed_store(struct device *dev,
|
|
|
|
struct device_attribute *attr,
|
|
|
|
const char *buffer, size_t count)
|
|
|
|
{
|
|
|
|
unsigned long value;
|
|
|
|
if (count > 31)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
value = simple_strtoul(buffer, NULL, 10);
|
2007-04-09 17:31:25 +00:00
|
|
|
if (sony_pic_set_fanspeed(value))
|
2007-04-09 17:28:56 +00:00
|
|
|
return -EIO;
|
|
|
|
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t sony_pic_fanspeed_show(struct device *dev,
|
|
|
|
struct device_attribute *attr, char *buffer)
|
|
|
|
{
|
|
|
|
u8 value = 0;
|
2007-04-09 17:31:25 +00:00
|
|
|
if (sony_pic_get_fanspeed(&value))
|
2007-04-09 17:28:56 +00:00
|
|
|
return -EIO;
|
|
|
|
|
|
|
|
return snprintf(buffer, PAGE_SIZE, "%d\n", value);
|
|
|
|
}
|
|
|
|
|
|
|
|
#define SPIC_ATTR(_name, _mode) \
|
|
|
|
struct device_attribute spic_attr_##_name = __ATTR(_name, \
|
|
|
|
_mode, sony_pic_## _name ##_show, \
|
|
|
|
sony_pic_## _name ##_store)
|
|
|
|
|
|
|
|
static SPIC_ATTR(bluetoothpower, 0644);
|
2007-04-28 14:21:42 +00:00
|
|
|
static SPIC_ATTR(wwanpower, 0644);
|
2007-04-09 17:28:56 +00:00
|
|
|
static SPIC_ATTR(fanspeed, 0644);
|
|
|
|
|
|
|
|
static struct attribute *spic_attributes[] = {
|
|
|
|
&spic_attr_bluetoothpower.attr,
|
2007-04-28 14:21:42 +00:00
|
|
|
&spic_attr_wwanpower.attr,
|
2007-04-09 17:28:56 +00:00
|
|
|
&spic_attr_fanspeed.attr,
|
|
|
|
NULL
|
|
|
|
};
|
|
|
|
|
|
|
|
static struct attribute_group spic_attribute_group = {
|
|
|
|
.attrs = spic_attributes
|
|
|
|
};
|
|
|
|
|
2007-04-09 17:31:25 +00:00
|
|
|
/******** SONYPI compatibility **********/
|
2007-05-01 02:19:53 +00:00
|
|
|
#ifdef CONFIG_SONYPI_COMPAT
|
2007-04-09 17:31:25 +00:00
|
|
|
|
|
|
|
/* battery / brightness / temperature addresses */
|
|
|
|
#define SONYPI_BAT_FLAGS 0x81
|
|
|
|
#define SONYPI_LCD_LIGHT 0x96
|
|
|
|
#define SONYPI_BAT1_PCTRM 0xa0
|
|
|
|
#define SONYPI_BAT1_LEFT 0xa2
|
|
|
|
#define SONYPI_BAT1_MAXRT 0xa4
|
|
|
|
#define SONYPI_BAT2_PCTRM 0xa8
|
|
|
|
#define SONYPI_BAT2_LEFT 0xaa
|
|
|
|
#define SONYPI_BAT2_MAXRT 0xac
|
|
|
|
#define SONYPI_BAT1_MAXTK 0xb0
|
|
|
|
#define SONYPI_BAT1_FULL 0xb2
|
|
|
|
#define SONYPI_BAT2_MAXTK 0xb8
|
|
|
|
#define SONYPI_BAT2_FULL 0xba
|
|
|
|
#define SONYPI_TEMP_STATUS 0xC1
|
|
|
|
|
|
|
|
struct sonypi_compat_s {
|
|
|
|
struct fasync_struct *fifo_async;
|
kfifo: move struct kfifo in place
This is a new generic kernel FIFO implementation.
The current kernel fifo API is not very widely used, because it has to
many constrains. Only 17 files in the current 2.6.31-rc5 used it.
FIFO's are like list's a very basic thing and a kfifo API which handles
the most use case would save a lot of development time and memory
resources.
I think this are the reasons why kfifo is not in use:
- The API is to simple, important functions are missing
- A fifo can be only allocated dynamically
- There is a requirement of a spinlock whether you need it or not
- There is no support for data records inside a fifo
So I decided to extend the kfifo in a more generic way without blowing up
the API to much. The new API has the following benefits:
- Generic usage: For kernel internal use and/or device driver.
- Provide an API for the most use case.
- Slim API: The whole API provides 25 functions.
- Linux style habit.
- DECLARE_KFIFO, DEFINE_KFIFO and INIT_KFIFO Macros
- Direct copy_to_user from the fifo and copy_from_user into the fifo.
- The kfifo itself is an in place member of the using data structure, this save an
indirection access and does not waste the kernel allocator.
- Lockless access: if only one reader and one writer is active on the fifo,
which is the common use case, no additional locking is necessary.
- Remove spinlock - give the user the freedom of choice what kind of locking to use if
one is required.
- Ability to handle records. Three type of records are supported:
- Variable length records between 0-255 bytes, with a record size
field of 1 bytes.
- Variable length records between 0-65535 bytes, with a record size
field of 2 bytes.
- Fixed size records, which no record size field.
- Preserve memory resource.
- Performance!
- Easy to use!
This patch:
Since most users want to have the kfifo as part of another object,
reorganize the code to allow including struct kfifo in another data
structure. This requires changing the kfifo_alloc and kfifo_init
prototypes so that we pass an existing kfifo pointer into them. This
patch changes the implementation and all existing users.
[akpm@linux-foundation.org: fix warning]
Signed-off-by: Stefani Seibold <stefani@seibold.net>
Acked-by: Greg Kroah-Hartman <gregkh@suse.de>
Acked-by: Mauro Carvalho Chehab <mchehab@redhat.com>
Acked-by: Andi Kleen <ak@linux.intel.com>
Acked-by: Arnd Bergmann <arnd@arndb.de>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
2009-12-21 22:37:26 +00:00
|
|
|
struct kfifo fifo;
|
2007-04-09 17:31:25 +00:00
|
|
|
spinlock_t fifo_lock;
|
|
|
|
wait_queue_head_t fifo_proc_list;
|
|
|
|
atomic_t open_count;
|
|
|
|
};
|
|
|
|
static struct sonypi_compat_s sonypi_compat = {
|
|
|
|
.open_count = ATOMIC_INIT(0),
|
|
|
|
};
|
|
|
|
|
|
|
|
static int sonypi_misc_fasync(int fd, struct file *filp, int on)
|
|
|
|
{
|
2009-02-01 21:52:56 +00:00
|
|
|
return fasync_helper(fd, filp, on, &sonypi_compat.fifo_async);
|
2007-04-09 17:31:25 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static int sonypi_misc_release(struct inode *inode, struct file *file)
|
|
|
|
{
|
|
|
|
atomic_dec(&sonypi_compat.open_count);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int sonypi_misc_open(struct inode *inode, struct file *file)
|
|
|
|
{
|
|
|
|
/* Flush input queue on first open */
|
2009-03-26 12:58:25 +00:00
|
|
|
unsigned long flags;
|
|
|
|
|
kfifo: move struct kfifo in place
This is a new generic kernel FIFO implementation.
The current kernel fifo API is not very widely used, because it has to
many constrains. Only 17 files in the current 2.6.31-rc5 used it.
FIFO's are like list's a very basic thing and a kfifo API which handles
the most use case would save a lot of development time and memory
resources.
I think this are the reasons why kfifo is not in use:
- The API is to simple, important functions are missing
- A fifo can be only allocated dynamically
- There is a requirement of a spinlock whether you need it or not
- There is no support for data records inside a fifo
So I decided to extend the kfifo in a more generic way without blowing up
the API to much. The new API has the following benefits:
- Generic usage: For kernel internal use and/or device driver.
- Provide an API for the most use case.
- Slim API: The whole API provides 25 functions.
- Linux style habit.
- DECLARE_KFIFO, DEFINE_KFIFO and INIT_KFIFO Macros
- Direct copy_to_user from the fifo and copy_from_user into the fifo.
- The kfifo itself is an in place member of the using data structure, this save an
indirection access and does not waste the kernel allocator.
- Lockless access: if only one reader and one writer is active on the fifo,
which is the common use case, no additional locking is necessary.
- Remove spinlock - give the user the freedom of choice what kind of locking to use if
one is required.
- Ability to handle records. Three type of records are supported:
- Variable length records between 0-255 bytes, with a record size
field of 1 bytes.
- Variable length records between 0-65535 bytes, with a record size
field of 2 bytes.
- Fixed size records, which no record size field.
- Preserve memory resource.
- Performance!
- Easy to use!
This patch:
Since most users want to have the kfifo as part of another object,
reorganize the code to allow including struct kfifo in another data
structure. This requires changing the kfifo_alloc and kfifo_init
prototypes so that we pass an existing kfifo pointer into them. This
patch changes the implementation and all existing users.
[akpm@linux-foundation.org: fix warning]
Signed-off-by: Stefani Seibold <stefani@seibold.net>
Acked-by: Greg Kroah-Hartman <gregkh@suse.de>
Acked-by: Mauro Carvalho Chehab <mchehab@redhat.com>
Acked-by: Andi Kleen <ak@linux.intel.com>
Acked-by: Arnd Bergmann <arnd@arndb.de>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
2009-12-21 22:37:26 +00:00
|
|
|
spin_lock_irqsave(&sonypi_compat.fifo_lock, flags);
|
2009-03-26 12:58:25 +00:00
|
|
|
|
2007-04-09 17:31:25 +00:00
|
|
|
if (atomic_inc_return(&sonypi_compat.open_count) == 1)
|
2009-12-21 22:37:28 +00:00
|
|
|
kfifo_reset(&sonypi_compat.fifo);
|
2009-03-26 12:58:25 +00:00
|
|
|
|
kfifo: move struct kfifo in place
This is a new generic kernel FIFO implementation.
The current kernel fifo API is not very widely used, because it has to
many constrains. Only 17 files in the current 2.6.31-rc5 used it.
FIFO's are like list's a very basic thing and a kfifo API which handles
the most use case would save a lot of development time and memory
resources.
I think this are the reasons why kfifo is not in use:
- The API is to simple, important functions are missing
- A fifo can be only allocated dynamically
- There is a requirement of a spinlock whether you need it or not
- There is no support for data records inside a fifo
So I decided to extend the kfifo in a more generic way without blowing up
the API to much. The new API has the following benefits:
- Generic usage: For kernel internal use and/or device driver.
- Provide an API for the most use case.
- Slim API: The whole API provides 25 functions.
- Linux style habit.
- DECLARE_KFIFO, DEFINE_KFIFO and INIT_KFIFO Macros
- Direct copy_to_user from the fifo and copy_from_user into the fifo.
- The kfifo itself is an in place member of the using data structure, this save an
indirection access and does not waste the kernel allocator.
- Lockless access: if only one reader and one writer is active on the fifo,
which is the common use case, no additional locking is necessary.
- Remove spinlock - give the user the freedom of choice what kind of locking to use if
one is required.
- Ability to handle records. Three type of records are supported:
- Variable length records between 0-255 bytes, with a record size
field of 1 bytes.
- Variable length records between 0-65535 bytes, with a record size
field of 2 bytes.
- Fixed size records, which no record size field.
- Preserve memory resource.
- Performance!
- Easy to use!
This patch:
Since most users want to have the kfifo as part of another object,
reorganize the code to allow including struct kfifo in another data
structure. This requires changing the kfifo_alloc and kfifo_init
prototypes so that we pass an existing kfifo pointer into them. This
patch changes the implementation and all existing users.
[akpm@linux-foundation.org: fix warning]
Signed-off-by: Stefani Seibold <stefani@seibold.net>
Acked-by: Greg Kroah-Hartman <gregkh@suse.de>
Acked-by: Mauro Carvalho Chehab <mchehab@redhat.com>
Acked-by: Andi Kleen <ak@linux.intel.com>
Acked-by: Arnd Bergmann <arnd@arndb.de>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
2009-12-21 22:37:26 +00:00
|
|
|
spin_unlock_irqrestore(&sonypi_compat.fifo_lock, flags);
|
2009-03-26 12:58:25 +00:00
|
|
|
|
2007-04-09 17:31:25 +00:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t sonypi_misc_read(struct file *file, char __user *buf,
|
|
|
|
size_t count, loff_t *pos)
|
|
|
|
{
|
|
|
|
ssize_t ret;
|
|
|
|
unsigned char c;
|
|
|
|
|
kfifo: move struct kfifo in place
This is a new generic kernel FIFO implementation.
The current kernel fifo API is not very widely used, because it has to
many constrains. Only 17 files in the current 2.6.31-rc5 used it.
FIFO's are like list's a very basic thing and a kfifo API which handles
the most use case would save a lot of development time and memory
resources.
I think this are the reasons why kfifo is not in use:
- The API is to simple, important functions are missing
- A fifo can be only allocated dynamically
- There is a requirement of a spinlock whether you need it or not
- There is no support for data records inside a fifo
So I decided to extend the kfifo in a more generic way without blowing up
the API to much. The new API has the following benefits:
- Generic usage: For kernel internal use and/or device driver.
- Provide an API for the most use case.
- Slim API: The whole API provides 25 functions.
- Linux style habit.
- DECLARE_KFIFO, DEFINE_KFIFO and INIT_KFIFO Macros
- Direct copy_to_user from the fifo and copy_from_user into the fifo.
- The kfifo itself is an in place member of the using data structure, this save an
indirection access and does not waste the kernel allocator.
- Lockless access: if only one reader and one writer is active on the fifo,
which is the common use case, no additional locking is necessary.
- Remove spinlock - give the user the freedom of choice what kind of locking to use if
one is required.
- Ability to handle records. Three type of records are supported:
- Variable length records between 0-255 bytes, with a record size
field of 1 bytes.
- Variable length records between 0-65535 bytes, with a record size
field of 2 bytes.
- Fixed size records, which no record size field.
- Preserve memory resource.
- Performance!
- Easy to use!
This patch:
Since most users want to have the kfifo as part of another object,
reorganize the code to allow including struct kfifo in another data
structure. This requires changing the kfifo_alloc and kfifo_init
prototypes so that we pass an existing kfifo pointer into them. This
patch changes the implementation and all existing users.
[akpm@linux-foundation.org: fix warning]
Signed-off-by: Stefani Seibold <stefani@seibold.net>
Acked-by: Greg Kroah-Hartman <gregkh@suse.de>
Acked-by: Mauro Carvalho Chehab <mchehab@redhat.com>
Acked-by: Andi Kleen <ak@linux.intel.com>
Acked-by: Arnd Bergmann <arnd@arndb.de>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
2009-12-21 22:37:26 +00:00
|
|
|
if ((kfifo_len(&sonypi_compat.fifo) == 0) &&
|
2007-04-09 17:31:25 +00:00
|
|
|
(file->f_flags & O_NONBLOCK))
|
|
|
|
return -EAGAIN;
|
|
|
|
|
|
|
|
ret = wait_event_interruptible(sonypi_compat.fifo_proc_list,
|
kfifo: move struct kfifo in place
This is a new generic kernel FIFO implementation.
The current kernel fifo API is not very widely used, because it has to
many constrains. Only 17 files in the current 2.6.31-rc5 used it.
FIFO's are like list's a very basic thing and a kfifo API which handles
the most use case would save a lot of development time and memory
resources.
I think this are the reasons why kfifo is not in use:
- The API is to simple, important functions are missing
- A fifo can be only allocated dynamically
- There is a requirement of a spinlock whether you need it or not
- There is no support for data records inside a fifo
So I decided to extend the kfifo in a more generic way without blowing up
the API to much. The new API has the following benefits:
- Generic usage: For kernel internal use and/or device driver.
- Provide an API for the most use case.
- Slim API: The whole API provides 25 functions.
- Linux style habit.
- DECLARE_KFIFO, DEFINE_KFIFO and INIT_KFIFO Macros
- Direct copy_to_user from the fifo and copy_from_user into the fifo.
- The kfifo itself is an in place member of the using data structure, this save an
indirection access and does not waste the kernel allocator.
- Lockless access: if only one reader and one writer is active on the fifo,
which is the common use case, no additional locking is necessary.
- Remove spinlock - give the user the freedom of choice what kind of locking to use if
one is required.
- Ability to handle records. Three type of records are supported:
- Variable length records between 0-255 bytes, with a record size
field of 1 bytes.
- Variable length records between 0-65535 bytes, with a record size
field of 2 bytes.
- Fixed size records, which no record size field.
- Preserve memory resource.
- Performance!
- Easy to use!
This patch:
Since most users want to have the kfifo as part of another object,
reorganize the code to allow including struct kfifo in another data
structure. This requires changing the kfifo_alloc and kfifo_init
prototypes so that we pass an existing kfifo pointer into them. This
patch changes the implementation and all existing users.
[akpm@linux-foundation.org: fix warning]
Signed-off-by: Stefani Seibold <stefani@seibold.net>
Acked-by: Greg Kroah-Hartman <gregkh@suse.de>
Acked-by: Mauro Carvalho Chehab <mchehab@redhat.com>
Acked-by: Andi Kleen <ak@linux.intel.com>
Acked-by: Arnd Bergmann <arnd@arndb.de>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
2009-12-21 22:37:26 +00:00
|
|
|
kfifo_len(&sonypi_compat.fifo) != 0);
|
2007-04-09 17:31:25 +00:00
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
while (ret < count &&
|
2009-12-21 22:37:28 +00:00
|
|
|
(kfifo_out_locked(&sonypi_compat.fifo, &c, sizeof(c),
|
2009-12-21 22:37:27 +00:00
|
|
|
&sonypi_compat.fifo_lock) == sizeof(c))) {
|
2007-04-09 17:31:25 +00:00
|
|
|
if (put_user(c, buf++))
|
|
|
|
return -EFAULT;
|
|
|
|
ret++;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (ret > 0) {
|
|
|
|
struct inode *inode = file->f_path.dentry->d_inode;
|
|
|
|
inode->i_atime = current_fs_time(inode->i_sb);
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static unsigned int sonypi_misc_poll(struct file *file, poll_table *wait)
|
|
|
|
{
|
|
|
|
poll_wait(file, &sonypi_compat.fifo_proc_list, wait);
|
kfifo: move struct kfifo in place
This is a new generic kernel FIFO implementation.
The current kernel fifo API is not very widely used, because it has to
many constrains. Only 17 files in the current 2.6.31-rc5 used it.
FIFO's are like list's a very basic thing and a kfifo API which handles
the most use case would save a lot of development time and memory
resources.
I think this are the reasons why kfifo is not in use:
- The API is to simple, important functions are missing
- A fifo can be only allocated dynamically
- There is a requirement of a spinlock whether you need it or not
- There is no support for data records inside a fifo
So I decided to extend the kfifo in a more generic way without blowing up
the API to much. The new API has the following benefits:
- Generic usage: For kernel internal use and/or device driver.
- Provide an API for the most use case.
- Slim API: The whole API provides 25 functions.
- Linux style habit.
- DECLARE_KFIFO, DEFINE_KFIFO and INIT_KFIFO Macros
- Direct copy_to_user from the fifo and copy_from_user into the fifo.
- The kfifo itself is an in place member of the using data structure, this save an
indirection access and does not waste the kernel allocator.
- Lockless access: if only one reader and one writer is active on the fifo,
which is the common use case, no additional locking is necessary.
- Remove spinlock - give the user the freedom of choice what kind of locking to use if
one is required.
- Ability to handle records. Three type of records are supported:
- Variable length records between 0-255 bytes, with a record size
field of 1 bytes.
- Variable length records between 0-65535 bytes, with a record size
field of 2 bytes.
- Fixed size records, which no record size field.
- Preserve memory resource.
- Performance!
- Easy to use!
This patch:
Since most users want to have the kfifo as part of another object,
reorganize the code to allow including struct kfifo in another data
structure. This requires changing the kfifo_alloc and kfifo_init
prototypes so that we pass an existing kfifo pointer into them. This
patch changes the implementation and all existing users.
[akpm@linux-foundation.org: fix warning]
Signed-off-by: Stefani Seibold <stefani@seibold.net>
Acked-by: Greg Kroah-Hartman <gregkh@suse.de>
Acked-by: Mauro Carvalho Chehab <mchehab@redhat.com>
Acked-by: Andi Kleen <ak@linux.intel.com>
Acked-by: Arnd Bergmann <arnd@arndb.de>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
2009-12-21 22:37:26 +00:00
|
|
|
if (kfifo_len(&sonypi_compat.fifo))
|
2007-04-09 17:31:25 +00:00
|
|
|
return POLLIN | POLLRDNORM;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int ec_read16(u8 addr, u16 *value)
|
|
|
|
{
|
|
|
|
u8 val_lb, val_hb;
|
|
|
|
if (ec_read(addr, &val_lb))
|
|
|
|
return -1;
|
|
|
|
if (ec_read(addr + 1, &val_hb))
|
|
|
|
return -1;
|
|
|
|
*value = val_lb | (val_hb << 8);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2009-03-26 12:58:19 +00:00
|
|
|
static long sonypi_misc_ioctl(struct file *fp, unsigned int cmd,
|
|
|
|
unsigned long arg)
|
2007-04-09 17:31:25 +00:00
|
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
void __user *argp = (void __user *)arg;
|
|
|
|
u8 val8;
|
|
|
|
u16 val16;
|
|
|
|
int value;
|
|
|
|
|
2007-04-28 14:19:36 +00:00
|
|
|
mutex_lock(&spic_dev.lock);
|
2007-04-09 17:31:25 +00:00
|
|
|
switch (cmd) {
|
|
|
|
case SONYPI_IOCGBRT:
|
|
|
|
if (sony_backlight_device == NULL) {
|
|
|
|
ret = -EIO;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
if (acpi_callgetfunc(sony_nc_acpi_handle, "GBRT", &value)) {
|
|
|
|
ret = -EIO;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
val8 = ((value & 0xff) - 1) << 5;
|
|
|
|
if (copy_to_user(argp, &val8, sizeof(val8)))
|
|
|
|
ret = -EFAULT;
|
|
|
|
break;
|
|
|
|
case SONYPI_IOCSBRT:
|
|
|
|
if (sony_backlight_device == NULL) {
|
|
|
|
ret = -EIO;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
if (copy_from_user(&val8, argp, sizeof(val8))) {
|
|
|
|
ret = -EFAULT;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
if (acpi_callsetfunc(sony_nc_acpi_handle, "SBRT",
|
|
|
|
(val8 >> 5) + 1, NULL)) {
|
|
|
|
ret = -EIO;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
/* sync the backlight device status */
|
|
|
|
sony_backlight_device->props.brightness =
|
|
|
|
sony_backlight_get_brightness(sony_backlight_device);
|
|
|
|
break;
|
|
|
|
case SONYPI_IOCGBAT1CAP:
|
|
|
|
if (ec_read16(SONYPI_BAT1_FULL, &val16)) {
|
|
|
|
ret = -EIO;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
if (copy_to_user(argp, &val16, sizeof(val16)))
|
|
|
|
ret = -EFAULT;
|
|
|
|
break;
|
|
|
|
case SONYPI_IOCGBAT1REM:
|
|
|
|
if (ec_read16(SONYPI_BAT1_LEFT, &val16)) {
|
|
|
|
ret = -EIO;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
if (copy_to_user(argp, &val16, sizeof(val16)))
|
|
|
|
ret = -EFAULT;
|
|
|
|
break;
|
|
|
|
case SONYPI_IOCGBAT2CAP:
|
|
|
|
if (ec_read16(SONYPI_BAT2_FULL, &val16)) {
|
|
|
|
ret = -EIO;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
if (copy_to_user(argp, &val16, sizeof(val16)))
|
|
|
|
ret = -EFAULT;
|
|
|
|
break;
|
|
|
|
case SONYPI_IOCGBAT2REM:
|
|
|
|
if (ec_read16(SONYPI_BAT2_LEFT, &val16)) {
|
|
|
|
ret = -EIO;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
if (copy_to_user(argp, &val16, sizeof(val16)))
|
|
|
|
ret = -EFAULT;
|
|
|
|
break;
|
|
|
|
case SONYPI_IOCGBATFLAGS:
|
|
|
|
if (ec_read(SONYPI_BAT_FLAGS, &val8)) {
|
|
|
|
ret = -EIO;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
val8 &= 0x07;
|
|
|
|
if (copy_to_user(argp, &val8, sizeof(val8)))
|
|
|
|
ret = -EFAULT;
|
|
|
|
break;
|
|
|
|
case SONYPI_IOCGBLUE:
|
|
|
|
val8 = spic_dev.bluetooth_power;
|
|
|
|
if (copy_to_user(argp, &val8, sizeof(val8)))
|
|
|
|
ret = -EFAULT;
|
|
|
|
break;
|
|
|
|
case SONYPI_IOCSBLUE:
|
|
|
|
if (copy_from_user(&val8, argp, sizeof(val8))) {
|
|
|
|
ret = -EFAULT;
|
|
|
|
break;
|
|
|
|
}
|
2007-04-28 14:19:36 +00:00
|
|
|
__sony_pic_set_bluetoothpower(val8);
|
2007-04-09 17:31:25 +00:00
|
|
|
break;
|
|
|
|
/* FAN Controls */
|
|
|
|
case SONYPI_IOCGFAN:
|
|
|
|
if (sony_pic_get_fanspeed(&val8)) {
|
|
|
|
ret = -EIO;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
if (copy_to_user(argp, &val8, sizeof(val8)))
|
|
|
|
ret = -EFAULT;
|
|
|
|
break;
|
|
|
|
case SONYPI_IOCSFAN:
|
|
|
|
if (copy_from_user(&val8, argp, sizeof(val8))) {
|
|
|
|
ret = -EFAULT;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
if (sony_pic_set_fanspeed(val8))
|
|
|
|
ret = -EIO;
|
|
|
|
break;
|
|
|
|
/* GET Temperature (useful under APM) */
|
|
|
|
case SONYPI_IOCGTEMP:
|
|
|
|
if (ec_read(SONYPI_TEMP_STATUS, &val8)) {
|
|
|
|
ret = -EIO;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
if (copy_to_user(argp, &val8, sizeof(val8)))
|
|
|
|
ret = -EFAULT;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
ret = -EINVAL;
|
|
|
|
}
|
2007-04-28 14:19:36 +00:00
|
|
|
mutex_unlock(&spic_dev.lock);
|
2007-04-09 17:31:25 +00:00
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static const struct file_operations sonypi_misc_fops = {
|
|
|
|
.owner = THIS_MODULE,
|
|
|
|
.read = sonypi_misc_read,
|
|
|
|
.poll = sonypi_misc_poll,
|
|
|
|
.open = sonypi_misc_open,
|
|
|
|
.release = sonypi_misc_release,
|
|
|
|
.fasync = sonypi_misc_fasync,
|
2009-03-26 12:58:19 +00:00
|
|
|
.unlocked_ioctl = sonypi_misc_ioctl,
|
llseek: automatically add .llseek fop
All file_operations should get a .llseek operation so we can make
nonseekable_open the default for future file operations without a
.llseek pointer.
The three cases that we can automatically detect are no_llseek, seq_lseek
and default_llseek. For cases where we can we can automatically prove that
the file offset is always ignored, we use noop_llseek, which maintains
the current behavior of not returning an error from a seek.
New drivers should normally not use noop_llseek but instead use no_llseek
and call nonseekable_open at open time. Existing drivers can be converted
to do the same when the maintainer knows for certain that no user code
relies on calling seek on the device file.
The generated code is often incorrectly indented and right now contains
comments that clarify for each added line why a specific variant was
chosen. In the version that gets submitted upstream, the comments will
be gone and I will manually fix the indentation, because there does not
seem to be a way to do that using coccinelle.
Some amount of new code is currently sitting in linux-next that should get
the same modifications, which I will do at the end of the merge window.
Many thanks to Julia Lawall for helping me learn to write a semantic
patch that does all this.
===== begin semantic patch =====
// This adds an llseek= method to all file operations,
// as a preparation for making no_llseek the default.
//
// The rules are
// - use no_llseek explicitly if we do nonseekable_open
// - use seq_lseek for sequential files
// - use default_llseek if we know we access f_pos
// - use noop_llseek if we know we don't access f_pos,
// but we still want to allow users to call lseek
//
@ open1 exists @
identifier nested_open;
@@
nested_open(...)
{
<+...
nonseekable_open(...)
...+>
}
@ open exists@
identifier open_f;
identifier i, f;
identifier open1.nested_open;
@@
int open_f(struct inode *i, struct file *f)
{
<+...
(
nonseekable_open(...)
|
nested_open(...)
)
...+>
}
@ read disable optional_qualifier exists @
identifier read_f;
identifier f, p, s, off;
type ssize_t, size_t, loff_t;
expression E;
identifier func;
@@
ssize_t read_f(struct file *f, char *p, size_t s, loff_t *off)
{
<+...
(
*off = E
|
*off += E
|
func(..., off, ...)
|
E = *off
)
...+>
}
@ read_no_fpos disable optional_qualifier exists @
identifier read_f;
identifier f, p, s, off;
type ssize_t, size_t, loff_t;
@@
ssize_t read_f(struct file *f, char *p, size_t s, loff_t *off)
{
... when != off
}
@ write @
identifier write_f;
identifier f, p, s, off;
type ssize_t, size_t, loff_t;
expression E;
identifier func;
@@
ssize_t write_f(struct file *f, const char *p, size_t s, loff_t *off)
{
<+...
(
*off = E
|
*off += E
|
func(..., off, ...)
|
E = *off
)
...+>
}
@ write_no_fpos @
identifier write_f;
identifier f, p, s, off;
type ssize_t, size_t, loff_t;
@@
ssize_t write_f(struct file *f, const char *p, size_t s, loff_t *off)
{
... when != off
}
@ fops0 @
identifier fops;
@@
struct file_operations fops = {
...
};
@ has_llseek depends on fops0 @
identifier fops0.fops;
identifier llseek_f;
@@
struct file_operations fops = {
...
.llseek = llseek_f,
...
};
@ has_read depends on fops0 @
identifier fops0.fops;
identifier read_f;
@@
struct file_operations fops = {
...
.read = read_f,
...
};
@ has_write depends on fops0 @
identifier fops0.fops;
identifier write_f;
@@
struct file_operations fops = {
...
.write = write_f,
...
};
@ has_open depends on fops0 @
identifier fops0.fops;
identifier open_f;
@@
struct file_operations fops = {
...
.open = open_f,
...
};
// use no_llseek if we call nonseekable_open
////////////////////////////////////////////
@ nonseekable1 depends on !has_llseek && has_open @
identifier fops0.fops;
identifier nso ~= "nonseekable_open";
@@
struct file_operations fops = {
... .open = nso, ...
+.llseek = no_llseek, /* nonseekable */
};
@ nonseekable2 depends on !has_llseek @
identifier fops0.fops;
identifier open.open_f;
@@
struct file_operations fops = {
... .open = open_f, ...
+.llseek = no_llseek, /* open uses nonseekable */
};
// use seq_lseek for sequential files
/////////////////////////////////////
@ seq depends on !has_llseek @
identifier fops0.fops;
identifier sr ~= "seq_read";
@@
struct file_operations fops = {
... .read = sr, ...
+.llseek = seq_lseek, /* we have seq_read */
};
// use default_llseek if there is a readdir
///////////////////////////////////////////
@ fops1 depends on !has_llseek && !nonseekable1 && !nonseekable2 && !seq @
identifier fops0.fops;
identifier readdir_e;
@@
// any other fop is used that changes pos
struct file_operations fops = {
... .readdir = readdir_e, ...
+.llseek = default_llseek, /* readdir is present */
};
// use default_llseek if at least one of read/write touches f_pos
/////////////////////////////////////////////////////////////////
@ fops2 depends on !fops1 && !has_llseek && !nonseekable1 && !nonseekable2 && !seq @
identifier fops0.fops;
identifier read.read_f;
@@
// read fops use offset
struct file_operations fops = {
... .read = read_f, ...
+.llseek = default_llseek, /* read accesses f_pos */
};
@ fops3 depends on !fops1 && !fops2 && !has_llseek && !nonseekable1 && !nonseekable2 && !seq @
identifier fops0.fops;
identifier write.write_f;
@@
// write fops use offset
struct file_operations fops = {
... .write = write_f, ...
+ .llseek = default_llseek, /* write accesses f_pos */
};
// Use noop_llseek if neither read nor write accesses f_pos
///////////////////////////////////////////////////////////
@ fops4 depends on !fops1 && !fops2 && !fops3 && !has_llseek && !nonseekable1 && !nonseekable2 && !seq @
identifier fops0.fops;
identifier read_no_fpos.read_f;
identifier write_no_fpos.write_f;
@@
// write fops use offset
struct file_operations fops = {
...
.write = write_f,
.read = read_f,
...
+.llseek = noop_llseek, /* read and write both use no f_pos */
};
@ depends on has_write && !has_read && !fops1 && !fops2 && !has_llseek && !nonseekable1 && !nonseekable2 && !seq @
identifier fops0.fops;
identifier write_no_fpos.write_f;
@@
struct file_operations fops = {
... .write = write_f, ...
+.llseek = noop_llseek, /* write uses no f_pos */
};
@ depends on has_read && !has_write && !fops1 && !fops2 && !has_llseek && !nonseekable1 && !nonseekable2 && !seq @
identifier fops0.fops;
identifier read_no_fpos.read_f;
@@
struct file_operations fops = {
... .read = read_f, ...
+.llseek = noop_llseek, /* read uses no f_pos */
};
@ depends on !has_read && !has_write && !fops1 && !fops2 && !has_llseek && !nonseekable1 && !nonseekable2 && !seq @
identifier fops0.fops;
@@
struct file_operations fops = {
...
+.llseek = noop_llseek, /* no read or write fn */
};
===== End semantic patch =====
Signed-off-by: Arnd Bergmann <arnd@arndb.de>
Cc: Julia Lawall <julia@diku.dk>
Cc: Christoph Hellwig <hch@infradead.org>
2010-08-15 16:52:59 +00:00
|
|
|
.llseek = noop_llseek,
|
2007-04-09 17:31:25 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
static struct miscdevice sonypi_misc_device = {
|
|
|
|
.minor = MISC_DYNAMIC_MINOR,
|
|
|
|
.name = "sonypi",
|
|
|
|
.fops = &sonypi_misc_fops,
|
|
|
|
};
|
|
|
|
|
|
|
|
static void sonypi_compat_report_event(u8 event)
|
|
|
|
{
|
2009-12-21 22:37:28 +00:00
|
|
|
kfifo_in_locked(&sonypi_compat.fifo, (unsigned char *)&event,
|
2009-12-21 22:37:27 +00:00
|
|
|
sizeof(event), &sonypi_compat.fifo_lock);
|
2007-04-09 17:31:25 +00:00
|
|
|
kill_fasync(&sonypi_compat.fifo_async, SIGIO, POLL_IN);
|
|
|
|
wake_up_interruptible(&sonypi_compat.fifo_proc_list);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int sonypi_compat_init(void)
|
|
|
|
{
|
|
|
|
int error;
|
|
|
|
|
|
|
|
spin_lock_init(&sonypi_compat.fifo_lock);
|
kfifo: move struct kfifo in place
This is a new generic kernel FIFO implementation.
The current kernel fifo API is not very widely used, because it has to
many constrains. Only 17 files in the current 2.6.31-rc5 used it.
FIFO's are like list's a very basic thing and a kfifo API which handles
the most use case would save a lot of development time and memory
resources.
I think this are the reasons why kfifo is not in use:
- The API is to simple, important functions are missing
- A fifo can be only allocated dynamically
- There is a requirement of a spinlock whether you need it or not
- There is no support for data records inside a fifo
So I decided to extend the kfifo in a more generic way without blowing up
the API to much. The new API has the following benefits:
- Generic usage: For kernel internal use and/or device driver.
- Provide an API for the most use case.
- Slim API: The whole API provides 25 functions.
- Linux style habit.
- DECLARE_KFIFO, DEFINE_KFIFO and INIT_KFIFO Macros
- Direct copy_to_user from the fifo and copy_from_user into the fifo.
- The kfifo itself is an in place member of the using data structure, this save an
indirection access and does not waste the kernel allocator.
- Lockless access: if only one reader and one writer is active on the fifo,
which is the common use case, no additional locking is necessary.
- Remove spinlock - give the user the freedom of choice what kind of locking to use if
one is required.
- Ability to handle records. Three type of records are supported:
- Variable length records between 0-255 bytes, with a record size
field of 1 bytes.
- Variable length records between 0-65535 bytes, with a record size
field of 2 bytes.
- Fixed size records, which no record size field.
- Preserve memory resource.
- Performance!
- Easy to use!
This patch:
Since most users want to have the kfifo as part of another object,
reorganize the code to allow including struct kfifo in another data
structure. This requires changing the kfifo_alloc and kfifo_init
prototypes so that we pass an existing kfifo pointer into them. This
patch changes the implementation and all existing users.
[akpm@linux-foundation.org: fix warning]
Signed-off-by: Stefani Seibold <stefani@seibold.net>
Acked-by: Greg Kroah-Hartman <gregkh@suse.de>
Acked-by: Mauro Carvalho Chehab <mchehab@redhat.com>
Acked-by: Andi Kleen <ak@linux.intel.com>
Acked-by: Arnd Bergmann <arnd@arndb.de>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
2009-12-21 22:37:26 +00:00
|
|
|
error =
|
2009-12-21 22:37:27 +00:00
|
|
|
kfifo_alloc(&sonypi_compat.fifo, SONY_LAPTOP_BUF_SIZE, GFP_KERNEL);
|
kfifo: move struct kfifo in place
This is a new generic kernel FIFO implementation.
The current kernel fifo API is not very widely used, because it has to
many constrains. Only 17 files in the current 2.6.31-rc5 used it.
FIFO's are like list's a very basic thing and a kfifo API which handles
the most use case would save a lot of development time and memory
resources.
I think this are the reasons why kfifo is not in use:
- The API is to simple, important functions are missing
- A fifo can be only allocated dynamically
- There is a requirement of a spinlock whether you need it or not
- There is no support for data records inside a fifo
So I decided to extend the kfifo in a more generic way without blowing up
the API to much. The new API has the following benefits:
- Generic usage: For kernel internal use and/or device driver.
- Provide an API for the most use case.
- Slim API: The whole API provides 25 functions.
- Linux style habit.
- DECLARE_KFIFO, DEFINE_KFIFO and INIT_KFIFO Macros
- Direct copy_to_user from the fifo and copy_from_user into the fifo.
- The kfifo itself is an in place member of the using data structure, this save an
indirection access and does not waste the kernel allocator.
- Lockless access: if only one reader and one writer is active on the fifo,
which is the common use case, no additional locking is necessary.
- Remove spinlock - give the user the freedom of choice what kind of locking to use if
one is required.
- Ability to handle records. Three type of records are supported:
- Variable length records between 0-255 bytes, with a record size
field of 1 bytes.
- Variable length records between 0-65535 bytes, with a record size
field of 2 bytes.
- Fixed size records, which no record size field.
- Preserve memory resource.
- Performance!
- Easy to use!
This patch:
Since most users want to have the kfifo as part of another object,
reorganize the code to allow including struct kfifo in another data
structure. This requires changing the kfifo_alloc and kfifo_init
prototypes so that we pass an existing kfifo pointer into them. This
patch changes the implementation and all existing users.
[akpm@linux-foundation.org: fix warning]
Signed-off-by: Stefani Seibold <stefani@seibold.net>
Acked-by: Greg Kroah-Hartman <gregkh@suse.de>
Acked-by: Mauro Carvalho Chehab <mchehab@redhat.com>
Acked-by: Andi Kleen <ak@linux.intel.com>
Acked-by: Arnd Bergmann <arnd@arndb.de>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
2009-12-21 22:37:26 +00:00
|
|
|
if (error) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_err(DRV_PFX "kfifo_alloc failed\n");
|
kfifo: move struct kfifo in place
This is a new generic kernel FIFO implementation.
The current kernel fifo API is not very widely used, because it has to
many constrains. Only 17 files in the current 2.6.31-rc5 used it.
FIFO's are like list's a very basic thing and a kfifo API which handles
the most use case would save a lot of development time and memory
resources.
I think this are the reasons why kfifo is not in use:
- The API is to simple, important functions are missing
- A fifo can be only allocated dynamically
- There is a requirement of a spinlock whether you need it or not
- There is no support for data records inside a fifo
So I decided to extend the kfifo in a more generic way without blowing up
the API to much. The new API has the following benefits:
- Generic usage: For kernel internal use and/or device driver.
- Provide an API for the most use case.
- Slim API: The whole API provides 25 functions.
- Linux style habit.
- DECLARE_KFIFO, DEFINE_KFIFO and INIT_KFIFO Macros
- Direct copy_to_user from the fifo and copy_from_user into the fifo.
- The kfifo itself is an in place member of the using data structure, this save an
indirection access and does not waste the kernel allocator.
- Lockless access: if only one reader and one writer is active on the fifo,
which is the common use case, no additional locking is necessary.
- Remove spinlock - give the user the freedom of choice what kind of locking to use if
one is required.
- Ability to handle records. Three type of records are supported:
- Variable length records between 0-255 bytes, with a record size
field of 1 bytes.
- Variable length records between 0-65535 bytes, with a record size
field of 2 bytes.
- Fixed size records, which no record size field.
- Preserve memory resource.
- Performance!
- Easy to use!
This patch:
Since most users want to have the kfifo as part of another object,
reorganize the code to allow including struct kfifo in another data
structure. This requires changing the kfifo_alloc and kfifo_init
prototypes so that we pass an existing kfifo pointer into them. This
patch changes the implementation and all existing users.
[akpm@linux-foundation.org: fix warning]
Signed-off-by: Stefani Seibold <stefani@seibold.net>
Acked-by: Greg Kroah-Hartman <gregkh@suse.de>
Acked-by: Mauro Carvalho Chehab <mchehab@redhat.com>
Acked-by: Andi Kleen <ak@linux.intel.com>
Acked-by: Arnd Bergmann <arnd@arndb.de>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
2009-12-21 22:37:26 +00:00
|
|
|
return error;
|
2007-04-09 17:31:25 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
init_waitqueue_head(&sonypi_compat.fifo_proc_list);
|
|
|
|
|
|
|
|
if (minor != -1)
|
|
|
|
sonypi_misc_device.minor = minor;
|
|
|
|
error = misc_register(&sonypi_misc_device);
|
|
|
|
if (error) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_err(DRV_PFX "misc_register failed\n");
|
2007-04-09 17:31:25 +00:00
|
|
|
goto err_free_kfifo;
|
|
|
|
}
|
|
|
|
if (minor == -1)
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_info(DRV_PFX "device allocated minor is %d\n",
|
2007-04-09 17:31:25 +00:00
|
|
|
sonypi_misc_device.minor);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
err_free_kfifo:
|
kfifo: move struct kfifo in place
This is a new generic kernel FIFO implementation.
The current kernel fifo API is not very widely used, because it has to
many constrains. Only 17 files in the current 2.6.31-rc5 used it.
FIFO's are like list's a very basic thing and a kfifo API which handles
the most use case would save a lot of development time and memory
resources.
I think this are the reasons why kfifo is not in use:
- The API is to simple, important functions are missing
- A fifo can be only allocated dynamically
- There is a requirement of a spinlock whether you need it or not
- There is no support for data records inside a fifo
So I decided to extend the kfifo in a more generic way without blowing up
the API to much. The new API has the following benefits:
- Generic usage: For kernel internal use and/or device driver.
- Provide an API for the most use case.
- Slim API: The whole API provides 25 functions.
- Linux style habit.
- DECLARE_KFIFO, DEFINE_KFIFO and INIT_KFIFO Macros
- Direct copy_to_user from the fifo and copy_from_user into the fifo.
- The kfifo itself is an in place member of the using data structure, this save an
indirection access and does not waste the kernel allocator.
- Lockless access: if only one reader and one writer is active on the fifo,
which is the common use case, no additional locking is necessary.
- Remove spinlock - give the user the freedom of choice what kind of locking to use if
one is required.
- Ability to handle records. Three type of records are supported:
- Variable length records between 0-255 bytes, with a record size
field of 1 bytes.
- Variable length records between 0-65535 bytes, with a record size
field of 2 bytes.
- Fixed size records, which no record size field.
- Preserve memory resource.
- Performance!
- Easy to use!
This patch:
Since most users want to have the kfifo as part of another object,
reorganize the code to allow including struct kfifo in another data
structure. This requires changing the kfifo_alloc and kfifo_init
prototypes so that we pass an existing kfifo pointer into them. This
patch changes the implementation and all existing users.
[akpm@linux-foundation.org: fix warning]
Signed-off-by: Stefani Seibold <stefani@seibold.net>
Acked-by: Greg Kroah-Hartman <gregkh@suse.de>
Acked-by: Mauro Carvalho Chehab <mchehab@redhat.com>
Acked-by: Andi Kleen <ak@linux.intel.com>
Acked-by: Arnd Bergmann <arnd@arndb.de>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
2009-12-21 22:37:26 +00:00
|
|
|
kfifo_free(&sonypi_compat.fifo);
|
2007-04-09 17:31:25 +00:00
|
|
|
return error;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void sonypi_compat_exit(void)
|
|
|
|
{
|
|
|
|
misc_deregister(&sonypi_misc_device);
|
kfifo: move struct kfifo in place
This is a new generic kernel FIFO implementation.
The current kernel fifo API is not very widely used, because it has to
many constrains. Only 17 files in the current 2.6.31-rc5 used it.
FIFO's are like list's a very basic thing and a kfifo API which handles
the most use case would save a lot of development time and memory
resources.
I think this are the reasons why kfifo is not in use:
- The API is to simple, important functions are missing
- A fifo can be only allocated dynamically
- There is a requirement of a spinlock whether you need it or not
- There is no support for data records inside a fifo
So I decided to extend the kfifo in a more generic way without blowing up
the API to much. The new API has the following benefits:
- Generic usage: For kernel internal use and/or device driver.
- Provide an API for the most use case.
- Slim API: The whole API provides 25 functions.
- Linux style habit.
- DECLARE_KFIFO, DEFINE_KFIFO and INIT_KFIFO Macros
- Direct copy_to_user from the fifo and copy_from_user into the fifo.
- The kfifo itself is an in place member of the using data structure, this save an
indirection access and does not waste the kernel allocator.
- Lockless access: if only one reader and one writer is active on the fifo,
which is the common use case, no additional locking is necessary.
- Remove spinlock - give the user the freedom of choice what kind of locking to use if
one is required.
- Ability to handle records. Three type of records are supported:
- Variable length records between 0-255 bytes, with a record size
field of 1 bytes.
- Variable length records between 0-65535 bytes, with a record size
field of 2 bytes.
- Fixed size records, which no record size field.
- Preserve memory resource.
- Performance!
- Easy to use!
This patch:
Since most users want to have the kfifo as part of another object,
reorganize the code to allow including struct kfifo in another data
structure. This requires changing the kfifo_alloc and kfifo_init
prototypes so that we pass an existing kfifo pointer into them. This
patch changes the implementation and all existing users.
[akpm@linux-foundation.org: fix warning]
Signed-off-by: Stefani Seibold <stefani@seibold.net>
Acked-by: Greg Kroah-Hartman <gregkh@suse.de>
Acked-by: Mauro Carvalho Chehab <mchehab@redhat.com>
Acked-by: Andi Kleen <ak@linux.intel.com>
Acked-by: Arnd Bergmann <arnd@arndb.de>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
2009-12-21 22:37:26 +00:00
|
|
|
kfifo_free(&sonypi_compat.fifo);
|
2007-04-09 17:31:25 +00:00
|
|
|
}
|
|
|
|
#else
|
|
|
|
static int sonypi_compat_init(void) { return 0; }
|
|
|
|
static void sonypi_compat_exit(void) { }
|
|
|
|
static void sonypi_compat_report_event(u8 event) { }
|
2007-05-01 02:19:53 +00:00
|
|
|
#endif /* CONFIG_SONYPI_COMPAT */
|
2007-04-09 17:31:25 +00:00
|
|
|
|
2007-04-09 08:19:08 +00:00
|
|
|
/*
|
2007-04-09 17:26:03 +00:00
|
|
|
* ACPI callbacks
|
2007-04-09 08:19:08 +00:00
|
|
|
*/
|
2007-04-09 17:26:03 +00:00
|
|
|
static acpi_status
|
|
|
|
sony_pic_read_possible_resource(struct acpi_resource *resource, void *context)
|
|
|
|
{
|
|
|
|
u32 i;
|
|
|
|
struct sony_pic_dev *dev = (struct sony_pic_dev *)context;
|
|
|
|
|
|
|
|
switch (resource->type) {
|
|
|
|
case ACPI_RESOURCE_TYPE_START_DEPENDENT:
|
2007-08-12 07:20:28 +00:00
|
|
|
{
|
|
|
|
/* start IO enumeration */
|
|
|
|
struct sony_pic_ioport *ioport = kzalloc(sizeof(*ioport), GFP_KERNEL);
|
|
|
|
if (!ioport)
|
|
|
|
return AE_ERROR;
|
|
|
|
|
|
|
|
list_add(&ioport->list, &dev->ioports);
|
|
|
|
return AE_OK;
|
|
|
|
}
|
|
|
|
|
2007-04-09 17:26:03 +00:00
|
|
|
case ACPI_RESOURCE_TYPE_END_DEPENDENT:
|
2007-08-12 07:20:28 +00:00
|
|
|
/* end IO enumeration */
|
2007-04-09 17:26:03 +00:00
|
|
|
return AE_OK;
|
|
|
|
|
|
|
|
case ACPI_RESOURCE_TYPE_IRQ:
|
|
|
|
{
|
|
|
|
struct acpi_resource_irq *p = &resource->data.irq;
|
|
|
|
struct sony_pic_irq *interrupt = NULL;
|
|
|
|
if (!p || !p->interrupt_count) {
|
|
|
|
/*
|
|
|
|
* IRQ descriptors may have no IRQ# bits set,
|
|
|
|
* particularly those those w/ _STA disabled
|
|
|
|
*/
|
|
|
|
dprintk("Blank IRQ resource\n");
|
|
|
|
return AE_OK;
|
|
|
|
}
|
|
|
|
for (i = 0; i < p->interrupt_count; i++) {
|
|
|
|
if (!p->interrupts[i]) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_warn(DRV_PFX "Invalid IRQ %d\n",
|
2007-04-09 17:26:03 +00:00
|
|
|
p->interrupts[i]);
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
interrupt = kzalloc(sizeof(*interrupt),
|
|
|
|
GFP_KERNEL);
|
|
|
|
if (!interrupt)
|
|
|
|
return AE_ERROR;
|
|
|
|
|
2007-08-12 07:20:28 +00:00
|
|
|
list_add(&interrupt->list, &dev->interrupts);
|
2007-04-09 17:26:03 +00:00
|
|
|
interrupt->irq.triggering = p->triggering;
|
|
|
|
interrupt->irq.polarity = p->polarity;
|
|
|
|
interrupt->irq.sharable = p->sharable;
|
|
|
|
interrupt->irq.interrupt_count = 1;
|
|
|
|
interrupt->irq.interrupts[0] = p->interrupts[i];
|
|
|
|
}
|
|
|
|
return AE_OK;
|
|
|
|
}
|
|
|
|
case ACPI_RESOURCE_TYPE_IO:
|
|
|
|
{
|
|
|
|
struct acpi_resource_io *io = &resource->data.io;
|
2007-08-12 07:20:28 +00:00
|
|
|
struct sony_pic_ioport *ioport =
|
|
|
|
list_first_entry(&dev->ioports, struct sony_pic_ioport, list);
|
2007-04-09 17:26:03 +00:00
|
|
|
if (!io) {
|
|
|
|
dprintk("Blank IO resource\n");
|
|
|
|
return AE_OK;
|
|
|
|
}
|
|
|
|
|
2007-08-12 07:20:28 +00:00
|
|
|
if (!ioport->io1.minimum) {
|
|
|
|
memcpy(&ioport->io1, io, sizeof(*io));
|
|
|
|
dprintk("IO1 at 0x%.4x (0x%.2x)\n", ioport->io1.minimum,
|
|
|
|
ioport->io1.address_length);
|
|
|
|
}
|
|
|
|
else if (!ioport->io2.minimum) {
|
|
|
|
memcpy(&ioport->io2, io, sizeof(*io));
|
|
|
|
dprintk("IO2 at 0x%.4x (0x%.2x)\n", ioport->io2.minimum,
|
|
|
|
ioport->io2.address_length);
|
|
|
|
}
|
|
|
|
else {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_err(DRV_PFX "Unknown SPIC Type, more than 2 IO Ports\n");
|
2007-04-09 17:26:03 +00:00
|
|
|
return AE_ERROR;
|
2007-08-12 07:20:28 +00:00
|
|
|
}
|
2007-04-09 17:26:03 +00:00
|
|
|
return AE_OK;
|
|
|
|
}
|
|
|
|
default:
|
|
|
|
dprintk("Resource %d isn't an IRQ nor an IO port\n",
|
|
|
|
resource->type);
|
|
|
|
|
|
|
|
case ACPI_RESOURCE_TYPE_END_TAG:
|
|
|
|
return AE_OK;
|
|
|
|
}
|
|
|
|
return AE_CTRL_TERMINATE;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int sony_pic_possible_resources(struct acpi_device *device)
|
|
|
|
{
|
|
|
|
int result = 0;
|
|
|
|
acpi_status status = AE_OK;
|
|
|
|
|
|
|
|
if (!device)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
/* get device status */
|
|
|
|
/* see acpi_pci_link_get_current acpi_pci_link_get_possible */
|
|
|
|
dprintk("Evaluating _STA\n");
|
|
|
|
result = acpi_bus_get_status(device);
|
|
|
|
if (result) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_warn(DRV_PFX "Unable to read status\n");
|
2007-04-09 17:26:03 +00:00
|
|
|
goto end;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!device->status.enabled)
|
|
|
|
dprintk("Device disabled\n");
|
|
|
|
else
|
|
|
|
dprintk("Device enabled\n");
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Query and parse 'method'
|
|
|
|
*/
|
|
|
|
dprintk("Evaluating %s\n", METHOD_NAME__PRS);
|
|
|
|
status = acpi_walk_resources(device->handle, METHOD_NAME__PRS,
|
|
|
|
sony_pic_read_possible_resource, &spic_dev);
|
|
|
|
if (ACPI_FAILURE(status)) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_warn(DRV_PFX "Failure evaluating %s\n",
|
2007-04-09 17:26:03 +00:00
|
|
|
METHOD_NAME__PRS);
|
|
|
|
result = -ENODEV;
|
|
|
|
}
|
|
|
|
end:
|
|
|
|
return result;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Disable the spic device by calling its _DIS method
|
|
|
|
*/
|
|
|
|
static int sony_pic_disable(struct acpi_device *device)
|
|
|
|
{
|
2008-10-29 21:01:03 +00:00
|
|
|
acpi_status ret = acpi_evaluate_object(device->handle, "_DIS", NULL,
|
|
|
|
NULL);
|
|
|
|
|
|
|
|
if (ACPI_FAILURE(ret) && ret != AE_NOT_FOUND)
|
2007-04-09 17:26:03 +00:00
|
|
|
return -ENXIO;
|
|
|
|
|
|
|
|
dprintk("Device disabled\n");
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Based on drivers/acpi/pci_link.c:acpi_pci_link_set
|
|
|
|
*
|
|
|
|
* Call _SRS to set current resources
|
|
|
|
*/
|
|
|
|
static int sony_pic_enable(struct acpi_device *device,
|
|
|
|
struct sony_pic_ioport *ioport, struct sony_pic_irq *irq)
|
|
|
|
{
|
|
|
|
acpi_status status;
|
|
|
|
int result = 0;
|
2007-08-12 07:20:28 +00:00
|
|
|
/* Type 1 resource layout is:
|
|
|
|
* IO
|
|
|
|
* IO
|
|
|
|
* IRQNoFlags
|
|
|
|
* End
|
|
|
|
*
|
|
|
|
* Type 2 and 3 resource layout is:
|
|
|
|
* IO
|
|
|
|
* IRQNoFlags
|
|
|
|
* End
|
|
|
|
*/
|
2007-04-09 17:26:03 +00:00
|
|
|
struct {
|
2007-08-12 07:20:28 +00:00
|
|
|
struct acpi_resource res1;
|
|
|
|
struct acpi_resource res2;
|
|
|
|
struct acpi_resource res3;
|
|
|
|
struct acpi_resource res4;
|
2007-04-09 17:26:03 +00:00
|
|
|
} *resource;
|
|
|
|
struct acpi_buffer buffer = { 0, NULL };
|
|
|
|
|
|
|
|
if (!ioport || !irq)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
/* init acpi_buffer */
|
|
|
|
resource = kzalloc(sizeof(*resource) + 1, GFP_KERNEL);
|
|
|
|
if (!resource)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
buffer.length = sizeof(*resource) + 1;
|
|
|
|
buffer.pointer = resource;
|
|
|
|
|
2007-08-12 07:20:28 +00:00
|
|
|
/* setup Type 1 resources */
|
2009-09-15 15:05:29 +00:00
|
|
|
if (spic_dev.model == SONYPI_DEVICE_TYPE1) {
|
2007-04-09 17:26:03 +00:00
|
|
|
|
2007-08-12 07:20:28 +00:00
|
|
|
/* setup io resources */
|
|
|
|
resource->res1.type = ACPI_RESOURCE_TYPE_IO;
|
|
|
|
resource->res1.length = sizeof(struct acpi_resource);
|
|
|
|
memcpy(&resource->res1.data.io, &ioport->io1,
|
|
|
|
sizeof(struct acpi_resource_io));
|
2007-04-09 17:26:03 +00:00
|
|
|
|
2007-08-12 07:20:28 +00:00
|
|
|
resource->res2.type = ACPI_RESOURCE_TYPE_IO;
|
|
|
|
resource->res2.length = sizeof(struct acpi_resource);
|
|
|
|
memcpy(&resource->res2.data.io, &ioport->io2,
|
|
|
|
sizeof(struct acpi_resource_io));
|
|
|
|
|
|
|
|
/* setup irq resource */
|
|
|
|
resource->res3.type = ACPI_RESOURCE_TYPE_IRQ;
|
|
|
|
resource->res3.length = sizeof(struct acpi_resource);
|
|
|
|
memcpy(&resource->res3.data.irq, &irq->irq,
|
|
|
|
sizeof(struct acpi_resource_irq));
|
|
|
|
/* we requested a shared irq */
|
|
|
|
resource->res3.data.irq.sharable = ACPI_SHARED;
|
|
|
|
|
|
|
|
resource->res4.type = ACPI_RESOURCE_TYPE_END_TAG;
|
|
|
|
|
|
|
|
}
|
|
|
|
/* setup Type 2/3 resources */
|
|
|
|
else {
|
|
|
|
/* setup io resource */
|
|
|
|
resource->res1.type = ACPI_RESOURCE_TYPE_IO;
|
|
|
|
resource->res1.length = sizeof(struct acpi_resource);
|
|
|
|
memcpy(&resource->res1.data.io, &ioport->io1,
|
|
|
|
sizeof(struct acpi_resource_io));
|
|
|
|
|
|
|
|
/* setup irq resource */
|
|
|
|
resource->res2.type = ACPI_RESOURCE_TYPE_IRQ;
|
|
|
|
resource->res2.length = sizeof(struct acpi_resource);
|
|
|
|
memcpy(&resource->res2.data.irq, &irq->irq,
|
|
|
|
sizeof(struct acpi_resource_irq));
|
|
|
|
/* we requested a shared irq */
|
|
|
|
resource->res2.data.irq.sharable = ACPI_SHARED;
|
|
|
|
|
|
|
|
resource->res3.type = ACPI_RESOURCE_TYPE_END_TAG;
|
|
|
|
}
|
2007-04-09 17:26:03 +00:00
|
|
|
|
|
|
|
/* Attempt to set the resource */
|
|
|
|
dprintk("Evaluating _SRS\n");
|
|
|
|
status = acpi_set_current_resources(device->handle, &buffer);
|
|
|
|
|
|
|
|
/* check for total failure */
|
|
|
|
if (ACPI_FAILURE(status)) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_err(DRV_PFX "Error evaluating _SRS\n");
|
2007-04-09 17:26:03 +00:00
|
|
|
result = -ENODEV;
|
|
|
|
goto end;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Necessary device initializations calls (from sonypi) */
|
|
|
|
sony_pic_call1(0x82);
|
|
|
|
sony_pic_call2(0x81, 0xff);
|
|
|
|
sony_pic_call1(compat ? 0x92 : 0x82);
|
|
|
|
|
|
|
|
end:
|
|
|
|
kfree(resource);
|
|
|
|
return result;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*****************
|
|
|
|
*
|
|
|
|
* ISR: some event is available
|
|
|
|
*
|
|
|
|
*****************/
|
|
|
|
static irqreturn_t sony_pic_irq(int irq, void *dev_id)
|
|
|
|
{
|
|
|
|
int i, j;
|
|
|
|
u8 ev = 0;
|
|
|
|
u8 data_mask = 0;
|
|
|
|
u8 device_event = 0;
|
|
|
|
|
|
|
|
struct sony_pic_dev *dev = (struct sony_pic_dev *) dev_id;
|
|
|
|
|
2007-08-12 07:20:28 +00:00
|
|
|
ev = inb_p(dev->cur_ioport->io1.minimum);
|
|
|
|
if (dev->cur_ioport->io2.minimum)
|
|
|
|
data_mask = inb_p(dev->cur_ioport->io2.minimum);
|
|
|
|
else
|
2008-01-14 09:05:43 +00:00
|
|
|
data_mask = inb_p(dev->cur_ioport->io1.minimum +
|
2009-09-15 15:05:29 +00:00
|
|
|
dev->evport_offset);
|
2007-04-09 17:26:03 +00:00
|
|
|
|
2007-07-15 17:34:39 +00:00
|
|
|
dprintk("event ([%.2x] [%.2x]) at port 0x%.4x(+0x%.2x)\n",
|
2008-01-14 09:05:43 +00:00
|
|
|
ev, data_mask, dev->cur_ioport->io1.minimum,
|
2009-09-15 15:05:29 +00:00
|
|
|
dev->evport_offset);
|
2007-04-09 17:26:03 +00:00
|
|
|
|
|
|
|
if (ev == 0x00 || ev == 0xff)
|
|
|
|
return IRQ_HANDLED;
|
|
|
|
|
2009-09-15 15:05:29 +00:00
|
|
|
for (i = 0; dev->event_types[i].mask; i++) {
|
2007-04-09 17:26:03 +00:00
|
|
|
|
2009-09-15 15:05:29 +00:00
|
|
|
if ((data_mask & dev->event_types[i].data) !=
|
|
|
|
dev->event_types[i].data)
|
2007-04-09 17:26:03 +00:00
|
|
|
continue;
|
|
|
|
|
2009-09-15 15:05:29 +00:00
|
|
|
if (!(mask & dev->event_types[i].mask))
|
2007-04-09 17:26:03 +00:00
|
|
|
continue;
|
|
|
|
|
2009-09-15 15:05:29 +00:00
|
|
|
for (j = 0; dev->event_types[i].events[j].event; j++) {
|
|
|
|
if (ev == dev->event_types[i].events[j].data) {
|
2007-04-09 17:26:03 +00:00
|
|
|
device_event =
|
2009-09-15 15:05:29 +00:00
|
|
|
dev->event_types[i].events[j].event;
|
2011-02-19 02:52:27 +00:00
|
|
|
/* some events may require ignoring */
|
|
|
|
if (!device_event)
|
|
|
|
return IRQ_HANDLED;
|
2007-04-09 17:26:03 +00:00
|
|
|
goto found;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
2008-01-14 09:05:45 +00:00
|
|
|
/* Still not able to decode the event try to pass
|
|
|
|
* it over to the minidriver
|
|
|
|
*/
|
2009-09-15 15:05:29 +00:00
|
|
|
if (dev->handle_irq && dev->handle_irq(data_mask, ev) == 0)
|
2008-01-14 09:05:45 +00:00
|
|
|
return IRQ_HANDLED;
|
|
|
|
|
2008-01-14 09:05:43 +00:00
|
|
|
dprintk("unknown event ([%.2x] [%.2x]) at port 0x%.4x(+0x%.2x)\n",
|
|
|
|
ev, data_mask, dev->cur_ioport->io1.minimum,
|
2009-09-15 15:05:29 +00:00
|
|
|
dev->evport_offset);
|
2007-04-09 17:26:03 +00:00
|
|
|
return IRQ_HANDLED;
|
|
|
|
|
|
|
|
found:
|
2007-04-09 08:19:08 +00:00
|
|
|
sony_laptop_report_input_event(device_event);
|
2008-01-14 09:05:43 +00:00
|
|
|
acpi_bus_generate_proc_event(dev->acpi_dev, 1, device_event);
|
2007-04-09 17:31:25 +00:00
|
|
|
sonypi_compat_report_event(device_event);
|
2007-04-09 17:26:03 +00:00
|
|
|
return IRQ_HANDLED;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*****************
|
|
|
|
*
|
|
|
|
* ACPI driver
|
|
|
|
*
|
|
|
|
*****************/
|
|
|
|
static int sony_pic_remove(struct acpi_device *device, int type)
|
|
|
|
{
|
|
|
|
struct sony_pic_ioport *io, *tmp_io;
|
|
|
|
struct sony_pic_irq *irq, *tmp_irq;
|
|
|
|
|
|
|
|
if (sony_pic_disable(device)) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_err(DRV_PFX "Couldn't disable device.\n");
|
2007-04-09 17:26:03 +00:00
|
|
|
return -ENXIO;
|
|
|
|
}
|
|
|
|
|
|
|
|
free_irq(spic_dev.cur_irq->irq.interrupts[0], &spic_dev);
|
2007-08-12 07:20:28 +00:00
|
|
|
release_region(spic_dev.cur_ioport->io1.minimum,
|
|
|
|
spic_dev.cur_ioport->io1.address_length);
|
|
|
|
if (spic_dev.cur_ioport->io2.minimum)
|
|
|
|
release_region(spic_dev.cur_ioport->io2.minimum,
|
|
|
|
spic_dev.cur_ioport->io2.address_length);
|
2007-04-09 17:26:03 +00:00
|
|
|
|
2007-08-12 07:20:27 +00:00
|
|
|
sonypi_compat_exit();
|
|
|
|
|
2007-04-09 08:19:08 +00:00
|
|
|
sony_laptop_remove_input();
|
2007-04-09 17:26:03 +00:00
|
|
|
|
2007-04-09 17:28:56 +00:00
|
|
|
/* pf attrs */
|
|
|
|
sysfs_remove_group(&sony_pf_device->dev.kobj, &spic_attribute_group);
|
|
|
|
sony_pf_remove();
|
|
|
|
|
2007-04-09 17:26:03 +00:00
|
|
|
list_for_each_entry_safe(io, tmp_io, &spic_dev.ioports, list) {
|
|
|
|
list_del(&io->list);
|
|
|
|
kfree(io);
|
|
|
|
}
|
|
|
|
list_for_each_entry_safe(irq, tmp_irq, &spic_dev.interrupts, list) {
|
|
|
|
list_del(&irq->list);
|
|
|
|
kfree(irq);
|
|
|
|
}
|
|
|
|
spic_dev.cur_ioport = NULL;
|
|
|
|
spic_dev.cur_irq = NULL;
|
|
|
|
|
2007-04-09 17:31:06 +00:00
|
|
|
dprintk(SONY_PIC_DRIVER_NAME " removed.\n");
|
2007-04-09 17:26:03 +00:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int sony_pic_add(struct acpi_device *device)
|
|
|
|
{
|
|
|
|
int result;
|
|
|
|
struct sony_pic_ioport *io, *tmp_io;
|
|
|
|
struct sony_pic_irq *irq, *tmp_irq;
|
|
|
|
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_info(DRV_PFX "%s v%s.\n", SONY_PIC_DRIVER_NAME,
|
|
|
|
SONY_LAPTOP_DRIVER_VERSION);
|
2007-04-09 17:26:03 +00:00
|
|
|
|
|
|
|
spic_dev.acpi_dev = device;
|
|
|
|
strcpy(acpi_device_class(device), "sony/hotkey");
|
2008-01-14 09:05:43 +00:00
|
|
|
sony_pic_detect_device_type(&spic_dev);
|
2007-04-28 14:19:36 +00:00
|
|
|
mutex_init(&spic_dev.lock);
|
2007-04-09 17:26:03 +00:00
|
|
|
|
|
|
|
/* read _PRS resources */
|
|
|
|
result = sony_pic_possible_resources(device);
|
|
|
|
if (result) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_err(DRV_PFX "Unable to read possible resources.\n");
|
2007-04-09 17:26:03 +00:00
|
|
|
goto err_free_resources;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* setup input devices and helper fifo */
|
2007-11-21 19:15:53 +00:00
|
|
|
result = sony_laptop_setup_input(device);
|
2007-04-09 17:26:03 +00:00
|
|
|
if (result) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_err(DRV_PFX "Unable to create input devices.\n");
|
2007-04-09 17:26:03 +00:00
|
|
|
goto err_free_resources;
|
|
|
|
}
|
|
|
|
|
2007-08-12 07:20:27 +00:00
|
|
|
if (sonypi_compat_init())
|
|
|
|
goto err_remove_input;
|
|
|
|
|
2007-04-09 17:26:03 +00:00
|
|
|
/* request io port */
|
2007-08-12 07:20:28 +00:00
|
|
|
list_for_each_entry_reverse(io, &spic_dev.ioports, list) {
|
|
|
|
if (request_region(io->io1.minimum, io->io1.address_length,
|
2007-04-09 17:26:03 +00:00
|
|
|
"Sony Programable I/O Device")) {
|
2007-08-12 07:20:28 +00:00
|
|
|
dprintk("I/O port1: 0x%.4x (0x%.4x) + 0x%.2x\n",
|
|
|
|
io->io1.minimum, io->io1.maximum,
|
|
|
|
io->io1.address_length);
|
|
|
|
/* Type 1 have 2 ioports */
|
|
|
|
if (io->io2.minimum) {
|
|
|
|
if (request_region(io->io2.minimum,
|
|
|
|
io->io2.address_length,
|
|
|
|
"Sony Programable I/O Device")) {
|
|
|
|
dprintk("I/O port2: 0x%.4x (0x%.4x) + 0x%.2x\n",
|
|
|
|
io->io2.minimum, io->io2.maximum,
|
|
|
|
io->io2.address_length);
|
|
|
|
spic_dev.cur_ioport = io;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
else {
|
|
|
|
dprintk("Unable to get I/O port2: "
|
|
|
|
"0x%.4x (0x%.4x) + 0x%.2x\n",
|
|
|
|
io->io2.minimum, io->io2.maximum,
|
|
|
|
io->io2.address_length);
|
|
|
|
release_region(io->io1.minimum,
|
|
|
|
io->io1.address_length);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
else {
|
|
|
|
spic_dev.cur_ioport = io;
|
|
|
|
break;
|
|
|
|
}
|
2007-04-09 17:26:03 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
if (!spic_dev.cur_ioport) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_err(DRV_PFX "Failed to request_region.\n");
|
2007-04-09 17:26:03 +00:00
|
|
|
result = -ENODEV;
|
2007-08-12 07:20:27 +00:00
|
|
|
goto err_remove_compat;
|
2007-04-09 17:26:03 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/* request IRQ */
|
2007-08-12 07:20:28 +00:00
|
|
|
list_for_each_entry_reverse(irq, &spic_dev.interrupts, list) {
|
2007-04-09 17:26:03 +00:00
|
|
|
if (!request_irq(irq->irq.interrupts[0], sony_pic_irq,
|
2009-09-15 15:05:30 +00:00
|
|
|
IRQF_DISABLED, "sony-laptop", &spic_dev)) {
|
2007-04-09 17:26:03 +00:00
|
|
|
dprintk("IRQ: %d - triggering: %d - "
|
|
|
|
"polarity: %d - shr: %d\n",
|
|
|
|
irq->irq.interrupts[0],
|
|
|
|
irq->irq.triggering,
|
|
|
|
irq->irq.polarity,
|
|
|
|
irq->irq.sharable);
|
|
|
|
spic_dev.cur_irq = irq;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
if (!spic_dev.cur_irq) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_err(DRV_PFX "Failed to request_irq.\n");
|
2007-04-09 17:26:03 +00:00
|
|
|
result = -ENODEV;
|
|
|
|
goto err_release_region;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* set resource status _SRS */
|
|
|
|
result = sony_pic_enable(device, spic_dev.cur_ioport, spic_dev.cur_irq);
|
|
|
|
if (result) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_err(DRV_PFX "Couldn't enable device.\n");
|
2007-04-09 17:26:03 +00:00
|
|
|
goto err_free_irq;
|
|
|
|
}
|
|
|
|
|
2007-04-09 17:28:56 +00:00
|
|
|
spic_dev.bluetooth_power = -1;
|
|
|
|
/* create device attributes */
|
|
|
|
result = sony_pf_add();
|
|
|
|
if (result)
|
|
|
|
goto err_disable_device;
|
|
|
|
|
|
|
|
result = sysfs_create_group(&sony_pf_device->dev.kobj, &spic_attribute_group);
|
|
|
|
if (result)
|
|
|
|
goto err_remove_pf;
|
|
|
|
|
2007-04-09 17:26:03 +00:00
|
|
|
return 0;
|
|
|
|
|
2007-04-09 17:28:56 +00:00
|
|
|
err_remove_pf:
|
|
|
|
sony_pf_remove();
|
|
|
|
|
|
|
|
err_disable_device:
|
|
|
|
sony_pic_disable(device);
|
|
|
|
|
2007-04-09 17:26:03 +00:00
|
|
|
err_free_irq:
|
|
|
|
free_irq(spic_dev.cur_irq->irq.interrupts[0], &spic_dev);
|
|
|
|
|
|
|
|
err_release_region:
|
2007-08-12 07:20:28 +00:00
|
|
|
release_region(spic_dev.cur_ioport->io1.minimum,
|
|
|
|
spic_dev.cur_ioport->io1.address_length);
|
|
|
|
if (spic_dev.cur_ioport->io2.minimum)
|
|
|
|
release_region(spic_dev.cur_ioport->io2.minimum,
|
|
|
|
spic_dev.cur_ioport->io2.address_length);
|
2007-04-09 17:26:03 +00:00
|
|
|
|
2007-08-12 07:20:27 +00:00
|
|
|
err_remove_compat:
|
|
|
|
sonypi_compat_exit();
|
|
|
|
|
2007-04-09 17:26:03 +00:00
|
|
|
err_remove_input:
|
2007-04-09 08:19:08 +00:00
|
|
|
sony_laptop_remove_input();
|
2007-04-09 17:26:03 +00:00
|
|
|
|
|
|
|
err_free_resources:
|
|
|
|
list_for_each_entry_safe(io, tmp_io, &spic_dev.ioports, list) {
|
|
|
|
list_del(&io->list);
|
|
|
|
kfree(io);
|
|
|
|
}
|
|
|
|
list_for_each_entry_safe(irq, tmp_irq, &spic_dev.interrupts, list) {
|
|
|
|
list_del(&irq->list);
|
|
|
|
kfree(irq);
|
|
|
|
}
|
|
|
|
spic_dev.cur_ioport = NULL;
|
|
|
|
spic_dev.cur_irq = NULL;
|
|
|
|
|
|
|
|
return result;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int sony_pic_suspend(struct acpi_device *device, pm_message_t state)
|
|
|
|
{
|
|
|
|
if (sony_pic_disable(device))
|
|
|
|
return -ENXIO;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int sony_pic_resume(struct acpi_device *device)
|
|
|
|
{
|
|
|
|
sony_pic_enable(device, spic_dev.cur_ioport, spic_dev.cur_irq);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2007-07-23 12:44:41 +00:00
|
|
|
static const struct acpi_device_id sony_pic_device_ids[] = {
|
|
|
|
{SONY_PIC_HID, 0},
|
|
|
|
{"", 0},
|
|
|
|
};
|
|
|
|
|
2007-04-09 17:26:03 +00:00
|
|
|
static struct acpi_driver sony_pic_driver = {
|
|
|
|
.name = SONY_PIC_DRIVER_NAME,
|
|
|
|
.class = SONY_PIC_CLASS,
|
2007-07-23 12:44:41 +00:00
|
|
|
.ids = sony_pic_device_ids,
|
2007-04-09 17:26:03 +00:00
|
|
|
.owner = THIS_MODULE,
|
|
|
|
.ops = {
|
|
|
|
.add = sony_pic_add,
|
|
|
|
.remove = sony_pic_remove,
|
|
|
|
.suspend = sony_pic_suspend,
|
|
|
|
.resume = sony_pic_resume,
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
|
|
|
static struct dmi_system_id __initdata sonypi_dmi_table[] = {
|
|
|
|
{
|
|
|
|
.ident = "Sony Vaio",
|
|
|
|
.matches = {
|
|
|
|
DMI_MATCH(DMI_SYS_VENDOR, "Sony Corporation"),
|
|
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "PCG-"),
|
|
|
|
},
|
|
|
|
},
|
|
|
|
{
|
|
|
|
.ident = "Sony Vaio",
|
|
|
|
.matches = {
|
|
|
|
DMI_MATCH(DMI_SYS_VENDOR, "Sony Corporation"),
|
|
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "VGN-"),
|
|
|
|
},
|
|
|
|
},
|
|
|
|
{ }
|
|
|
|
};
|
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
static int __init sony_laptop_init(void)
|
2007-01-13 22:04:31 +00:00
|
|
|
{
|
2007-04-09 17:26:03 +00:00
|
|
|
int result;
|
|
|
|
|
|
|
|
if (!no_spic && dmi_check_system(sonypi_dmi_table)) {
|
|
|
|
result = acpi_bus_register_driver(&sony_pic_driver);
|
|
|
|
if (result) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_err(DRV_PFX "Unable to register SPIC driver.");
|
2007-04-09 17:26:03 +00:00
|
|
|
goto out;
|
|
|
|
}
|
2009-09-15 15:05:32 +00:00
|
|
|
spic_drv_registered = 1;
|
2007-04-09 17:26:03 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
result = acpi_bus_register_driver(&sony_nc_driver);
|
|
|
|
if (result) {
|
2011-02-19 02:52:28 +00:00
|
|
|
pr_err(DRV_PFX "Unable to register SNC driver.");
|
2007-04-09 17:26:03 +00:00
|
|
|
goto out_unregister_pic;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
out_unregister_pic:
|
2009-09-15 15:05:32 +00:00
|
|
|
if (spic_drv_registered)
|
2007-04-09 17:26:03 +00:00
|
|
|
acpi_bus_unregister_driver(&sony_pic_driver);
|
|
|
|
out:
|
|
|
|
return result;
|
2007-01-13 22:04:31 +00:00
|
|
|
}
|
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
static void __exit sony_laptop_exit(void)
|
2007-01-13 22:04:31 +00:00
|
|
|
{
|
2007-04-09 08:19:04 +00:00
|
|
|
acpi_bus_unregister_driver(&sony_nc_driver);
|
2009-09-15 15:05:32 +00:00
|
|
|
if (spic_drv_registered)
|
2007-04-09 17:26:03 +00:00
|
|
|
acpi_bus_unregister_driver(&sony_pic_driver);
|
2007-01-13 22:04:31 +00:00
|
|
|
}
|
|
|
|
|
2007-04-09 08:19:04 +00:00
|
|
|
module_init(sony_laptop_init);
|
|
|
|
module_exit(sony_laptop_exit);
|