/* * led.c * * Copyright (C) 2017 Jeremy Soller * Copyright (C) 2014-2016 Arnoud Willemsen * Copyright (C) 2013-2015 TUXEDO Computers GmbH * * 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 . */ 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); }