leds-apu2: Add PC Engines APU2 LED driver
This adds support for the PCB LEDs and Reset Button found on the PC Engines APU2/APU3 embedded boards. Signed-off-by: Chris Blake <chrisrblake93@gmail.com>
This commit is contained in:
Chris Blake
Felix Fietkau
parent
9ed108e98b
commit
fe12d51cd4
4 changed files with 435 additions and 0 deletions
52
package/kernel/leds-apu2/Makefile
Normal file
52
package/kernel/leds-apu2/Makefile
Normal file
|
|
@ -0,0 +1,52 @@
|
||||||
|
#
|
||||||
|
# Copyright (C) 2017 Chris Blake <chrisrblake93@gmail.com>
|
||||||
|
#
|
||||||
|
# This is free software, licensed under the GNU General Public License v2.
|
||||||
|
# See /LICENSE for more information.
|
||||||
|
#
|
||||||
|
|
||||||
|
include $(TOPDIR)/rules.mk
|
||||||
|
include $(INCLUDE_DIR)/kernel.mk
|
||||||
|
|
||||||
|
PKG_NAME:=leds-apu2
|
||||||
|
PKG_RELEASE:=1
|
||||||
|
|
||||||
|
PKG_MAINTAINER:=Chris Blake <chrisrblake93@gmail.com>
|
||||||
|
PKG_LICENSE:=GPL-2.0
|
||||||
|
|
||||||
|
include $(INCLUDE_DIR)/package.mk
|
||||||
|
|
||||||
|
define KernelPackage/leds-apu2
|
||||||
|
SUBMENU:=LED modules
|
||||||
|
TITLE:= PC Engines APU2/APU3 LED support
|
||||||
|
DEPENDS:= @GPIO_SUPPORT @TARGET_x86
|
||||||
|
FILES:=$(PKG_BUILD_DIR)/leds-apu2.ko
|
||||||
|
AUTOLOAD:=$(call AutoLoad,41,leds-apu2,1)
|
||||||
|
KCONFIG:=
|
||||||
|
endef
|
||||||
|
|
||||||
|
define KernelPackage/leds-apu2/description
|
||||||
|
Driver for the PC Engines APU2/APU3 LEDs & Reset Button.
|
||||||
|
endef
|
||||||
|
|
||||||
|
EXTRA_KCONFIG:= \
|
||||||
|
CONFIG_LEDS_APU2=m
|
||||||
|
|
||||||
|
EXTRA_CFLAGS:= \
|
||||||
|
$(patsubst CONFIG_%, -DCONFIG_%=1, $(patsubst %=m,%,$(filter %=m,$(EXTRA_KCONFIG)))) \
|
||||||
|
$(patsubst CONFIG_%, -DCONFIG_%=1, $(patsubst %=y,%,$(filter %=y,$(EXTRA_KCONFIG)))) \
|
||||||
|
|
||||||
|
MAKE_OPTS:= \
|
||||||
|
ARCH="$(LINUX_KARCH)" \
|
||||||
|
CROSS_COMPILE="$(TARGET_CROSS)" \
|
||||||
|
SUBDIRS="$(PKG_BUILD_DIR)" \
|
||||||
|
EXTRA_CFLAGS="$(EXTRA_CFLAGS)" \
|
||||||
|
$(EXTRA_KCONFIG)
|
||||||
|
|
||||||
|
define Build/Compile
|
||||||
|
$(MAKE) -C "$(LINUX_DIR)" \
|
||||||
|
$(MAKE_OPTS) \
|
||||||
|
modules
|
||||||
|
endef
|
||||||
|
|
||||||
|
$(eval $(call KernelPackage,leds-apu2))
|
||||||
8
package/kernel/leds-apu2/src/Kconfig
Normal file
8
package/kernel/leds-apu2/src/Kconfig
Normal file
|
|
@ -0,0 +1,8 @@
|
||||||
|
config LEDS_APU2
|
||||||
|
tristate "PC Engines APU2/APU3 LED support"
|
||||||
|
depends on LEDS_CLASS
|
||||||
|
depends on LEDS_GPIO
|
||||||
|
depends on GPIOLIB
|
||||||
|
help
|
||||||
|
Say yes here to enable support for the CPU GPIO pins on the PC Engines
|
||||||
|
APU2/APU3 board, which enables the front LEDs and Reset Button.
|
||||||
1
package/kernel/leds-apu2/src/Makefile
Normal file
1
package/kernel/leds-apu2/src/Makefile
Normal file
|
|
@ -0,0 +1 @@
|
||||||
|
obj-${CONFIG_LEDS_APU2} += leds-apu2.o
|
||||||
374
package/kernel/leds-apu2/src/leds-apu2.c
Normal file
374
package/kernel/leds-apu2/src/leds-apu2.c
Normal file
|
|
@ -0,0 +1,374 @@
|
||||||
|
/*
|
||||||
|
* APU2 LED/GPIO Driver
|
||||||
|
* Copyright (c) 2016 Christian Lamparter <chunkeey (at) googlemail.com>
|
||||||
|
*
|
||||||
|
* Based on gpio-apu2.c - AMD FCH GPIO support for PC-Engines APU-2 board
|
||||||
|
*
|
||||||
|
* Copyright (c) 2015 Carsten Spiess <fli4l at carsten-spiess.de>
|
||||||
|
*
|
||||||
|
* 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/module.h>
|
||||||
|
#include <linux/types.h>
|
||||||
|
#include <linux/miscdevice.h>
|
||||||
|
#include <linux/gpio.h>
|
||||||
|
#include <linux/init.h>
|
||||||
|
#include <linux/pci.h>
|
||||||
|
#include <linux/ioport.h>
|
||||||
|
#include <linux/platform_device.h>
|
||||||
|
#include <linux/uaccess.h>
|
||||||
|
#include <linux/io.h>
|
||||||
|
#include <linux/version.h>
|
||||||
|
#include <linux/dmi.h>
|
||||||
|
#include <linux/string.h>
|
||||||
|
|
||||||
|
#include <linux/leds.h>
|
||||||
|
#include <linux/input.h>
|
||||||
|
#include <linux/gpio_keys.h>
|
||||||
|
|
||||||
|
#define DEVNAME "leds-apu2"
|
||||||
|
|
||||||
|
#define FCH_ACPI_MMIO_BASE 0xFED80000
|
||||||
|
#define FCH_GPIO_BASE (FCH_ACPI_MMIO_BASE + 0x1500)
|
||||||
|
#define FCH_GPIO_SIZE 0x300
|
||||||
|
|
||||||
|
#define APU_NUM_GPIO 4
|
||||||
|
|
||||||
|
#define GPIO_BIT_DIR 23
|
||||||
|
#define GPIO_BIT_WRITE 22
|
||||||
|
#define GPIO_BIT_READ 16
|
||||||
|
|
||||||
|
/* internal variables */
|
||||||
|
static struct pci_dev *gpio_apu2_pci;
|
||||||
|
static DEFINE_SPINLOCK (gpio_lock);
|
||||||
|
|
||||||
|
/* the watchdog platform device */
|
||||||
|
static struct platform_device *gpio_apu2_platform_device;
|
||||||
|
static struct platform_device *leddev;
|
||||||
|
static struct platform_device *keydev;
|
||||||
|
|
||||||
|
static const struct pci_device_id gpio_apu2_pci_tbl[] ={
|
||||||
|
{PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_HUDSON2_SMBUS, PCI_ANY_ID, PCI_ANY_ID},
|
||||||
|
{ 0, } /* End of list */
|
||||||
|
};
|
||||||
|
MODULE_DEVICE_TABLE (pci, gpio_apu2_pci_tbl);
|
||||||
|
|
||||||
|
/* EGPIO89=GPIO32, AGPIO68=GPIO57, AGPIO69=GPIO58, AGPIO70=GPIO59 */
|
||||||
|
static u8 gpio_offset[APU_NUM_GPIO] = {89, 68, 69, 70};
|
||||||
|
|
||||||
|
static void __iomem *gpio_addr[APU_NUM_GPIO] = {NULL, NULL, NULL, NULL};
|
||||||
|
|
||||||
|
static int gpio_apu2_get_dir (struct gpio_chip *chip, unsigned offset)
|
||||||
|
{
|
||||||
|
u32 val;
|
||||||
|
|
||||||
|
val = ~ioread32 (gpio_addr[offset]);
|
||||||
|
|
||||||
|
return (val >> GPIO_BIT_DIR) & 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int gpio_apu2_dir_in (struct gpio_chip *gc, unsigned offset)
|
||||||
|
{
|
||||||
|
u32 val;
|
||||||
|
|
||||||
|
spin_lock_bh (&gpio_lock);
|
||||||
|
|
||||||
|
val = ioread32 (gpio_addr[offset]);
|
||||||
|
val &= ~BIT(GPIO_BIT_DIR);
|
||||||
|
iowrite32 (val, gpio_addr[offset]);
|
||||||
|
|
||||||
|
spin_unlock_bh (&gpio_lock);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int gpio_apu2_dir_out (struct gpio_chip *chip, unsigned offset,
|
||||||
|
int value)
|
||||||
|
{
|
||||||
|
u32 val;
|
||||||
|
|
||||||
|
spin_lock_bh (&gpio_lock);
|
||||||
|
|
||||||
|
val = ioread32 (gpio_addr[offset]);
|
||||||
|
val |= BIT(GPIO_BIT_DIR);
|
||||||
|
iowrite32 (val, gpio_addr[offset]);
|
||||||
|
|
||||||
|
spin_unlock_bh (&gpio_lock);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int gpio_apu2_get_data (struct gpio_chip *chip, unsigned offset)
|
||||||
|
{
|
||||||
|
u32 val;
|
||||||
|
|
||||||
|
val = ioread32 (gpio_addr[offset]);
|
||||||
|
|
||||||
|
return (val >> GPIO_BIT_READ) & 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void gpio_apu2_set_data (struct gpio_chip *chip, unsigned offset, int value)
|
||||||
|
{
|
||||||
|
u32 val;
|
||||||
|
|
||||||
|
spin_lock_bh (&gpio_lock);
|
||||||
|
|
||||||
|
val = ioread32 (gpio_addr[offset]);
|
||||||
|
|
||||||
|
if (value)
|
||||||
|
val |= BIT(GPIO_BIT_WRITE);
|
||||||
|
else
|
||||||
|
val &= ~BIT(GPIO_BIT_WRITE);
|
||||||
|
|
||||||
|
iowrite32 (val, gpio_addr[offset]);
|
||||||
|
|
||||||
|
spin_unlock_bh (&gpio_lock);
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct gpio_chip gpio_apu2_chip = {
|
||||||
|
.label = DEVNAME,
|
||||||
|
.owner = THIS_MODULE,
|
||||||
|
.base = -1,
|
||||||
|
.ngpio = APU_NUM_GPIO,
|
||||||
|
.get_direction = gpio_apu2_get_dir,
|
||||||
|
.direction_input = gpio_apu2_dir_in,
|
||||||
|
.direction_output = gpio_apu2_dir_out,
|
||||||
|
.get = gpio_apu2_get_data,
|
||||||
|
.set = gpio_apu2_set_data,
|
||||||
|
};
|
||||||
|
|
||||||
|
/*
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
static int gpio_apu2_probe (struct platform_device *dev)
|
||||||
|
{
|
||||||
|
int ret = 0;
|
||||||
|
int i;
|
||||||
|
struct pci_dev *pci_dev = NULL;
|
||||||
|
|
||||||
|
/* Match the PCI device */
|
||||||
|
for_each_pci_dev (pci_dev) {
|
||||||
|
if (pci_match_id (gpio_apu2_pci_tbl, pci_dev) != NULL) {
|
||||||
|
gpio_apu2_pci = pci_dev;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (!gpio_apu2_pci)
|
||||||
|
return -ENODEV;
|
||||||
|
|
||||||
|
pr_info ("%s: PCI Revision ID: 0x%x\n", DEVNAME, gpio_apu2_pci->revision);
|
||||||
|
|
||||||
|
/* Determine type of southbridge chipset */
|
||||||
|
if (gpio_apu2_pci->revision < 0x40) {
|
||||||
|
return -EACCES;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Request memory region for GPIO's */
|
||||||
|
if (!devm_request_mem_region (&dev->dev, FCH_GPIO_BASE,
|
||||||
|
FCH_GPIO_SIZE, DEVNAME)){
|
||||||
|
pr_err ("%s: request GPIO mem region failed\n", DEVNAME);
|
||||||
|
return -ENXIO;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Map IO's for GPIO's */
|
||||||
|
for (i = 0; i < APU_NUM_GPIO; i++) {
|
||||||
|
gpio_addr[i] = devm_ioremap (&dev->dev,
|
||||||
|
FCH_GPIO_BASE + (gpio_offset[i] * sizeof (u32)), sizeof (u32));
|
||||||
|
if (!gpio_addr[i]) {
|
||||||
|
pr_err ("%s: map GPIO%d address failed\n", DEVNAME, gpio_offset[i]);
|
||||||
|
return -ENXIO;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
gpio_apu2_chip.dev = &dev->dev;
|
||||||
|
ret = gpiochip_add (&gpio_apu2_chip);
|
||||||
|
if (ret) {
|
||||||
|
pr_err ("%s: adding gpiochip failed\n", DEVNAME);
|
||||||
|
}
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int gpio_apu2_remove (struct platform_device *dev)
|
||||||
|
{
|
||||||
|
#if LINUX_VERSION_CODE < KERNEL_VERSION(3,18,0)
|
||||||
|
int ret;
|
||||||
|
ret = gpiochip_remove (&gpio_apu2_chip);
|
||||||
|
#else /* LINUX_VERSION_CODE < KERNEL_VERSION(3,18,0) */
|
||||||
|
gpiochip_remove (&gpio_apu2_chip);
|
||||||
|
#endif /* LINUX_VERSION_CODE < KERNEL_VERSION(3,18,0) */
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct platform_driver gpio_apu2_driver = {
|
||||||
|
.probe = gpio_apu2_probe,
|
||||||
|
.remove = gpio_apu2_remove,
|
||||||
|
.driver = {
|
||||||
|
.owner = THIS_MODULE,
|
||||||
|
.name = DEVNAME
|
||||||
|
}
|
||||||
|
};
|
||||||
|
|
||||||
|
static struct gpio_led apu2_leds_gpio[] = {
|
||||||
|
{
|
||||||
|
.name = "apu2:green:power",
|
||||||
|
.gpio = 509,
|
||||||
|
.active_low = 1,
|
||||||
|
},
|
||||||
|
{
|
||||||
|
.name = "apu2:green:led2",
|
||||||
|
.gpio = 510,
|
||||||
|
.active_low = 1,
|
||||||
|
},
|
||||||
|
{
|
||||||
|
.name = "apu2:green:led3",
|
||||||
|
.gpio = 511,
|
||||||
|
.active_low = 1,
|
||||||
|
},
|
||||||
|
};
|
||||||
|
|
||||||
|
static struct gpio_keys_button apu2_gpio_keys[] = {
|
||||||
|
{
|
||||||
|
.desc = "Reset button",
|
||||||
|
.type = EV_KEY,
|
||||||
|
.code = KEY_RESTART,
|
||||||
|
.debounce_interval = 60,
|
||||||
|
.gpio = 508,
|
||||||
|
.active_low = 1,
|
||||||
|
},
|
||||||
|
};
|
||||||
|
|
||||||
|
static void register_gpio_keys_polled(int id, unsigned poll_interval,
|
||||||
|
unsigned nbuttons,
|
||||||
|
struct gpio_keys_button *buttons)
|
||||||
|
{
|
||||||
|
struct gpio_keys_platform_data pdata = { };
|
||||||
|
int err;
|
||||||
|
|
||||||
|
keydev = platform_device_alloc("gpio-keys-polled", id);
|
||||||
|
if (!keydev) {
|
||||||
|
printk(KERN_ERR "Failed to allocate gpio-keys platform device\n");
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
pdata.poll_interval = poll_interval;
|
||||||
|
pdata.nbuttons = nbuttons;
|
||||||
|
pdata.buttons = buttons;
|
||||||
|
|
||||||
|
err = platform_device_add_data(keydev, &pdata, sizeof(pdata));
|
||||||
|
if (err) {
|
||||||
|
dev_err(&keydev->dev, "failed to add platform data to key driver (%d)", err);
|
||||||
|
goto err_put_pdev;
|
||||||
|
}
|
||||||
|
|
||||||
|
err = platform_device_add(keydev);
|
||||||
|
if (err) {
|
||||||
|
dev_err(&keydev->dev, "failed to register key platform device (%d)", err);
|
||||||
|
goto err_put_pdev;
|
||||||
|
}
|
||||||
|
|
||||||
|
return;
|
||||||
|
|
||||||
|
err_put_pdev:
|
||||||
|
platform_device_put(keydev);
|
||||||
|
keydev = NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void register_leds_gpio(int id, unsigned num_leds, struct gpio_led *leds)
|
||||||
|
{
|
||||||
|
struct gpio_led_platform_data pdata = { };
|
||||||
|
int err;
|
||||||
|
|
||||||
|
leddev = platform_device_alloc("leds-gpio", id);
|
||||||
|
if (!leddev) {
|
||||||
|
printk(KERN_ERR "Failed to allocate leds-gpio platform device\n");
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
pdata.num_leds = num_leds;
|
||||||
|
pdata.leds = leds;
|
||||||
|
|
||||||
|
err = platform_device_add_data(leddev, &pdata, sizeof(pdata));
|
||||||
|
if (err) {
|
||||||
|
dev_err(&leddev->dev, "failed to add platform data to key driver (%d)", err);
|
||||||
|
goto err_put_pdev;
|
||||||
|
}
|
||||||
|
|
||||||
|
err = platform_device_add(leddev);
|
||||||
|
if (err) {
|
||||||
|
dev_err(&leddev->dev, "failed to register key platform device (%d)", err);
|
||||||
|
goto err_put_pdev;
|
||||||
|
}
|
||||||
|
|
||||||
|
return;
|
||||||
|
|
||||||
|
err_put_pdev:
|
||||||
|
platform_device_put(leddev);
|
||||||
|
leddev = NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int __init gpio_apu2_init (void)
|
||||||
|
{
|
||||||
|
int err;
|
||||||
|
const char *board_vendor = dmi_get_system_info(DMI_BOARD_VENDOR);
|
||||||
|
const char *board_name = dmi_get_system_info(DMI_BOARD_NAME);
|
||||||
|
|
||||||
|
/* Match the device name/model */
|
||||||
|
if (!board_name || !board_vendor || strcasecmp(board_vendor, "PC Engines") || strcasecmp(board_name, "apu2")) {
|
||||||
|
err = -ENODEV;
|
||||||
|
goto exit;
|
||||||
|
}
|
||||||
|
|
||||||
|
pr_info ("%s: load APU2/LED GPIO driver module\n", DEVNAME);
|
||||||
|
|
||||||
|
err = platform_driver_register (&gpio_apu2_driver);
|
||||||
|
if (err)
|
||||||
|
goto exit;
|
||||||
|
|
||||||
|
gpio_apu2_platform_device = platform_device_register_simple (DEVNAME, -1, NULL, 0);
|
||||||
|
if (IS_ERR(gpio_apu2_platform_device)) {
|
||||||
|
err = PTR_ERR(gpio_apu2_platform_device);
|
||||||
|
goto exit_driver;
|
||||||
|
}
|
||||||
|
|
||||||
|
pr_info ("%s: APU2 GPIO/LED driver module loaded\n", DEVNAME);
|
||||||
|
|
||||||
|
register_leds_gpio(-1, ARRAY_SIZE(apu2_leds_gpio), apu2_leds_gpio);
|
||||||
|
register_gpio_keys_polled(-1, 20, ARRAY_SIZE(apu2_gpio_keys), apu2_gpio_keys);
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
exit_driver:
|
||||||
|
platform_driver_unregister (&gpio_apu2_driver);
|
||||||
|
exit:
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void __exit gpio_apu2_exit (void)
|
||||||
|
{
|
||||||
|
platform_device_unregister (gpio_apu2_platform_device);
|
||||||
|
platform_device_unregister (leddev);
|
||||||
|
platform_device_unregister (keydev);
|
||||||
|
platform_driver_unregister (&gpio_apu2_driver);
|
||||||
|
pr_info ("%s: APU2 GPIO/LED driver module unloaded\n", DEVNAME);
|
||||||
|
}
|
||||||
|
|
||||||
|
MODULE_AUTHOR ("Carsten Spiess <fli4l at carsten-spiess.de>");
|
||||||
|
MODULE_DESCRIPTION("GPIO driver for AMD FCH on PC-Engines APU-2");
|
||||||
|
MODULE_LICENSE("GPL");
|
||||||
|
|
||||||
|
module_init (gpio_apu2_init);
|
||||||
|
module_exit (gpio_apu2_exit);
|
||||||
Loading…
Reference in a new issue