94 lines
2.4 KiB
C
94 lines
2.4 KiB
C
/*
|
|
* led.c
|
|
*
|
|
* Copyright (C) 2017 Jeremy Soller <jeremy@system76.com>
|
|
* Copyright (C) 2014-2016 Arnoud Willemsen <mail@lynthium.com>
|
|
* Copyright (C) 2013-2015 TUXEDO Computers GmbH <tux@tuxedocomputers.com>
|
|
*
|
|
* 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, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
static struct workqueue_struct *ap_led_workqueue;
|
|
|
|
static struct _ap_led_work {
|
|
struct work_struct work;
|
|
int wk;
|
|
} ap_led_work;
|
|
|
|
static void ap_led_update(struct work_struct *work) {
|
|
u8 byte;
|
|
struct _ap_led_work *w;
|
|
|
|
w = container_of(work, struct _ap_led_work, work);
|
|
|
|
ec_read(0xD9, &byte);
|
|
|
|
ec_write(0xD9, w->wk ? byte & ~0x40 : byte | 0x40);
|
|
|
|
/* wmbb 0x6C 1 (?) */
|
|
}
|
|
|
|
static enum led_brightness ap_led_get(struct led_classdev *led_cdev) {
|
|
u8 byte;
|
|
|
|
ec_read(0xD9, &byte);
|
|
|
|
return byte & 0x40 ? LED_OFF : LED_FULL;
|
|
}
|
|
|
|
/* must not sleep */
|
|
static void ap_led_set(struct led_classdev *led_cdev, enum led_brightness value) {
|
|
ap_led_work.wk = value;
|
|
queue_work(ap_led_workqueue, &ap_led_work.work);
|
|
}
|
|
|
|
static struct led_classdev ap_led = {
|
|
.name = "system76::airplane",
|
|
.brightness_get = ap_led_get,
|
|
.brightness_set = ap_led_set,
|
|
.max_brightness = 1,
|
|
.default_trigger = "rfkill-any"
|
|
};
|
|
|
|
static int __init ap_led_init(struct device *dev) {
|
|
int err;
|
|
|
|
ap_led_workqueue = create_singlethread_workqueue("ap_led_workqueue");
|
|
if (unlikely(!ap_led_workqueue)) {
|
|
return -ENOMEM;
|
|
}
|
|
|
|
INIT_WORK(&ap_led_work.work, ap_led_update);
|
|
|
|
err = led_classdev_register(dev, &ap_led);
|
|
if (unlikely(err)) {
|
|
goto err_destroy_workqueue;
|
|
}
|
|
|
|
return 0;
|
|
|
|
err_destroy_workqueue:
|
|
destroy_workqueue(ap_led_workqueue);
|
|
ap_led_workqueue = NULL;
|
|
|
|
return err;
|
|
}
|
|
|
|
static void __exit ap_led_exit(void) {
|
|
if (!IS_ERR_OR_NULL(ap_led.dev))
|
|
led_classdev_unregister(&ap_led);
|
|
if (ap_led_workqueue)
|
|
destroy_workqueue(ap_led_workqueue);
|
|
}
|