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