0e1152fcc2
directly accessed. Although this will work on some platforms, it can throw an exception if the pointer is invalid and then panic the kernel. Add a missing SYSCTL_IN() of "SCTP_BASE_STATS" structure. MFC after: 3 days Sponsored by: Mellanox Technologies
1257 lines
32 KiB
C
1257 lines
32 KiB
C
/*-
|
|
* Copyright (c) 2004 Takanori Watanabe
|
|
* Copyright (c) 2005 Markus Brueffer <markus@FreeBSD.org>
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
|
|
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
|
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
|
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
|
* SUCH DAMAGE.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__FBSDID("$FreeBSD$");
|
|
|
|
/*
|
|
* Driver for extra ACPI-controlled gadgets found on IBM ThinkPad laptops.
|
|
* Inspired by the ibm-acpi and tpb projects which implement these features
|
|
* on Linux.
|
|
*
|
|
* acpi-ibm: <http://ibm-acpi.sourceforge.net/>
|
|
* tpb: <http://www.nongnu.org/tpb/>
|
|
*/
|
|
|
|
#include "opt_acpi.h"
|
|
#include <sys/param.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/bus.h>
|
|
#include <machine/cpufunc.h>
|
|
|
|
#include <contrib/dev/acpica/include/acpi.h>
|
|
#include <contrib/dev/acpica/include/accommon.h>
|
|
|
|
#include "acpi_if.h"
|
|
#include <sys/module.h>
|
|
#include <dev/acpica/acpivar.h>
|
|
#include <dev/led/led.h>
|
|
#include <sys/power.h>
|
|
#include <sys/sbuf.h>
|
|
#include <sys/sysctl.h>
|
|
#include <isa/rtc.h>
|
|
|
|
#define _COMPONENT ACPI_OEM
|
|
ACPI_MODULE_NAME("IBM")
|
|
|
|
/* Internal methods */
|
|
#define ACPI_IBM_METHOD_EVENTS 1
|
|
#define ACPI_IBM_METHOD_EVENTMASK 2
|
|
#define ACPI_IBM_METHOD_HOTKEY 3
|
|
#define ACPI_IBM_METHOD_BRIGHTNESS 4
|
|
#define ACPI_IBM_METHOD_VOLUME 5
|
|
#define ACPI_IBM_METHOD_MUTE 6
|
|
#define ACPI_IBM_METHOD_THINKLIGHT 7
|
|
#define ACPI_IBM_METHOD_BLUETOOTH 8
|
|
#define ACPI_IBM_METHOD_WLAN 9
|
|
#define ACPI_IBM_METHOD_FANSPEED 10
|
|
#define ACPI_IBM_METHOD_FANLEVEL 11
|
|
#define ACPI_IBM_METHOD_FANSTATUS 12
|
|
#define ACPI_IBM_METHOD_THERMAL 13
|
|
#define ACPI_IBM_METHOD_HANDLEREVENTS 14
|
|
|
|
/* Hotkeys/Buttons */
|
|
#define IBM_RTC_HOTKEY1 0x64
|
|
#define IBM_RTC_MASK_HOME (1 << 0)
|
|
#define IBM_RTC_MASK_SEARCH (1 << 1)
|
|
#define IBM_RTC_MASK_MAIL (1 << 2)
|
|
#define IBM_RTC_MASK_WLAN (1 << 5)
|
|
#define IBM_RTC_HOTKEY2 0x65
|
|
#define IBM_RTC_MASK_THINKPAD (1 << 3)
|
|
#define IBM_RTC_MASK_ZOOM (1 << 5)
|
|
#define IBM_RTC_MASK_VIDEO (1 << 6)
|
|
#define IBM_RTC_MASK_HIBERNATE (1 << 7)
|
|
#define IBM_RTC_THINKLIGHT 0x66
|
|
#define IBM_RTC_MASK_THINKLIGHT (1 << 4)
|
|
#define IBM_RTC_SCREENEXPAND 0x67
|
|
#define IBM_RTC_MASK_SCREENEXPAND (1 << 5)
|
|
#define IBM_RTC_BRIGHTNESS 0x6c
|
|
#define IBM_RTC_MASK_BRIGHTNESS (1 << 5)
|
|
#define IBM_RTC_VOLUME 0x6e
|
|
#define IBM_RTC_MASK_VOLUME (1 << 7)
|
|
|
|
/* Embedded Controller registers */
|
|
#define IBM_EC_BRIGHTNESS 0x31
|
|
#define IBM_EC_MASK_BRI 0x7
|
|
#define IBM_EC_VOLUME 0x30
|
|
#define IBM_EC_MASK_VOL 0xf
|
|
#define IBM_EC_MASK_MUTE (1 << 6)
|
|
#define IBM_EC_FANSTATUS 0x2F
|
|
#define IBM_EC_MASK_FANLEVEL 0x3f
|
|
#define IBM_EC_MASK_FANDISENGAGED (1 << 6)
|
|
#define IBM_EC_MASK_FANSTATUS (1 << 7)
|
|
#define IBM_EC_FANSPEED 0x84
|
|
|
|
/* CMOS Commands */
|
|
#define IBM_CMOS_VOLUME_DOWN 0
|
|
#define IBM_CMOS_VOLUME_UP 1
|
|
#define IBM_CMOS_VOLUME_MUTE 2
|
|
#define IBM_CMOS_BRIGHTNESS_UP 4
|
|
#define IBM_CMOS_BRIGHTNESS_DOWN 5
|
|
|
|
/* ACPI methods */
|
|
#define IBM_NAME_KEYLIGHT "KBLT"
|
|
#define IBM_NAME_WLAN_BT_GET "GBDC"
|
|
#define IBM_NAME_WLAN_BT_SET "SBDC"
|
|
#define IBM_NAME_MASK_BT (1 << 1)
|
|
#define IBM_NAME_MASK_WLAN (1 << 2)
|
|
#define IBM_NAME_THERMAL_GET "TMP7"
|
|
#define IBM_NAME_THERMAL_UPDT "UPDT"
|
|
|
|
#define IBM_NAME_EVENTS_STATUS_GET "DHKC"
|
|
#define IBM_NAME_EVENTS_MASK_GET "DHKN"
|
|
#define IBM_NAME_EVENTS_STATUS_SET "MHKC"
|
|
#define IBM_NAME_EVENTS_MASK_SET "MHKM"
|
|
#define IBM_NAME_EVENTS_GET "MHKP"
|
|
#define IBM_NAME_EVENTS_AVAILMASK "MHKA"
|
|
|
|
/* Event Code */
|
|
#define IBM_EVENT_LCD_BACKLIGHT 0x03
|
|
#define IBM_EVENT_SUSPEND_TO_RAM 0x04
|
|
#define IBM_EVENT_BLUETOOTH 0x05
|
|
#define IBM_EVENT_SCREEN_EXPAND 0x07
|
|
#define IBM_EVENT_SUSPEND_TO_DISK 0x0c
|
|
#define IBM_EVENT_BRIGHTNESS_UP 0x10
|
|
#define IBM_EVENT_BRIGHTNESS_DOWN 0x11
|
|
#define IBM_EVENT_THINKLIGHT 0x12
|
|
#define IBM_EVENT_ZOOM 0x14
|
|
#define IBM_EVENT_VOLUME_UP 0x15
|
|
#define IBM_EVENT_VOLUME_DOWN 0x16
|
|
#define IBM_EVENT_MUTE 0x17
|
|
#define IBM_EVENT_ACCESS_IBM_BUTTON 0x18
|
|
|
|
#define ABS(x) (((x) < 0)? -(x) : (x))
|
|
|
|
struct acpi_ibm_softc {
|
|
device_t dev;
|
|
ACPI_HANDLE handle;
|
|
|
|
/* Embedded controller */
|
|
device_t ec_dev;
|
|
ACPI_HANDLE ec_handle;
|
|
|
|
/* CMOS */
|
|
ACPI_HANDLE cmos_handle;
|
|
|
|
/* Fan status */
|
|
ACPI_HANDLE fan_handle;
|
|
int fan_levels;
|
|
|
|
/* Keylight commands and states */
|
|
ACPI_HANDLE light_handle;
|
|
int light_cmd_on;
|
|
int light_cmd_off;
|
|
int light_val;
|
|
int light_get_supported;
|
|
int light_set_supported;
|
|
|
|
/* led(4) interface */
|
|
struct cdev *led_dev;
|
|
int led_busy;
|
|
int led_state;
|
|
|
|
int wlan_bt_flags;
|
|
int thermal_updt_supported;
|
|
|
|
unsigned int events_availmask;
|
|
unsigned int events_initialmask;
|
|
int events_mask_supported;
|
|
int events_enable;
|
|
|
|
unsigned int handler_events;
|
|
|
|
struct sysctl_ctx_list *sysctl_ctx;
|
|
struct sysctl_oid *sysctl_tree;
|
|
};
|
|
|
|
static struct {
|
|
char *name;
|
|
int method;
|
|
char *description;
|
|
int flag_rdonly;
|
|
} acpi_ibm_sysctls[] = {
|
|
{
|
|
.name = "events",
|
|
.method = ACPI_IBM_METHOD_EVENTS,
|
|
.description = "ACPI events enable",
|
|
},
|
|
{
|
|
.name = "eventmask",
|
|
.method = ACPI_IBM_METHOD_EVENTMASK,
|
|
.description = "ACPI eventmask",
|
|
},
|
|
{
|
|
.name = "hotkey",
|
|
.method = ACPI_IBM_METHOD_HOTKEY,
|
|
.description = "Key Status",
|
|
.flag_rdonly = 1
|
|
},
|
|
{
|
|
.name = "lcd_brightness",
|
|
.method = ACPI_IBM_METHOD_BRIGHTNESS,
|
|
.description = "LCD Brightness",
|
|
},
|
|
{
|
|
.name = "volume",
|
|
.method = ACPI_IBM_METHOD_VOLUME,
|
|
.description = "Volume",
|
|
},
|
|
{
|
|
.name = "mute",
|
|
.method = ACPI_IBM_METHOD_MUTE,
|
|
.description = "Mute",
|
|
},
|
|
{
|
|
.name = "thinklight",
|
|
.method = ACPI_IBM_METHOD_THINKLIGHT,
|
|
.description = "Thinklight enable",
|
|
},
|
|
{
|
|
.name = "bluetooth",
|
|
.method = ACPI_IBM_METHOD_BLUETOOTH,
|
|
.description = "Bluetooth enable",
|
|
},
|
|
{
|
|
.name = "wlan",
|
|
.method = ACPI_IBM_METHOD_WLAN,
|
|
.description = "WLAN enable",
|
|
.flag_rdonly = 1
|
|
},
|
|
{
|
|
.name = "fan_speed",
|
|
.method = ACPI_IBM_METHOD_FANSPEED,
|
|
.description = "Fan speed",
|
|
.flag_rdonly = 1
|
|
},
|
|
{
|
|
.name = "fan_level",
|
|
.method = ACPI_IBM_METHOD_FANLEVEL,
|
|
.description = "Fan level",
|
|
},
|
|
{
|
|
.name = "fan",
|
|
.method = ACPI_IBM_METHOD_FANSTATUS,
|
|
.description = "Fan enable",
|
|
},
|
|
|
|
{ NULL, 0, NULL, 0 }
|
|
};
|
|
|
|
ACPI_SERIAL_DECL(ibm, "ACPI IBM extras");
|
|
|
|
static int acpi_ibm_probe(device_t dev);
|
|
static int acpi_ibm_attach(device_t dev);
|
|
static int acpi_ibm_detach(device_t dev);
|
|
static int acpi_ibm_resume(device_t dev);
|
|
|
|
static void ibm_led(void *softc, int onoff);
|
|
static void ibm_led_task(struct acpi_ibm_softc *sc, int pending __unused);
|
|
|
|
static int acpi_ibm_sysctl(SYSCTL_HANDLER_ARGS);
|
|
static int acpi_ibm_sysctl_init(struct acpi_ibm_softc *sc, int method);
|
|
static int acpi_ibm_sysctl_get(struct acpi_ibm_softc *sc, int method);
|
|
static int acpi_ibm_sysctl_set(struct acpi_ibm_softc *sc, int method, int val);
|
|
|
|
static int acpi_ibm_eventmask_set(struct acpi_ibm_softc *sc, int val);
|
|
static int acpi_ibm_thermal_sysctl(SYSCTL_HANDLER_ARGS);
|
|
static int acpi_ibm_handlerevents_sysctl(SYSCTL_HANDLER_ARGS);
|
|
static void acpi_ibm_notify(ACPI_HANDLE h, UINT32 notify, void *context);
|
|
|
|
static int acpi_ibm_brightness_set(struct acpi_ibm_softc *sc, int arg);
|
|
static int acpi_ibm_bluetooth_set(struct acpi_ibm_softc *sc, int arg);
|
|
static int acpi_ibm_thinklight_set(struct acpi_ibm_softc *sc, int arg);
|
|
static int acpi_ibm_volume_set(struct acpi_ibm_softc *sc, int arg);
|
|
static int acpi_ibm_mute_set(struct acpi_ibm_softc *sc, int arg);
|
|
|
|
static device_method_t acpi_ibm_methods[] = {
|
|
/* Device interface */
|
|
DEVMETHOD(device_probe, acpi_ibm_probe),
|
|
DEVMETHOD(device_attach, acpi_ibm_attach),
|
|
DEVMETHOD(device_detach, acpi_ibm_detach),
|
|
DEVMETHOD(device_resume, acpi_ibm_resume),
|
|
|
|
DEVMETHOD_END
|
|
};
|
|
|
|
static driver_t acpi_ibm_driver = {
|
|
"acpi_ibm",
|
|
acpi_ibm_methods,
|
|
sizeof(struct acpi_ibm_softc),
|
|
};
|
|
|
|
static devclass_t acpi_ibm_devclass;
|
|
|
|
DRIVER_MODULE(acpi_ibm, acpi, acpi_ibm_driver, acpi_ibm_devclass,
|
|
0, 0);
|
|
MODULE_DEPEND(acpi_ibm, acpi, 1, 1, 1);
|
|
static char *ibm_ids[] = {"IBM0068", "LEN0068", NULL};
|
|
|
|
static void
|
|
ibm_led(void *softc, int onoff)
|
|
{
|
|
struct acpi_ibm_softc* sc = (struct acpi_ibm_softc*) softc;
|
|
|
|
ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
|
|
|
|
if (sc->led_busy)
|
|
return;
|
|
|
|
sc->led_busy = 1;
|
|
sc->led_state = onoff;
|
|
|
|
AcpiOsExecute(OSL_NOTIFY_HANDLER, (void *)ibm_led_task, sc);
|
|
}
|
|
|
|
static void
|
|
ibm_led_task(struct acpi_ibm_softc *sc, int pending __unused)
|
|
{
|
|
ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
|
|
|
|
ACPI_SERIAL_BEGIN(ibm);
|
|
acpi_ibm_sysctl_set(sc, ACPI_IBM_METHOD_THINKLIGHT, sc->led_state);
|
|
ACPI_SERIAL_END(ibm);
|
|
|
|
sc->led_busy = 0;
|
|
}
|
|
|
|
static int
|
|
acpi_ibm_probe(device_t dev)
|
|
{
|
|
if (acpi_disabled("ibm") ||
|
|
ACPI_ID_PROBE(device_get_parent(dev), dev, ibm_ids) == NULL ||
|
|
device_get_unit(dev) != 0)
|
|
return (ENXIO);
|
|
|
|
device_set_desc(dev, "IBM ThinkPad ACPI Extras");
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
acpi_ibm_attach(device_t dev)
|
|
{
|
|
struct acpi_ibm_softc *sc;
|
|
devclass_t ec_devclass;
|
|
|
|
ACPI_FUNCTION_TRACE((char *)(uintptr_t) __func__);
|
|
|
|
sc = device_get_softc(dev);
|
|
sc->dev = dev;
|
|
sc->handle = acpi_get_handle(dev);
|
|
|
|
/* Look for the first embedded controller */
|
|
if (!(ec_devclass = devclass_find ("acpi_ec"))) {
|
|
if (bootverbose)
|
|
device_printf(dev, "Couldn't find acpi_ec devclass\n");
|
|
return (EINVAL);
|
|
}
|
|
if (!(sc->ec_dev = devclass_get_device(ec_devclass, 0))) {
|
|
if (bootverbose)
|
|
device_printf(dev, "Couldn't find acpi_ec device\n");
|
|
return (EINVAL);
|
|
}
|
|
sc->ec_handle = acpi_get_handle(sc->ec_dev);
|
|
|
|
/* Get the sysctl tree */
|
|
sc->sysctl_ctx = device_get_sysctl_ctx(dev);
|
|
sc->sysctl_tree = device_get_sysctl_tree(dev);
|
|
|
|
/* Look for event mask and hook up the nodes */
|
|
sc->events_mask_supported = ACPI_SUCCESS(acpi_GetInteger(sc->handle,
|
|
IBM_NAME_EVENTS_MASK_GET, &sc->events_initialmask));
|
|
|
|
if (sc->events_mask_supported) {
|
|
SYSCTL_ADD_UINT(sc->sysctl_ctx,
|
|
SYSCTL_CHILDREN(sc->sysctl_tree), OID_AUTO,
|
|
"initialmask", CTLFLAG_RD,
|
|
&sc->events_initialmask, 0, "Initial eventmask");
|
|
|
|
/* The availmask is the bitmask of supported events */
|
|
if (ACPI_FAILURE(acpi_GetInteger(sc->handle,
|
|
IBM_NAME_EVENTS_AVAILMASK, &sc->events_availmask)))
|
|
sc->events_availmask = 0xffffffff;
|
|
|
|
SYSCTL_ADD_UINT(sc->sysctl_ctx,
|
|
SYSCTL_CHILDREN(sc->sysctl_tree), OID_AUTO,
|
|
"availmask", CTLFLAG_RD,
|
|
&sc->events_availmask, 0, "Mask of supported events");
|
|
}
|
|
|
|
/* Hook up proc nodes */
|
|
for (int i = 0; acpi_ibm_sysctls[i].name != NULL; i++) {
|
|
if (!acpi_ibm_sysctl_init(sc, acpi_ibm_sysctls[i].method))
|
|
continue;
|
|
|
|
if (acpi_ibm_sysctls[i].flag_rdonly != 0) {
|
|
SYSCTL_ADD_PROC(sc->sysctl_ctx,
|
|
SYSCTL_CHILDREN(sc->sysctl_tree), OID_AUTO,
|
|
acpi_ibm_sysctls[i].name, CTLTYPE_INT | CTLFLAG_RD,
|
|
sc, i, acpi_ibm_sysctl, "I",
|
|
acpi_ibm_sysctls[i].description);
|
|
} else {
|
|
SYSCTL_ADD_PROC(sc->sysctl_ctx,
|
|
SYSCTL_CHILDREN(sc->sysctl_tree), OID_AUTO,
|
|
acpi_ibm_sysctls[i].name, CTLTYPE_INT | CTLFLAG_RW,
|
|
sc, i, acpi_ibm_sysctl, "I",
|
|
acpi_ibm_sysctls[i].description);
|
|
}
|
|
}
|
|
|
|
/* Hook up thermal node */
|
|
if (acpi_ibm_sysctl_init(sc, ACPI_IBM_METHOD_THERMAL)) {
|
|
SYSCTL_ADD_PROC(sc->sysctl_ctx,
|
|
SYSCTL_CHILDREN(sc->sysctl_tree), OID_AUTO,
|
|
"thermal", CTLTYPE_INT | CTLFLAG_RD,
|
|
sc, 0, acpi_ibm_thermal_sysctl, "I",
|
|
"Thermal zones");
|
|
}
|
|
|
|
/* Hook up handlerevents node */
|
|
if (acpi_ibm_sysctl_init(sc, ACPI_IBM_METHOD_HANDLEREVENTS)) {
|
|
SYSCTL_ADD_PROC(sc->sysctl_ctx,
|
|
SYSCTL_CHILDREN(sc->sysctl_tree), OID_AUTO,
|
|
"handlerevents", CTLTYPE_STRING | CTLFLAG_RW,
|
|
sc, 0, acpi_ibm_handlerevents_sysctl, "I",
|
|
"devd(8) events handled by acpi_ibm");
|
|
}
|
|
|
|
/* Handle notifies */
|
|
AcpiInstallNotifyHandler(sc->handle, ACPI_DEVICE_NOTIFY,
|
|
acpi_ibm_notify, dev);
|
|
|
|
/* Hook up light to led(4) */
|
|
if (sc->light_set_supported)
|
|
sc->led_dev = led_create_state(ibm_led, sc, "thinklight", sc->light_val);
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
acpi_ibm_detach(device_t dev)
|
|
{
|
|
ACPI_FUNCTION_TRACE((char *)(uintptr_t) __func__);
|
|
|
|
struct acpi_ibm_softc *sc = device_get_softc(dev);
|
|
|
|
/* Disable events and restore eventmask */
|
|
ACPI_SERIAL_BEGIN(ibm);
|
|
acpi_ibm_sysctl_set(sc, ACPI_IBM_METHOD_EVENTS, 0);
|
|
acpi_ibm_sysctl_set(sc, ACPI_IBM_METHOD_EVENTMASK, sc->events_initialmask);
|
|
ACPI_SERIAL_END(ibm);
|
|
|
|
AcpiRemoveNotifyHandler(sc->handle, ACPI_DEVICE_NOTIFY, acpi_ibm_notify);
|
|
|
|
if (sc->led_dev != NULL)
|
|
led_destroy(sc->led_dev);
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
acpi_ibm_resume(device_t dev)
|
|
{
|
|
struct acpi_ibm_softc *sc = device_get_softc(dev);
|
|
|
|
ACPI_FUNCTION_TRACE((char *)(uintptr_t) __func__);
|
|
|
|
ACPI_SERIAL_BEGIN(ibm);
|
|
for (int i = 0; acpi_ibm_sysctls[i].name != NULL; i++) {
|
|
int val;
|
|
|
|
val = acpi_ibm_sysctl_get(sc, i);
|
|
|
|
if (acpi_ibm_sysctls[i].flag_rdonly != 0)
|
|
continue;
|
|
|
|
acpi_ibm_sysctl_set(sc, i, val);
|
|
}
|
|
ACPI_SERIAL_END(ibm);
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
acpi_ibm_eventmask_set(struct acpi_ibm_softc *sc, int val)
|
|
{
|
|
ACPI_OBJECT arg[2];
|
|
ACPI_OBJECT_LIST args;
|
|
ACPI_STATUS status;
|
|
|
|
ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
|
|
ACPI_SERIAL_ASSERT(ibm);
|
|
|
|
args.Count = 2;
|
|
args.Pointer = arg;
|
|
arg[0].Type = ACPI_TYPE_INTEGER;
|
|
arg[1].Type = ACPI_TYPE_INTEGER;
|
|
|
|
for (int i = 0; i < 32; ++i) {
|
|
arg[0].Integer.Value = i+1;
|
|
arg[1].Integer.Value = (((1 << i) & val) != 0);
|
|
status = AcpiEvaluateObject(sc->handle,
|
|
IBM_NAME_EVENTS_MASK_SET, &args, NULL);
|
|
|
|
if (ACPI_FAILURE(status))
|
|
return (status);
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
acpi_ibm_sysctl(SYSCTL_HANDLER_ARGS)
|
|
{
|
|
struct acpi_ibm_softc *sc;
|
|
int arg;
|
|
int error = 0;
|
|
int function;
|
|
int method;
|
|
|
|
ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
|
|
|
|
sc = (struct acpi_ibm_softc *)oidp->oid_arg1;
|
|
function = oidp->oid_arg2;
|
|
method = acpi_ibm_sysctls[function].method;
|
|
|
|
ACPI_SERIAL_BEGIN(ibm);
|
|
arg = acpi_ibm_sysctl_get(sc, method);
|
|
error = sysctl_handle_int(oidp, &arg, 0, req);
|
|
|
|
/* Sanity check */
|
|
if (error != 0 || req->newptr == NULL)
|
|
goto out;
|
|
|
|
/* Update */
|
|
error = acpi_ibm_sysctl_set(sc, method, arg);
|
|
|
|
out:
|
|
ACPI_SERIAL_END(ibm);
|
|
return (error);
|
|
}
|
|
|
|
static int
|
|
acpi_ibm_sysctl_get(struct acpi_ibm_softc *sc, int method)
|
|
{
|
|
UINT64 val_ec;
|
|
int val = 0, key;
|
|
|
|
ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
|
|
ACPI_SERIAL_ASSERT(ibm);
|
|
|
|
switch (method) {
|
|
case ACPI_IBM_METHOD_EVENTS:
|
|
acpi_GetInteger(sc->handle, IBM_NAME_EVENTS_STATUS_GET, &val);
|
|
break;
|
|
|
|
case ACPI_IBM_METHOD_EVENTMASK:
|
|
if (sc->events_mask_supported)
|
|
acpi_GetInteger(sc->handle, IBM_NAME_EVENTS_MASK_GET, &val);
|
|
break;
|
|
|
|
case ACPI_IBM_METHOD_HOTKEY:
|
|
/*
|
|
* Construct the hotkey as a bitmask as illustrated below.
|
|
* Note that whenever a key was pressed, the respecting bit
|
|
* toggles and nothing else changes.
|
|
* +--+--+-+-+-+-+-+-+-+-+-+-+
|
|
* |11|10|9|8|7|6|5|4|3|2|1|0|
|
|
* +--+--+-+-+-+-+-+-+-+-+-+-+
|
|
* | | | | | | | | | | | |
|
|
* | | | | | | | | | | | +- Home Button
|
|
* | | | | | | | | | | +--- Search Button
|
|
* | | | | | | | | | +----- Mail Button
|
|
* | | | | | | | | +------- Thinkpad Button
|
|
* | | | | | | | +--------- Zoom (Fn + Space)
|
|
* | | | | | | +----------- WLAN Button
|
|
* | | | | | +------------- Video Button
|
|
* | | | | +--------------- Hibernate Button
|
|
* | | | +----------------- Thinklight Button
|
|
* | | +------------------- Screen expand (Fn + F8)
|
|
* | +--------------------- Brightness
|
|
* +------------------------ Volume/Mute
|
|
*/
|
|
key = rtcin(IBM_RTC_HOTKEY1);
|
|
val = (IBM_RTC_MASK_HOME | IBM_RTC_MASK_SEARCH | IBM_RTC_MASK_MAIL | IBM_RTC_MASK_WLAN) & key;
|
|
key = rtcin(IBM_RTC_HOTKEY2);
|
|
val |= (IBM_RTC_MASK_THINKPAD | IBM_RTC_MASK_VIDEO | IBM_RTC_MASK_HIBERNATE) & key;
|
|
val |= (IBM_RTC_MASK_ZOOM & key) >> 1;
|
|
key = rtcin(IBM_RTC_THINKLIGHT);
|
|
val |= (IBM_RTC_MASK_THINKLIGHT & key) << 4;
|
|
key = rtcin(IBM_RTC_SCREENEXPAND);
|
|
val |= (IBM_RTC_MASK_THINKLIGHT & key) << 4;
|
|
key = rtcin(IBM_RTC_BRIGHTNESS);
|
|
val |= (IBM_RTC_MASK_BRIGHTNESS & key) << 5;
|
|
key = rtcin(IBM_RTC_VOLUME);
|
|
val |= (IBM_RTC_MASK_VOLUME & key) << 4;
|
|
break;
|
|
|
|
case ACPI_IBM_METHOD_BRIGHTNESS:
|
|
ACPI_EC_READ(sc->ec_dev, IBM_EC_BRIGHTNESS, &val_ec, 1);
|
|
val = val_ec & IBM_EC_MASK_BRI;
|
|
break;
|
|
|
|
case ACPI_IBM_METHOD_VOLUME:
|
|
ACPI_EC_READ(sc->ec_dev, IBM_EC_VOLUME, &val_ec, 1);
|
|
val = val_ec & IBM_EC_MASK_VOL;
|
|
break;
|
|
|
|
case ACPI_IBM_METHOD_MUTE:
|
|
ACPI_EC_READ(sc->ec_dev, IBM_EC_VOLUME, &val_ec, 1);
|
|
val = ((val_ec & IBM_EC_MASK_MUTE) == IBM_EC_MASK_MUTE);
|
|
break;
|
|
|
|
case ACPI_IBM_METHOD_THINKLIGHT:
|
|
if (sc->light_get_supported)
|
|
acpi_GetInteger(sc->ec_handle, IBM_NAME_KEYLIGHT, &val);
|
|
else
|
|
val = sc->light_val;
|
|
break;
|
|
|
|
case ACPI_IBM_METHOD_BLUETOOTH:
|
|
acpi_GetInteger(sc->handle, IBM_NAME_WLAN_BT_GET, &val);
|
|
sc->wlan_bt_flags = val;
|
|
val = ((val & IBM_NAME_MASK_BT) != 0);
|
|
break;
|
|
|
|
case ACPI_IBM_METHOD_WLAN:
|
|
acpi_GetInteger(sc->handle, IBM_NAME_WLAN_BT_GET, &val);
|
|
sc->wlan_bt_flags = val;
|
|
val = ((val & IBM_NAME_MASK_WLAN) != 0);
|
|
break;
|
|
|
|
case ACPI_IBM_METHOD_FANSPEED:
|
|
if (sc->fan_handle) {
|
|
if(ACPI_FAILURE(acpi_GetInteger(sc->fan_handle, NULL, &val)))
|
|
val = -1;
|
|
}
|
|
else {
|
|
ACPI_EC_READ(sc->ec_dev, IBM_EC_FANSPEED, &val_ec, 2);
|
|
val = val_ec;
|
|
}
|
|
break;
|
|
|
|
case ACPI_IBM_METHOD_FANLEVEL:
|
|
/*
|
|
* The IBM_EC_FANSTATUS register works as follows:
|
|
* Bit 0-5 indicate the level at which the fan operates. Only
|
|
* values between 0 and 7 have an effect. Everything
|
|
* above 7 is treated the same as level 7
|
|
* Bit 6 overrides the fan speed limit if set to 1
|
|
* Bit 7 indicates at which mode the fan operates:
|
|
* manual (0) or automatic (1)
|
|
*/
|
|
if (!sc->fan_handle) {
|
|
ACPI_EC_READ(sc->ec_dev, IBM_EC_FANSTATUS, &val_ec, 1);
|
|
val = val_ec & IBM_EC_MASK_FANLEVEL;
|
|
}
|
|
break;
|
|
|
|
case ACPI_IBM_METHOD_FANSTATUS:
|
|
if (!sc->fan_handle) {
|
|
ACPI_EC_READ(sc->ec_dev, IBM_EC_FANSTATUS, &val_ec, 1);
|
|
val = (val_ec & IBM_EC_MASK_FANSTATUS) == IBM_EC_MASK_FANSTATUS;
|
|
}
|
|
else
|
|
val = -1;
|
|
break;
|
|
}
|
|
|
|
return (val);
|
|
}
|
|
|
|
static int
|
|
acpi_ibm_sysctl_set(struct acpi_ibm_softc *sc, int method, int arg)
|
|
{
|
|
int val;
|
|
UINT64 val_ec;
|
|
ACPI_STATUS status;
|
|
|
|
ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
|
|
ACPI_SERIAL_ASSERT(ibm);
|
|
|
|
switch (method) {
|
|
case ACPI_IBM_METHOD_EVENTS:
|
|
if (arg < 0 || arg > 1)
|
|
return (EINVAL);
|
|
|
|
status = acpi_SetInteger(sc->handle, IBM_NAME_EVENTS_STATUS_SET, arg);
|
|
if (ACPI_FAILURE(status))
|
|
return (status);
|
|
if (sc->events_mask_supported)
|
|
return acpi_ibm_eventmask_set(sc, sc->events_availmask);
|
|
break;
|
|
|
|
case ACPI_IBM_METHOD_EVENTMASK:
|
|
if (sc->events_mask_supported)
|
|
return acpi_ibm_eventmask_set(sc, arg);
|
|
break;
|
|
|
|
case ACPI_IBM_METHOD_BRIGHTNESS:
|
|
return acpi_ibm_brightness_set(sc, arg);
|
|
break;
|
|
|
|
case ACPI_IBM_METHOD_VOLUME:
|
|
return acpi_ibm_volume_set(sc, arg);
|
|
break;
|
|
|
|
case ACPI_IBM_METHOD_MUTE:
|
|
return acpi_ibm_mute_set(sc, arg);
|
|
break;
|
|
|
|
case ACPI_IBM_METHOD_THINKLIGHT:
|
|
return acpi_ibm_thinklight_set(sc, arg);
|
|
break;
|
|
|
|
case ACPI_IBM_METHOD_BLUETOOTH:
|
|
return acpi_ibm_bluetooth_set(sc, arg);
|
|
break;
|
|
|
|
case ACPI_IBM_METHOD_FANLEVEL:
|
|
if (arg < 0 || arg > 7)
|
|
return (EINVAL);
|
|
|
|
if (!sc->fan_handle) {
|
|
/* Read the current fanstatus */
|
|
ACPI_EC_READ(sc->ec_dev, IBM_EC_FANSTATUS, &val_ec, 1);
|
|
val = val_ec & (~IBM_EC_MASK_FANLEVEL);
|
|
|
|
return ACPI_EC_WRITE(sc->ec_dev, IBM_EC_FANSTATUS, val | arg, 1);
|
|
}
|
|
break;
|
|
|
|
case ACPI_IBM_METHOD_FANSTATUS:
|
|
if (arg < 0 || arg > 1)
|
|
return (EINVAL);
|
|
|
|
if (!sc->fan_handle) {
|
|
/* Read the current fanstatus */
|
|
ACPI_EC_READ(sc->ec_dev, IBM_EC_FANSTATUS, &val_ec, 1);
|
|
|
|
return ACPI_EC_WRITE(sc->ec_dev, IBM_EC_FANSTATUS,
|
|
(arg == 1) ? (val_ec | IBM_EC_MASK_FANSTATUS) : (val_ec & (~IBM_EC_MASK_FANSTATUS)), 1);
|
|
}
|
|
break;
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
acpi_ibm_sysctl_init(struct acpi_ibm_softc *sc, int method)
|
|
{
|
|
int dummy;
|
|
ACPI_OBJECT_TYPE cmos_t;
|
|
ACPI_HANDLE ledb_handle;
|
|
|
|
switch (method) {
|
|
case ACPI_IBM_METHOD_EVENTS:
|
|
/* Events are disabled by default */
|
|
return (TRUE);
|
|
|
|
case ACPI_IBM_METHOD_EVENTMASK:
|
|
return (sc->events_mask_supported);
|
|
|
|
case ACPI_IBM_METHOD_HOTKEY:
|
|
case ACPI_IBM_METHOD_BRIGHTNESS:
|
|
case ACPI_IBM_METHOD_VOLUME:
|
|
case ACPI_IBM_METHOD_MUTE:
|
|
/* EC is required here, which was aready checked before */
|
|
return (TRUE);
|
|
|
|
case ACPI_IBM_METHOD_THINKLIGHT:
|
|
sc->cmos_handle = NULL;
|
|
sc->light_get_supported = ACPI_SUCCESS(acpi_GetInteger(
|
|
sc->ec_handle, IBM_NAME_KEYLIGHT, &sc->light_val));
|
|
|
|
if ((ACPI_SUCCESS(AcpiGetHandle(sc->handle, "\\UCMS", &sc->light_handle)) ||
|
|
ACPI_SUCCESS(AcpiGetHandle(sc->handle, "\\CMOS", &sc->light_handle)) ||
|
|
ACPI_SUCCESS(AcpiGetHandle(sc->handle, "\\CMS", &sc->light_handle))) &&
|
|
ACPI_SUCCESS(AcpiGetType(sc->light_handle, &cmos_t)) &&
|
|
cmos_t == ACPI_TYPE_METHOD) {
|
|
sc->light_cmd_on = 0x0c;
|
|
sc->light_cmd_off = 0x0d;
|
|
sc->cmos_handle = sc->light_handle;
|
|
}
|
|
else if (ACPI_SUCCESS(AcpiGetHandle(sc->handle, "\\LGHT", &sc->light_handle))) {
|
|
sc->light_cmd_on = 1;
|
|
sc->light_cmd_off = 0;
|
|
}
|
|
else
|
|
sc->light_handle = NULL;
|
|
|
|
sc->light_set_supported = (sc->light_handle &&
|
|
ACPI_FAILURE(AcpiGetHandle(sc->ec_handle, "LEDB", &ledb_handle)));
|
|
|
|
if (sc->light_get_supported)
|
|
return (TRUE);
|
|
|
|
if (sc->light_set_supported) {
|
|
sc->light_val = 0;
|
|
return (TRUE);
|
|
}
|
|
|
|
return (FALSE);
|
|
|
|
case ACPI_IBM_METHOD_BLUETOOTH:
|
|
case ACPI_IBM_METHOD_WLAN:
|
|
if (ACPI_SUCCESS(acpi_GetInteger(sc->handle, IBM_NAME_WLAN_BT_GET, &dummy)))
|
|
return (TRUE);
|
|
return (FALSE);
|
|
|
|
case ACPI_IBM_METHOD_FANSPEED:
|
|
/*
|
|
* Some models report the fan speed in levels from 0-7
|
|
* Newer models report it contiguously
|
|
*/
|
|
sc->fan_levels =
|
|
(ACPI_SUCCESS(AcpiGetHandle(sc->handle, "GFAN", &sc->fan_handle)) ||
|
|
ACPI_SUCCESS(AcpiGetHandle(sc->handle, "\\FSPD", &sc->fan_handle)));
|
|
return (TRUE);
|
|
|
|
case ACPI_IBM_METHOD_FANLEVEL:
|
|
case ACPI_IBM_METHOD_FANSTATUS:
|
|
/*
|
|
* Fan status is only supported on those models,
|
|
* which report fan RPM contiguously, not in levels
|
|
*/
|
|
if (sc->fan_levels)
|
|
return (FALSE);
|
|
return (TRUE);
|
|
|
|
case ACPI_IBM_METHOD_THERMAL:
|
|
if (ACPI_SUCCESS(acpi_GetInteger(sc->ec_handle, IBM_NAME_THERMAL_GET, &dummy))) {
|
|
sc->thermal_updt_supported = ACPI_SUCCESS(acpi_GetInteger(sc->ec_handle, IBM_NAME_THERMAL_UPDT, &dummy));
|
|
return (TRUE);
|
|
}
|
|
return (FALSE);
|
|
|
|
case ACPI_IBM_METHOD_HANDLEREVENTS:
|
|
return (TRUE);
|
|
}
|
|
return (FALSE);
|
|
}
|
|
|
|
static int
|
|
acpi_ibm_thermal_sysctl(SYSCTL_HANDLER_ARGS)
|
|
{
|
|
struct acpi_ibm_softc *sc;
|
|
int error = 0;
|
|
char temp_cmd[] = "TMP0";
|
|
int temp[8];
|
|
|
|
ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
|
|
|
|
sc = (struct acpi_ibm_softc *)oidp->oid_arg1;
|
|
|
|
ACPI_SERIAL_BEGIN(ibm);
|
|
|
|
for (int i = 0; i < 8; ++i) {
|
|
temp_cmd[3] = '0' + i;
|
|
|
|
/*
|
|
* The TMPx methods seem to return +/- 128 or 0
|
|
* when the respecting sensor is not available
|
|
*/
|
|
if (ACPI_FAILURE(acpi_GetInteger(sc->ec_handle, temp_cmd,
|
|
&temp[i])) || ABS(temp[i]) == 128 || temp[i] == 0)
|
|
temp[i] = -1;
|
|
else if (sc->thermal_updt_supported)
|
|
/* Temperature is reported in tenth of Kelvin */
|
|
temp[i] = (temp[i] - 2732 + 5) / 10;
|
|
}
|
|
|
|
error = sysctl_handle_opaque(oidp, &temp, 8*sizeof(int), req);
|
|
|
|
ACPI_SERIAL_END(ibm);
|
|
return (error);
|
|
}
|
|
|
|
static int
|
|
acpi_ibm_handlerevents_sysctl(SYSCTL_HANDLER_ARGS)
|
|
{
|
|
struct acpi_ibm_softc *sc;
|
|
int error = 0;
|
|
struct sbuf sb;
|
|
char *cp, *ep;
|
|
int l, val;
|
|
unsigned int handler_events;
|
|
char temp[128];
|
|
|
|
ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
|
|
|
|
sc = (struct acpi_ibm_softc *)oidp->oid_arg1;
|
|
|
|
if (sbuf_new(&sb, NULL, 128, SBUF_AUTOEXTEND) == NULL)
|
|
return (ENOMEM);
|
|
|
|
ACPI_SERIAL_BEGIN(ibm);
|
|
|
|
/* Get old values if this is a get request. */
|
|
if (req->newptr == NULL) {
|
|
for (int i = 0; i < 8 * sizeof(sc->handler_events); i++)
|
|
if (sc->handler_events & (1 << i))
|
|
sbuf_printf(&sb, "0x%02x ", i + 1);
|
|
if (sbuf_len(&sb) == 0)
|
|
sbuf_printf(&sb, "NONE");
|
|
}
|
|
|
|
sbuf_trim(&sb);
|
|
sbuf_finish(&sb);
|
|
strlcpy(temp, sbuf_data(&sb), sizeof(temp));
|
|
sbuf_delete(&sb);
|
|
|
|
error = sysctl_handle_string(oidp, temp, sizeof(temp), req);
|
|
|
|
/* Check for error or no change */
|
|
if (error != 0 || req->newptr == NULL)
|
|
goto out;
|
|
|
|
/* If the user is setting a string, parse it. */
|
|
handler_events = 0;
|
|
cp = temp;
|
|
while (*cp) {
|
|
if (isspace(*cp)) {
|
|
cp++;
|
|
continue;
|
|
}
|
|
|
|
ep = cp;
|
|
|
|
while (*ep && !isspace(*ep))
|
|
ep++;
|
|
|
|
l = ep - cp;
|
|
if (l == 0)
|
|
break;
|
|
|
|
if (strncmp(cp, "NONE", 4) == 0) {
|
|
cp = ep;
|
|
continue;
|
|
}
|
|
|
|
if (l >= 3 && cp[0] == '0' && (cp[1] == 'X' || cp[1] == 'x'))
|
|
val = strtoul(cp, &ep, 16);
|
|
else
|
|
val = strtoul(cp, &ep, 10);
|
|
|
|
if (val == 0 || ep == cp || val >= 8 * sizeof(handler_events)) {
|
|
cp[l] = '\0';
|
|
device_printf(sc->dev, "invalid event code: %s\n", cp);
|
|
error = EINVAL;
|
|
goto out;
|
|
}
|
|
|
|
handler_events |= 1 << (val - 1);
|
|
|
|
cp = ep;
|
|
}
|
|
|
|
sc->handler_events = handler_events;
|
|
out:
|
|
ACPI_SERIAL_END(ibm);
|
|
return (error);
|
|
}
|
|
|
|
static int
|
|
acpi_ibm_brightness_set(struct acpi_ibm_softc *sc, int arg)
|
|
{
|
|
int val, step;
|
|
UINT64 val_ec;
|
|
ACPI_OBJECT Arg;
|
|
ACPI_OBJECT_LIST Args;
|
|
ACPI_STATUS status;
|
|
|
|
ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
|
|
ACPI_SERIAL_ASSERT(ibm);
|
|
|
|
if (arg < 0 || arg > 7)
|
|
return (EINVAL);
|
|
|
|
/* Read the current brightness */
|
|
status = ACPI_EC_READ(sc->ec_dev, IBM_EC_BRIGHTNESS, &val_ec, 1);
|
|
if (ACPI_FAILURE(status))
|
|
return (status);
|
|
|
|
if (sc->cmos_handle) {
|
|
val = val_ec & IBM_EC_MASK_BRI;
|
|
|
|
Args.Count = 1;
|
|
Args.Pointer = &Arg;
|
|
Arg.Type = ACPI_TYPE_INTEGER;
|
|
Arg.Integer.Value = (arg > val) ? IBM_CMOS_BRIGHTNESS_UP :
|
|
IBM_CMOS_BRIGHTNESS_DOWN;
|
|
|
|
step = (arg > val) ? 1 : -1;
|
|
for (int i = val; i != arg; i += step) {
|
|
status = AcpiEvaluateObject(sc->cmos_handle, NULL,
|
|
&Args, NULL);
|
|
if (ACPI_FAILURE(status)) {
|
|
/* Record the last value */
|
|
if (i != val) {
|
|
ACPI_EC_WRITE(sc->ec_dev,
|
|
IBM_EC_BRIGHTNESS, i - step, 1);
|
|
}
|
|
return (status);
|
|
}
|
|
}
|
|
}
|
|
|
|
return ACPI_EC_WRITE(sc->ec_dev, IBM_EC_BRIGHTNESS, arg, 1);
|
|
}
|
|
|
|
static int
|
|
acpi_ibm_bluetooth_set(struct acpi_ibm_softc *sc, int arg)
|
|
{
|
|
int val;
|
|
|
|
ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
|
|
ACPI_SERIAL_ASSERT(ibm);
|
|
|
|
if (arg < 0 || arg > 1)
|
|
return (EINVAL);
|
|
|
|
val = (arg == 1) ? sc->wlan_bt_flags | IBM_NAME_MASK_BT :
|
|
sc->wlan_bt_flags & (~IBM_NAME_MASK_BT);
|
|
return acpi_SetInteger(sc->handle, IBM_NAME_WLAN_BT_SET, val);
|
|
}
|
|
|
|
static int
|
|
acpi_ibm_thinklight_set(struct acpi_ibm_softc *sc, int arg)
|
|
{
|
|
ACPI_OBJECT Arg;
|
|
ACPI_OBJECT_LIST Args;
|
|
ACPI_STATUS status;
|
|
|
|
ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
|
|
ACPI_SERIAL_ASSERT(ibm);
|
|
|
|
if (arg < 0 || arg > 1)
|
|
return (EINVAL);
|
|
|
|
if (sc->light_set_supported) {
|
|
Args.Count = 1;
|
|
Args.Pointer = &Arg;
|
|
Arg.Type = ACPI_TYPE_INTEGER;
|
|
Arg.Integer.Value = arg ? sc->light_cmd_on : sc->light_cmd_off;
|
|
|
|
status = AcpiEvaluateObject(sc->light_handle, NULL,
|
|
&Args, NULL);
|
|
if (ACPI_SUCCESS(status))
|
|
sc->light_val = arg;
|
|
return (status);
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
acpi_ibm_volume_set(struct acpi_ibm_softc *sc, int arg)
|
|
{
|
|
int val, step;
|
|
UINT64 val_ec;
|
|
ACPI_OBJECT Arg;
|
|
ACPI_OBJECT_LIST Args;
|
|
ACPI_STATUS status;
|
|
|
|
ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
|
|
ACPI_SERIAL_ASSERT(ibm);
|
|
|
|
if (arg < 0 || arg > 14)
|
|
return (EINVAL);
|
|
|
|
/* Read the current volume */
|
|
status = ACPI_EC_READ(sc->ec_dev, IBM_EC_VOLUME, &val_ec, 1);
|
|
if (ACPI_FAILURE(status))
|
|
return (status);
|
|
|
|
if (sc->cmos_handle) {
|
|
val = val_ec & IBM_EC_MASK_VOL;
|
|
|
|
Args.Count = 1;
|
|
Args.Pointer = &Arg;
|
|
Arg.Type = ACPI_TYPE_INTEGER;
|
|
Arg.Integer.Value = (arg > val) ? IBM_CMOS_VOLUME_UP :
|
|
IBM_CMOS_VOLUME_DOWN;
|
|
|
|
step = (arg > val) ? 1 : -1;
|
|
for (int i = val; i != arg; i += step) {
|
|
status = AcpiEvaluateObject(sc->cmos_handle, NULL,
|
|
&Args, NULL);
|
|
if (ACPI_FAILURE(status)) {
|
|
/* Record the last value */
|
|
if (i != val) {
|
|
val_ec = i - step +
|
|
(val_ec & (~IBM_EC_MASK_VOL));
|
|
ACPI_EC_WRITE(sc->ec_dev, IBM_EC_VOLUME,
|
|
val_ec, 1);
|
|
}
|
|
return (status);
|
|
}
|
|
}
|
|
}
|
|
|
|
val_ec = arg + (val_ec & (~IBM_EC_MASK_VOL));
|
|
return ACPI_EC_WRITE(sc->ec_dev, IBM_EC_VOLUME, val_ec, 1);
|
|
}
|
|
|
|
static int
|
|
acpi_ibm_mute_set(struct acpi_ibm_softc *sc, int arg)
|
|
{
|
|
UINT64 val_ec;
|
|
ACPI_OBJECT Arg;
|
|
ACPI_OBJECT_LIST Args;
|
|
ACPI_STATUS status;
|
|
|
|
ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
|
|
ACPI_SERIAL_ASSERT(ibm);
|
|
|
|
if (arg < 0 || arg > 1)
|
|
return (EINVAL);
|
|
|
|
status = ACPI_EC_READ(sc->ec_dev, IBM_EC_VOLUME, &val_ec, 1);
|
|
if (ACPI_FAILURE(status))
|
|
return (status);
|
|
|
|
if (sc->cmos_handle) {
|
|
Args.Count = 1;
|
|
Args.Pointer = &Arg;
|
|
Arg.Type = ACPI_TYPE_INTEGER;
|
|
Arg.Integer.Value = IBM_CMOS_VOLUME_MUTE;
|
|
|
|
status = AcpiEvaluateObject(sc->cmos_handle, NULL, &Args, NULL);
|
|
if (ACPI_FAILURE(status))
|
|
return (status);
|
|
}
|
|
|
|
val_ec = (arg == 1) ? val_ec | IBM_EC_MASK_MUTE :
|
|
val_ec & (~IBM_EC_MASK_MUTE);
|
|
return ACPI_EC_WRITE(sc->ec_dev, IBM_EC_VOLUME, val_ec, 1);
|
|
}
|
|
|
|
static void
|
|
acpi_ibm_eventhandler(struct acpi_ibm_softc *sc, int arg)
|
|
{
|
|
int val;
|
|
UINT64 val_ec;
|
|
ACPI_STATUS status;
|
|
|
|
ACPI_SERIAL_BEGIN(ibm);
|
|
switch (arg) {
|
|
case IBM_EVENT_SUSPEND_TO_RAM:
|
|
power_pm_suspend(POWER_SLEEP_STATE_SUSPEND);
|
|
break;
|
|
|
|
case IBM_EVENT_BLUETOOTH:
|
|
acpi_ibm_bluetooth_set(sc, (sc->wlan_bt_flags == 0));
|
|
break;
|
|
|
|
case IBM_EVENT_BRIGHTNESS_UP:
|
|
case IBM_EVENT_BRIGHTNESS_DOWN:
|
|
/* Read the current brightness */
|
|
status = ACPI_EC_READ(sc->ec_dev, IBM_EC_BRIGHTNESS,
|
|
&val_ec, 1);
|
|
if (ACPI_FAILURE(status))
|
|
return;
|
|
|
|
val = val_ec & IBM_EC_MASK_BRI;
|
|
val = (arg == IBM_EVENT_BRIGHTNESS_UP) ? val + 1 : val - 1;
|
|
acpi_ibm_brightness_set(sc, val);
|
|
break;
|
|
|
|
case IBM_EVENT_THINKLIGHT:
|
|
acpi_ibm_thinklight_set(sc, (sc->light_val == 0));
|
|
break;
|
|
|
|
case IBM_EVENT_VOLUME_UP:
|
|
case IBM_EVENT_VOLUME_DOWN:
|
|
/* Read the current volume */
|
|
status = ACPI_EC_READ(sc->ec_dev, IBM_EC_VOLUME, &val_ec, 1);
|
|
if (ACPI_FAILURE(status))
|
|
return;
|
|
|
|
val = val_ec & IBM_EC_MASK_VOL;
|
|
val = (arg == IBM_EVENT_VOLUME_UP) ? val + 1 : val - 1;
|
|
acpi_ibm_volume_set(sc, val);
|
|
break;
|
|
|
|
case IBM_EVENT_MUTE:
|
|
/* Read the current value */
|
|
status = ACPI_EC_READ(sc->ec_dev, IBM_EC_VOLUME, &val_ec, 1);
|
|
if (ACPI_FAILURE(status))
|
|
return;
|
|
|
|
val = ((val_ec & IBM_EC_MASK_MUTE) == IBM_EC_MASK_MUTE);
|
|
acpi_ibm_mute_set(sc, (val == 0));
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
ACPI_SERIAL_END(ibm);
|
|
}
|
|
|
|
static void
|
|
acpi_ibm_notify(ACPI_HANDLE h, UINT32 notify, void *context)
|
|
{
|
|
int event, arg, type;
|
|
device_t dev = context;
|
|
struct acpi_ibm_softc *sc = device_get_softc(dev);
|
|
|
|
ACPI_FUNCTION_TRACE_U32((char *)(uintptr_t)__func__, notify);
|
|
|
|
if (notify != 0x80)
|
|
device_printf(dev, "Unknown notify\n");
|
|
|
|
for (;;) {
|
|
acpi_GetInteger(acpi_get_handle(dev), IBM_NAME_EVENTS_GET, &event);
|
|
|
|
if (event == 0)
|
|
break;
|
|
|
|
|
|
type = (event >> 12) & 0xf;
|
|
arg = event & 0xfff;
|
|
switch (type) {
|
|
case 1:
|
|
if (!(sc->events_availmask & (1 << (arg - 1)))) {
|
|
device_printf(dev, "Unknown key %d\n", arg);
|
|
break;
|
|
}
|
|
|
|
/* Execute event handler */
|
|
if (sc->handler_events & (1 << (arg - 1)))
|
|
acpi_ibm_eventhandler(sc, (arg & 0xff));
|
|
|
|
/* Notify devd(8) */
|
|
acpi_UserNotify("IBM", h, (arg & 0xff));
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
}
|