1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * linux/arch/arm/mach-footbridge/ebsa285.c
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * EBSA285 machine fixup
6*4882a593Smuzhiyun */
7*4882a593Smuzhiyun #include <linux/init.h>
8*4882a593Smuzhiyun #include <linux/io.h>
9*4882a593Smuzhiyun #include <linux/spinlock.h>
10*4882a593Smuzhiyun #include <linux/slab.h>
11*4882a593Smuzhiyun #include <linux/leds.h>
12*4882a593Smuzhiyun
13*4882a593Smuzhiyun #include <asm/hardware/dec21285.h>
14*4882a593Smuzhiyun #include <asm/mach-types.h>
15*4882a593Smuzhiyun
16*4882a593Smuzhiyun #include <asm/mach/arch.h>
17*4882a593Smuzhiyun
18*4882a593Smuzhiyun #include "common.h"
19*4882a593Smuzhiyun
20*4882a593Smuzhiyun /* LEDs */
21*4882a593Smuzhiyun #if defined(CONFIG_NEW_LEDS) && defined(CONFIG_LEDS_CLASS)
22*4882a593Smuzhiyun #define XBUS_AMBER_L BIT(0)
23*4882a593Smuzhiyun #define XBUS_GREEN_L BIT(1)
24*4882a593Smuzhiyun #define XBUS_RED_L BIT(2)
25*4882a593Smuzhiyun #define XBUS_TOGGLE BIT(7)
26*4882a593Smuzhiyun
27*4882a593Smuzhiyun struct ebsa285_led {
28*4882a593Smuzhiyun struct led_classdev cdev;
29*4882a593Smuzhiyun u8 mask;
30*4882a593Smuzhiyun };
31*4882a593Smuzhiyun
32*4882a593Smuzhiyun /*
33*4882a593Smuzhiyun * The triggers lines up below will only be used if the
34*4882a593Smuzhiyun * LED triggers are compiled in.
35*4882a593Smuzhiyun */
36*4882a593Smuzhiyun static const struct {
37*4882a593Smuzhiyun const char *name;
38*4882a593Smuzhiyun const char *trigger;
39*4882a593Smuzhiyun } ebsa285_leds[] = {
40*4882a593Smuzhiyun { "ebsa285:amber", "cpu0", },
41*4882a593Smuzhiyun { "ebsa285:green", "heartbeat", },
42*4882a593Smuzhiyun { "ebsa285:red",},
43*4882a593Smuzhiyun };
44*4882a593Smuzhiyun
45*4882a593Smuzhiyun static unsigned char hw_led_state;
46*4882a593Smuzhiyun static void __iomem *xbus;
47*4882a593Smuzhiyun
ebsa285_led_set(struct led_classdev * cdev,enum led_brightness b)48*4882a593Smuzhiyun static void ebsa285_led_set(struct led_classdev *cdev,
49*4882a593Smuzhiyun enum led_brightness b)
50*4882a593Smuzhiyun {
51*4882a593Smuzhiyun struct ebsa285_led *led = container_of(cdev,
52*4882a593Smuzhiyun struct ebsa285_led, cdev);
53*4882a593Smuzhiyun
54*4882a593Smuzhiyun if (b == LED_OFF)
55*4882a593Smuzhiyun hw_led_state |= led->mask;
56*4882a593Smuzhiyun else
57*4882a593Smuzhiyun hw_led_state &= ~led->mask;
58*4882a593Smuzhiyun writeb(hw_led_state, xbus);
59*4882a593Smuzhiyun }
60*4882a593Smuzhiyun
ebsa285_led_get(struct led_classdev * cdev)61*4882a593Smuzhiyun static enum led_brightness ebsa285_led_get(struct led_classdev *cdev)
62*4882a593Smuzhiyun {
63*4882a593Smuzhiyun struct ebsa285_led *led = container_of(cdev,
64*4882a593Smuzhiyun struct ebsa285_led, cdev);
65*4882a593Smuzhiyun
66*4882a593Smuzhiyun return hw_led_state & led->mask ? LED_OFF : LED_FULL;
67*4882a593Smuzhiyun }
68*4882a593Smuzhiyun
ebsa285_leds_init(void)69*4882a593Smuzhiyun static int __init ebsa285_leds_init(void)
70*4882a593Smuzhiyun {
71*4882a593Smuzhiyun int i;
72*4882a593Smuzhiyun
73*4882a593Smuzhiyun if (!machine_is_ebsa285())
74*4882a593Smuzhiyun return -ENODEV;
75*4882a593Smuzhiyun
76*4882a593Smuzhiyun xbus = ioremap(XBUS_CS2, SZ_4K);
77*4882a593Smuzhiyun if (!xbus)
78*4882a593Smuzhiyun return -ENOMEM;
79*4882a593Smuzhiyun
80*4882a593Smuzhiyun /* 3 LEDS all off */
81*4882a593Smuzhiyun hw_led_state = XBUS_AMBER_L | XBUS_GREEN_L | XBUS_RED_L;
82*4882a593Smuzhiyun writeb(hw_led_state, xbus);
83*4882a593Smuzhiyun
84*4882a593Smuzhiyun for (i = 0; i < ARRAY_SIZE(ebsa285_leds); i++) {
85*4882a593Smuzhiyun struct ebsa285_led *led;
86*4882a593Smuzhiyun
87*4882a593Smuzhiyun led = kzalloc(sizeof(*led), GFP_KERNEL);
88*4882a593Smuzhiyun if (!led)
89*4882a593Smuzhiyun break;
90*4882a593Smuzhiyun
91*4882a593Smuzhiyun led->cdev.name = ebsa285_leds[i].name;
92*4882a593Smuzhiyun led->cdev.brightness_set = ebsa285_led_set;
93*4882a593Smuzhiyun led->cdev.brightness_get = ebsa285_led_get;
94*4882a593Smuzhiyun led->cdev.default_trigger = ebsa285_leds[i].trigger;
95*4882a593Smuzhiyun led->mask = BIT(i);
96*4882a593Smuzhiyun
97*4882a593Smuzhiyun if (led_classdev_register(NULL, &led->cdev) < 0) {
98*4882a593Smuzhiyun kfree(led);
99*4882a593Smuzhiyun break;
100*4882a593Smuzhiyun }
101*4882a593Smuzhiyun }
102*4882a593Smuzhiyun
103*4882a593Smuzhiyun return 0;
104*4882a593Smuzhiyun }
105*4882a593Smuzhiyun
106*4882a593Smuzhiyun /*
107*4882a593Smuzhiyun * Since we may have triggers on any subsystem, defer registration
108*4882a593Smuzhiyun * until after subsystem_init.
109*4882a593Smuzhiyun */
110*4882a593Smuzhiyun fs_initcall(ebsa285_leds_init);
111*4882a593Smuzhiyun #endif
112*4882a593Smuzhiyun
113*4882a593Smuzhiyun MACHINE_START(EBSA285, "EBSA285")
114*4882a593Smuzhiyun /* Maintainer: Russell King */
115*4882a593Smuzhiyun .atag_offset = 0x100,
116*4882a593Smuzhiyun .video_start = 0x000a0000,
117*4882a593Smuzhiyun .video_end = 0x000bffff,
118*4882a593Smuzhiyun .map_io = footbridge_map_io,
119*4882a593Smuzhiyun .init_early = footbridge_sched_clock,
120*4882a593Smuzhiyun .init_irq = footbridge_init_irq,
121*4882a593Smuzhiyun .init_time = footbridge_timer_init,
122*4882a593Smuzhiyun .restart = footbridge_restart,
123*4882a593Smuzhiyun MACHINE_END
124*4882a593Smuzhiyun
125