target/linux/lantiq/patches-2.6.39/601-mach-gigasx76x.patch

   1 --- a/arch/mips/lantiq/xway/Kconfig
   2 +++ b/arch/mips/lantiq/xway/Kconfig
   3 @@ -14,6 +14,11 @@ config LANTIQ_MACH_NETGEAR
   4         bool "Netgear"
   5         default y
   6
   7 +config LANTIQ_MACH_GIGASX76X
   8 +       bool "GIGASX76X"
   9 +       select LTQ_DEV_GPIO_BUTTONS
  10 +       default y
  11 +
  12  endmenu
  13
  14  endif
  15 --- a/arch/mips/lantiq/xway/Makefile
  16 +++ b/arch/mips/lantiq/xway/Makefile
  17 @@ -7,4 +7,5 @@ obj-$(CONFIG_LANTIQ_MACH_EASY50712) += m
  18  obj-$(CONFIG_LANTIQ_MACH_EASY50601) += mach-easy50601.o
  19  obj-$(CONFIG_LANTIQ_MACH_ARV45XX) += mach-arv45xx.o
  20  obj-$(CONFIG_LANTIQ_MACH_NETGEAR) += mach-netgear.o
  21 +obj-$(CONFIG_LANTIQ_MACH_GIGASX76X) += mach-gigasx76x.o
  22  obj-y += dev-dwc_otg.o
  23 --- /dev/null
  24 +++ b/arch/mips/lantiq/xway/mach-gigasx76x.c
  25 @@ -0,0 +1,209 @@
  26 +/*
  27 + *  This program is free software; you can redistribute it and/or modify it
  28 + *  under the terms of the GNU General Public License version 2 as published
  29 + *  by the Free Software Foundation.
  30 + *
  31 + *  Copyright (C) 2011 Andrej Vlašić
  32 + *  Copyright (C) 2011 Luka Perkov
  33 + *
  34 + */
  35 +
  36 +#include <linux/kernel.h>
  37 +#include <linux/init.h>
  38 +#include <linux/platform_device.h>
  39 +#include <linux/leds.h>
  40 +#include <linux/gpio.h>
  41 +#include <linux/mtd/mtd.h>
  42 +#include <linux/mtd/partitions.h>
  43 +#include <linux/mtd/physmap.h>
  44 +#include <linux/input.h>
  45 +#include <linux/ath5k_platform.h>
  46 +#include <linux/pci.h>
  47 +#include <linux/phy.h>
  48 +#include <linux/io.h>
  49 +#include <linux/string.h>
  50 +
  51 +#include <irq.h>
  52 +
  53 +#include <lantiq_soc.h>
  54 +#include <lantiq_platform.h>
  55 +
  56 +#include "devices.h"
  57 +#include "dev-dwc_otg.h"
  58 +#include "../machtypes.h"
  59 +#include "../dev-leds-gpio.h"
  60 +#include "../dev-gpio-buttons.h"
  61 +
  62 +#define UBOOT_ENV_OFFSET       0x010000
  63 +#define UBOOT_ENV_SIZE         0x010000
  64 +
  65 +#ifdef CONFIG_MTD_PARTITIONS
  66 +static struct mtd_partition gigasx76x_partitions[] =
  67 +{
  68 +       {
  69 +               .name   = "uboot",
  70 +               .offset = 0x000000,
  71 +               .size   = 0x010000,
  72 +       },
  73 +       {
  74 +               .name   = "uboot_env",
  75 +               .offset = UBOOT_ENV_OFFSET,
  76 +               .size   = UBOOT_ENV_SIZE,
  77 +       },
  78 +       {
  79 +               .name   = "linux",
  80 +               .offset = 0x020000,
  81 +               .size   = 0x7d0000,
  82 +       },
  83 +       {
  84 +               .name   = "board_config",
  85 +               .offset = 0x7f0000,
  86 +               .size   = 0x010000,
  87 +       },
  88 +};
  89 +#endif
  90 +
  91 +static struct gpio_led
  92 +gigasx76x_gpio_leds[] __initdata = {
  93 +       { .name = "soc:green:usb", .gpio = 50, },
  94 +       { .name = "soc:green:wlan", .gpio = 51, },
  95 +       { .name = "soc:green:phone2", .gpio = 52, },
  96 +       { .name = "soc:green:phone1", .gpio = 53, },
  97 +       { .name = "soc:green:line", .gpio = 54, },
  98 +       { .name = "soc:green:online", .gpio = 55, },
  99 +       { .name = "soc:green:voip", .gpio = 56, },
 100 +};
 101 +
 102 +static struct gpio_keys_button
 103 +gigasx76x_gpio_keys[] __initdata = {
 104 +               {
 105 +                       .desc           = "reset",
 106 +                       .type           = EV_KEY,
 107 +                       .code           = KEY_RESTART,
 108 +                       .debounce_interval = LTQ_KEYS_DEBOUNCE_INTERVAL,
 109 +                       .gpio = 14,
 110 +                       .active_low = 1,
 111 +               },
 112 +};
 113 +
 114 +static struct physmap_flash_data gigasx76x_flash_data = {
 115 +#ifdef CONFIG_MTD_PARTITIONS
 116 +       .nr_parts       = ARRAY_SIZE(gigasx76x_partitions),
 117 +       .parts          = gigasx76x_partitions,
 118 +#endif
 119 +};
 120 +
 121 +static struct ltq_pci_data ltq_pci_data = {
 122 +       .clock  = PCI_CLOCK_INT,
 123 +       .gpio   = PCI_GNT1 | PCI_REQ1,
 124 +       .irq    = { [14] = INT_NUM_IM0_IRL0 + 22, },
 125 +};
 126 +
 127 +static struct ltq_eth_data ltq_eth_data = {
 128 +  .mii_mode    = PHY_INTERFACE_MODE_MII,
 129 +};
 130 +
 131 +static char __init *get_uboot_env_var(char *haystack, int haystack_len, char *needle, int needle_len) {
 132 +       int i;
 133 +       for (i = 0; i <= haystack_len - needle_len; i++) {
 134 +               if (memcmp(haystack + i, needle, needle_len) == 0) {
 135 +                       return haystack + i + needle_len;
 136 +               }
 137 +       }
 138 +       return NULL;
 139 +}
 140 +
 141 +/*
 142 + * gigasx76x_parse_hex_* are not uniq. in arm/orion there are also duplicates:
 143 + * dns323_parse_hex_*
 144 + * TODO: one day write a patch for this :)
 145 + */
 146 +static int __init gigasx76x_parse_hex_nibble(char n) {
 147 +       if (n >= '0' && n <= '9')
 148 +               return n - '0';
 149 +
 150 +       if (n >= 'A' && n <= 'F')
 151 +               return n - 'A' + 10;
 152 +
 153 +       if (n >= 'a' && n <= 'f')
 154 +               return n - 'a' + 10;
 155 +
 156 +       return -1;
 157 +}
 158 +
 159 +static int __init gigasx76x_parse_hex_byte(const char *b) {
 160 +       int hi;
 161 +       int lo;
 162 +
 163 +       hi = gigasx76x_parse_hex_nibble(b[0]);
 164 +       lo = gigasx76x_parse_hex_nibble(b[1]);
 165 +
 166 +       if (hi < 0 || lo < 0)
 167 +               return -1;
 168 +
 169 +       return (hi << 4) | lo;
 170 +}
 171 +
 172 +static int __init gigasx76x_register_ethernet(void) {
 173 +       u_int8_t addr[6];
 174 +       int i;
 175 +       char *uboot_env_page;
 176 +       char *mac;
 177 +
 178 +       uboot_env_page = ioremap(LTQ_FLASH_START + UBOOT_ENV_OFFSET, UBOOT_ENV_SIZE);
 179 +       if (!uboot_env_page)
 180 +               return -ENOMEM;
 181 +
 182 +       mac = get_uboot_env_var(uboot_env_page, UBOOT_ENV_SIZE, "\0ethaddr=", 9);
 183 +
 184 +       if (!mac) {
 185 +       goto error_fail;
 186 +       }
 187 +
 188 +       /* Sanity check the string we're looking at */
 189 +       for (i = 0; i < 5; i++) {
 190 +       if (*(mac + (i * 3) + 2) != ':') {
 191 +               goto error_fail;
 192 +               }
 193 +       }
 194 +
 195 +       for (i = 0; i < 6; i++) {
 196 +               int byte;
 197 +               byte = gigasx76x_parse_hex_byte(mac + (i * 3));
 198 +               if (byte < 0) {
 199 +                       goto error_fail;
 200 +               }
 201 +               addr[i] = byte;
 202 +       }
 203 +
 204 +       iounmap(uboot_env_page);
 205 +       printk("GIGASX76X: Found ethernet MAC address: ");
 206 +       for (i = 0; i < 6; i++)
 207 +               printk("%.2x%s", addr[i], (i < 5) ? ":" : ".\n");
 208 +
 209 +       memcpy(&ltq_eth_data.mac.sa_data, addr, 6);
 210 +       ltq_register_etop(&ltq_eth_data);
 211 +
 212 +       return 0;
 213 +
 214 +       error_fail:
 215 +               iounmap(uboot_env_page);
 216 +               return -EINVAL;
 217 +}
 218 +
 219 +static void __init gigasx76x_init(void) {
 220 +#define GIGASX76X_USB          29
 221 +#define GIGASX76X_MADWIFI_ADDR 0xb07f0000
 222 +
 223 +       ltq_register_gpio_stp();
 224 +       ltq_register_nor(&gigasx76x_flash_data);
 225 +       ltq_register_pci(&ltq_pci_data);
 226 +       gigasx76x_register_ethernet();
 227 +       xway_register_dwc(GIGASX76X_USB);
 228 +       ltq_register_tapi();
 229 +       ltq_register_madwifi_eep(GIGASX76X_MADWIFI_ADDR);
 230 +       ltq_add_device_leds_gpio(-1, ARRAY_SIZE(gigasx76x_gpio_leds), gigasx76x_gpio_leds);
 231 +       ltq_register_gpio_keys_polled(-1, LTQ_KEYS_POLL_INTERVAL, ARRAY_SIZE(gigasx76x_gpio_keys), gigasx76x_gpio_keys);
 232 +}
 233 +
 234 +MIPS_MACHINE(LANTIQ_MACH_GIGASX76X, "GIGASX76X", "GIGASX76X - Gigaset SX761,SX762,SX763", gigasx76x_init);
 235 --- a/arch/mips/lantiq/machtypes.h
 236 +++ b/arch/mips/lantiq/machtypes.h
 237 @@ -37,6 +37,9 @@ enum lantiq_mach_type {
 238
 239         /* Netgear */
 240         LANTIQ_MACH_DGN3500B,           /* Netgear DGN3500 */
 241 +
 242 +       /* Gigaset */
 243 +       LANTIQ_MACH_GIGASX76X,          /* Gigaset SX76x */
 244  };
 245
 246  #endif