freebsd-skq/sys/dev/acpi_support/acpi_ibm.c
Hans Petter Selasky 0e1152fcc2 The SYSCTL data pointers can come from userspace and must not be
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
2014-10-28 12:00:39 +00:00

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;
}
}
}