Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 8ea402f5 authored by Pawel Moll's avatar Pawel Moll Committed by Samuel Ortiz
Browse files

mfd: vexpress: Add pseudo-GPIO based LEDs 



The LEDs on the Versatile Express motherboard are controlled
through simple memory-mapped register. This patch extends
the pseudo-GPIO controller definition for these lines and
creates generic "leds-gpio" device using them

Signed-off-by: default avatarPawel Moll <pawel.moll@arm.com>
Signed-off-by: default avatarSamuel Ortiz <sameo@linux.intel.com>
parent 151621a7

drivers/mfd/vexpress-sysreg.c

+55 −18
Original line number Diff line number Diff line
@@ -49,6 +49,8 @@ 
#define SYS_ID_HBI_SHIFT	16

#define SYS_PROCIDx_HBI_SHIFT	0



#define SYS_LED_LED(n)		(1 << (n))



#define SYS_MCI_CARDIN		(1 << 0)

#define SYS_MCI_WPROT		(1 << 1)
@@ -348,22 +350,27 @@ void __init vexpress_sysreg_of_early_init(void) 
}





#define VEXPRESS_SYSREG_GPIO(_name, _reg, _value) \

	[VEXPRESS_GPIO_##_name] = { \

		.reg = _reg, \

		.value = _reg##_##_value, \

	}



static struct vexpress_sysreg_gpio {

	unsigned long reg;

	u32 value;

} vexpress_sysreg_gpios[] = {

	[VEXPRESS_GPIO_MMC_CARDIN] = {

		.reg = SYS_MCI,

		.value = SYS_MCI_CARDIN,

	},

	[VEXPRESS_GPIO_MMC_WPROT] = {

		.reg = SYS_MCI,

		.value = SYS_MCI_WPROT,

	},

	[VEXPRESS_GPIO_FLASH_WPn] = {

		.reg = SYS_FLASH,

		.value = SYS_FLASH_WPn,

	},

	VEXPRESS_SYSREG_GPIO(MMC_CARDIN,	SYS_MCI,	CARDIN),

	VEXPRESS_SYSREG_GPIO(MMC_WPROT,		SYS_MCI,	WPROT),

	VEXPRESS_SYSREG_GPIO(FLASH_WPn,		SYS_FLASH,	WPn),

	VEXPRESS_SYSREG_GPIO(LED0,		SYS_LED,	LED(0)),

	VEXPRESS_SYSREG_GPIO(LED1,		SYS_LED,	LED(1)),

	VEXPRESS_SYSREG_GPIO(LED2,		SYS_LED,	LED(2)),

	VEXPRESS_SYSREG_GPIO(LED3,		SYS_LED,	LED(3)),

	VEXPRESS_SYSREG_GPIO(LED4,		SYS_LED,	LED(4)),

	VEXPRESS_SYSREG_GPIO(LED5,		SYS_LED,	LED(5)),

	VEXPRESS_SYSREG_GPIO(LED6,		SYS_LED,	LED(6)),

	VEXPRESS_SYSREG_GPIO(LED7,		SYS_LED,	LED(7)),

};



static int vexpress_sysreg_gpio_direction_input(struct gpio_chip *chip,
@@ -372,12 +379,6 @@ static int vexpress_sysreg_gpio_direction_input(struct gpio_chip *chip, 
	return 0;

}



static int vexpress_sysreg_gpio_direction_output(struct gpio_chip *chip,

						unsigned offset, int value)

{

	return 0;

}



static int vexpress_sysreg_gpio_get(struct gpio_chip *chip,

				       unsigned offset)

{
@@ -401,6 +402,14 @@ static void vexpress_sysreg_gpio_set(struct gpio_chip *chip, 
	writel(reg_value, vexpress_sysreg_base + gpio->reg);

}



static int vexpress_sysreg_gpio_direction_output(struct gpio_chip *chip,

						unsigned offset, int value)

{

	vexpress_sysreg_gpio_set(chip, offset, value);



	return 0;

}



static struct gpio_chip vexpress_sysreg_gpio_chip = {

	.label = "vexpress-sysreg",

	.direction_input = vexpress_sysreg_gpio_direction_input,
@@ -412,6 +421,30 @@ static struct gpio_chip vexpress_sysreg_gpio_chip = { 
};





#define VEXPRESS_SYSREG_GREEN_LED(_name, _default_trigger, _gpio) \

	{ \

		.name = "v2m:green:"_name, \

		.default_trigger = _default_trigger, \

		.gpio = VEXPRESS_GPIO_##_gpio, \

	}



struct gpio_led vexpress_sysreg_leds[] = {

	VEXPRESS_SYSREG_GREEN_LED("user1",	"heartbeat",	LED0),

	VEXPRESS_SYSREG_GREEN_LED("user2",	"mmc0",		LED1),

	VEXPRESS_SYSREG_GREEN_LED("user3",	"cpu0",		LED2),

	VEXPRESS_SYSREG_GREEN_LED("user4",	"cpu1",		LED3),

	VEXPRESS_SYSREG_GREEN_LED("user5",	"cpu2",		LED4),

	VEXPRESS_SYSREG_GREEN_LED("user6",	"cpu3",		LED5),

	VEXPRESS_SYSREG_GREEN_LED("user7",	"cpu4",		LED6),

	VEXPRESS_SYSREG_GREEN_LED("user8",	"cpu5",		LED7),

};



struct gpio_led_platform_data vexpress_sysreg_leds_pdata = {

	.num_leds = ARRAY_SIZE(vexpress_sysreg_leds),

	.leds = vexpress_sysreg_leds,

};





static ssize_t vexpress_sysreg_sys_id_show(struct device *dev,

		struct device_attribute *attr, char *buf)

{
@@ -456,6 +489,10 @@ static int vexpress_sysreg_probe(struct platform_device *pdev) 
		return err;

	}



	platform_device_register_data(vexpress_sysreg_dev, "leds-gpio",

			PLATFORM_DEVID_AUTO, &vexpress_sysreg_leds_pdata,

			sizeof(vexpress_sysreg_leds_pdata));



	vexpress_sysreg_dev = &pdev->dev;



	device_create_file(vexpress_sysreg_dev, &dev_attr_sys_id);

include/linux/vexpress.h

+8 −0
Original line number Diff line number Diff line
@@ -27,6 +27,14 @@ 
#define VEXPRESS_GPIO_MMC_CARDIN	0

#define VEXPRESS_GPIO_MMC_WPROT		1

#define VEXPRESS_GPIO_FLASH_WPn		2

#define VEXPRESS_GPIO_LED0		3

#define VEXPRESS_GPIO_LED1		4

#define VEXPRESS_GPIO_LED2		5

#define VEXPRESS_GPIO_LED3		6

#define VEXPRESS_GPIO_LED4		7

#define VEXPRESS_GPIO_LED5		8

#define VEXPRESS_GPIO_LED6		9

#define VEXPRESS_GPIO_LED7		10



#define VEXPRESS_RES_FUNC(_site, _func)	\

{					\