root/arch/x86/platform/geode/net5501.c

DEFINITIONS

1. register_net5501
2. net5501_present
3. net5501_init

   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);