1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * System Specific setup for Soekris net5501 4 * At the moment this means setup of GPIO control of LEDs and buttons 5 * on net5501 boards. 6 * 7 * Copyright (C) 2008-2009 Tower Technologies 8 * Written by Alessandro Zummo <a.zummo@towertech.it> 9 * 10 * Copyright (C) 2008 Constantin Baranov <const@mimas.ru> 11 * Copyright (C) 2011 Ed Wildgoose <kernel@wildgooses.com> 12 * and Philip Prindeville <philipp@redfish-solutions.com> 13 */ 14 15 #include <linux/kernel.h> 16 #include <linux/init.h> 17 #include <linux/io.h> 18 #include <linux/string.h> 19 #include <linux/leds.h> 20 #include <linux/platform_device.h> 21 #include <linux/input.h> 22 #include <linux/gpio_keys.h> 23 24 #include <asm/geode.h> 25 26 #define BIOS_REGION_BASE 0xffff0000 27 #define BIOS_REGION_SIZE 0x00010000 28 29 static struct gpio_keys_button net5501_gpio_buttons[] = { 30 { 31 .code = KEY_RESTART, 32 .gpio = 24, 33 .active_low = 1, 34 .desc = "Reset button", 35 .type = EV_KEY, 36 .wakeup = 0, 37 .debounce_interval = 100, 38 .can_disable = 0, 39 } 40 }; 41 static struct gpio_keys_platform_data net5501_buttons_data = { 42 .buttons = net5501_gpio_buttons, 43 .nbuttons = ARRAY_SIZE(net5501_gpio_buttons), 44 .poll_interval = 20, 45 }; 46 47 static struct platform_device net5501_buttons_dev = { 48 .name = "gpio-keys-polled", 49 .id = 1, 50 .dev = { 51 .platform_data = &net5501_buttons_data, 52 } 53 }; 54 55 static struct gpio_led net5501_leds[] = { 56 { 57 .name = "net5501:1", 58 .gpio = 6, 59 .default_trigger = "default-on", 60 .active_low = 0, 61 }, 62 }; 63 64 static struct gpio_led_platform_data net5501_leds_data = { 65 .num_leds = ARRAY_SIZE(net5501_leds), 66 .leds = net5501_leds, 67 }; 68 69 static struct platform_device net5501_leds_dev = { 70 .name = "leds-gpio", 71 .id = -1, 72 .dev.platform_data = &net5501_leds_data, 73 }; 74 75 static struct platform_device *net5501_devs[] __initdata = { 76 &net5501_buttons_dev, 77 &net5501_leds_dev, 78 }; 79 80 static void __init register_net5501(void) 81 { 82 /* Setup LED control through leds-gpio driver */ 83 platform_add_devices(net5501_devs, ARRAY_SIZE(net5501_devs)); 84 } 85 86 struct net5501_board { 87 u16 offset; 88 u16 len; 89 char *sig; 90 }; 91 92 static struct net5501_board __initdata boards[] = { 93 { 0xb7b, 7, "net5501" }, /* net5501 v1.33/1.33c */ 94 { 0xb1f, 7, "net5501" }, /* net5501 v1.32i */ 95 }; 96 97 static bool __init net5501_present(void) 98 { 99 int i; 100 unsigned char *rombase, *bios; 101 bool found = false; 102 103 rombase = ioremap(BIOS_REGION_BASE, BIOS_REGION_SIZE - 1); 104 if (!rombase) { 105 printk(KERN_ERR "%s: failed to get rombase\n", KBUILD_MODNAME); 106 return found; 107 } 108 109 bios = rombase + 0x20; /* null terminated */ 110 111 if (memcmp(bios, "comBIOS", 7)) 112 goto unmap; 113 114 for (i = 0; i < ARRAY_SIZE(boards); i++) { 115 unsigned char *model = rombase + boards[i].offset; 116 117 if (!memcmp(model, boards[i].sig, boards[i].len)) { 118 printk(KERN_INFO "%s: system is recognized as \"%s\"\n", 119 KBUILD_MODNAME, model); 120 121 found = true; 122 break; 123 } 124 } 125 126 unmap: 127 iounmap(rombase); 128 return found; 129 } 130 131 static int __init net5501_init(void) 132 { 133 if (!is_geode()) 134 return 0; 135 136 if (!net5501_present()) 137 return 0; 138 139 register_net5501(); 140 141 return 0; 142 } 143 device_initcall(net5501_init); 144