target/linux/adm5120/files-3.8/arch/mips/adm5120/common/platform.c

   1 /*
   2  *  ADM5120 generic platform devices
   3  *
   4  *  Copyright (C) 2007-2008 Gabor Juhos <juhosg@openwrt.org>
   5  *
   6  *  This program is free software; you can redistribute it and/or modify it
   7  *  under the terms of the GNU General Public License version 2 as published
   8  *  by the Free Software Foundation.
   9  *
  10  */
  11
  12 #include <linux/init.h>
  13 #include <linux/kernel.h>
  14 #include <linux/list.h>
  15 #include <linux/device.h>
  16 #include <linux/dma-mapping.h>
  17 #include <linux/platform_device.h>
  18 #include <linux/gpio.h>
  19 #include <linux/irq.h>
  20 #include <linux/slab.h>
  21 #include <linux/export.h>
  22
  23 #include <asm/bootinfo.h>
  24
  25 #include <asm/mach-adm5120/adm5120_defs.h>
  26 #include <asm/mach-adm5120/adm5120_info.h>
  27 #include <asm/mach-adm5120/adm5120_switch.h>
  28 #include <asm/mach-adm5120/adm5120_nand.h>
  29 #include <asm/mach-adm5120/adm5120_platform.h>
  30
  31 #if 1
  32 /*
  33  * TODO:remove global adm5120_eth* variables when the switch driver will be
  34  *      converted into a real platform driver
  35  */
  36 unsigned int adm5120_eth_num_ports = 6;
  37 EXPORT_SYMBOL_GPL(adm5120_eth_num_ports);
  38
  39 unsigned char adm5120_eth_macs[6][6] = {
  40         {'\00', 'A', 'D', 'M', '\x51', '\x20' },
  41         {'\00', 'A', 'D', 'M', '\x51', '\x21' },
  42         {'\00', 'A', 'D', 'M', '\x51', '\x22' },
  43         {'\00', 'A', 'D', 'M', '\x51', '\x23' },
  44         {'\00', 'A', 'D', 'M', '\x51', '\x24' },
  45         {'\00', 'A', 'D', 'M', '\x51', '\x25' }
  46 };
  47 EXPORT_SYMBOL_GPL(adm5120_eth_macs);
  48
  49 unsigned char adm5120_eth_vlans[6] = {
  50         0x41, 0x42, 0x44, 0x48, 0x50, 0x60
  51 };
  52 EXPORT_SYMBOL_GPL(adm5120_eth_vlans);
  53 #endif
  54
  55 void __init adm5120_setup_eth_macs(u8 *mac_base)
  56 {
  57         u32 t;
  58         int i, j;
  59
  60         t = ((u32) mac_base[3] << 16) | ((u32) mac_base[4] << 8)
  61                 | ((u32) mac_base[5]);
  62
  63         for (i = 0; i < ARRAY_SIZE(adm5120_eth_macs); i++) {
  64                 for (j = 0; j < 3; j++)
  65                         adm5120_eth_macs[i][j] = mac_base[j];
  66
  67                 adm5120_eth_macs[i][3] = (t >> 16) & 0xff;
  68                 adm5120_eth_macs[i][4] = (t >> 8) & 0xff;
  69                 adm5120_eth_macs[i][5] = t & 0xff;
  70
  71                 t++;
  72         }
  73 }
  74
  75 /*
  76  * Built-in ethernet switch
  77  */
  78 struct resource adm5120_switch_resources[] = {
  79         [0] = {
  80                 .start  = ADM5120_SWITCH_BASE,
  81                 .end    = ADM5120_SWITCH_BASE+ADM5120_SWITCH_SIZE-1,
  82                 .flags  = IORESOURCE_MEM,
  83         },
  84         [1] = {
  85                 .start  = ADM5120_IRQ_SWITCH,
  86                 .end    = ADM5120_IRQ_SWITCH,
  87                 .flags  = IORESOURCE_IRQ,
  88         },
  89 };
  90
  91 struct adm5120_switch_platform_data adm5120_switch_data;
  92 struct platform_device adm5120_switch_device = {
  93         .name           = "adm5120-switch",
  94         .id             = -1,
  95         .num_resources  = ARRAY_SIZE(adm5120_switch_resources),
  96         .resource       = adm5120_switch_resources,
  97         .dev.platform_data = &adm5120_switch_data,
  98 };
  99
 100 void __init adm5120_add_device_switch(unsigned num_ports, u8 *vlan_map)
 101 {
 102         if (num_ports > 0)
 103                 adm5120_eth_num_ports = num_ports;
 104
 105         if (vlan_map)
 106                 memcpy(adm5120_eth_vlans, vlan_map, sizeof(adm5120_eth_vlans));
 107
 108         platform_device_register(&adm5120_switch_device);
 109 }
 110
 111 /*
 112  * USB Host Controller
 113  */
 114 struct resource adm5120_hcd_resources[] = {
 115         [0] = {
 116                 .start  = ADM5120_USBC_BASE,
 117                 .end    = ADM5120_USBC_BASE+ADM5120_USBC_SIZE-1,
 118                 .flags  = IORESOURCE_MEM,
 119         },
 120         [1] = {
 121                 .start  = ADM5120_IRQ_USBC,
 122                 .end    = ADM5120_IRQ_USBC,
 123                 .flags  = IORESOURCE_IRQ,
 124         },
 125 };
 126
 127 static u64 adm5120_hcd_dma_mask = DMA_BIT_MASK(24);
 128 struct platform_device adm5120_hcd_device = {
 129         .name           = "adm5120-hcd",
 130         .id             = -1,
 131         .num_resources  = ARRAY_SIZE(adm5120_hcd_resources),
 132         .resource       = adm5120_hcd_resources,
 133         .dev = {
 134                 .dma_mask               = &adm5120_hcd_dma_mask,
 135                 .coherent_dma_mask      = DMA_BIT_MASK(24),
 136         }
 137 };
 138
 139 void __init adm5120_add_device_usb(void)
 140 {
 141         platform_device_register(&adm5120_hcd_device);
 142 }
 143
 144 /*
 145  * NOR flash devices
 146  */
 147 struct adm5120_flash_platform_data adm5120_flash0_data;
 148 struct platform_device adm5120_flash0_device =  {
 149         .name                   = "adm5120-flash",
 150         .id                     = 0,
 151         .dev.platform_data      = &adm5120_flash0_data,
 152 };
 153
 154 struct adm5120_flash_platform_data adm5120_flash1_data;
 155 struct platform_device adm5120_flash1_device =  {
 156         .name                   = "adm5120-flash",
 157         .id                     = 1,
 158         .dev.platform_data      = &adm5120_flash1_data,
 159 };
 160
 161 void __init adm5120_add_device_flash(unsigned id)
 162 {
 163         struct platform_device *pdev;
 164
 165         switch (id) {
 166         case 0:
 167                 pdev = &adm5120_flash0_device;
 168                 break;
 169         case 1:
 170                 pdev = &adm5120_flash1_device;
 171                 break;
 172         default:
 173                 pdev = NULL;
 174                 break;
 175         }
 176
 177         if (pdev)
 178                 platform_device_register(pdev);
 179 }
 180
 181 /*
 182  * built-in UARTs
 183  */
 184 static void adm5120_uart_set_mctrl(struct amba_device *dev, void __iomem *base,
 185                 unsigned int mctrl)
 186 {
 187 }
 188
 189 struct amba_pl010_data adm5120_uart0_data = {
 190         .set_mctrl = adm5120_uart_set_mctrl
 191 };
 192
 193 struct amba_device adm5120_uart0_device = {
 194         .dev            = {
 195                 .init_name = "apb:uart0",
 196                 .platform_data = &adm5120_uart0_data,
 197         },
 198         .res            = {
 199                 .start  = ADM5120_UART0_BASE,
 200                 .end    = ADM5120_UART0_BASE + ADM5120_UART_SIZE - 1,
 201                 .flags  = IORESOURCE_MEM,
 202         },
 203         .irq            = { ADM5120_IRQ_UART0, 0 },
 204         .periphid       = 0x0041010,
 205 };
 206
 207 struct amba_pl010_data adm5120_uart1_data = {
 208         .set_mctrl = adm5120_uart_set_mctrl
 209 };
 210
 211 struct amba_device adm5120_uart1_device = {
 212         .dev            = {
 213                 .init_name = "apb:uart1",
 214                 .platform_data = &adm5120_uart1_data,
 215         },
 216         .res            = {
 217                 .start  = ADM5120_UART1_BASE,
 218                 .end    = ADM5120_UART1_BASE + ADM5120_UART_SIZE - 1,
 219                 .flags  = IORESOURCE_MEM,
 220         },
 221         .irq            = { ADM5120_IRQ_UART1, 0 },
 222         .periphid       = 0x0041010,
 223 };
 224
 225 void __init adm5120_add_device_uart(unsigned id)
 226 {
 227         struct amba_device *dev;
 228
 229         switch (id) {
 230         case 0:
 231                 dev = &adm5120_uart0_device;
 232                 break;
 233         case 1:
 234                 dev = &adm5120_uart1_device;
 235                 break;
 236         default:
 237                 dev = NULL;
 238                 break;
 239         }
 240
 241         if (dev)
 242                 amba_device_register(dev, &iomem_resource);
 243 }
 244
 245 /*
 246  * GPIO buttons
 247  */
 248 void __init adm5120_register_gpio_buttons(int id,
 249                                           unsigned poll_interval,
 250                                           unsigned nbuttons,
 251                                           struct gpio_keys_button *buttons)
 252 {
 253         struct platform_device *pdev;
 254         struct gpio_keys_platform_data pdata;
 255         struct gpio_keys_button *p;
 256         int err;
 257
 258         p = kmemdup(buttons, nbuttons * sizeof(*p), GFP_KERNEL);
 259         if (!p)
 260                 return;
 261
 262         pdev = platform_device_alloc("gpio-keys-polled", id);
 263         if (!pdev)
 264                 goto err_free_buttons;
 265
 266         memset(&pdata, 0, sizeof(pdata));
 267         pdata.poll_interval = poll_interval;
 268         pdata.nbuttons = nbuttons;
 269         pdata.buttons = p;
 270
 271         err = platform_device_add_data(pdev, &pdata, sizeof(pdata));
 272         if (err)
 273                 goto err_put_pdev;
 274
 275         err = platform_device_add(pdev);
 276         if (err)
 277                 goto err_put_pdev;
 278
 279         return;
 280
 281 err_put_pdev:
 282         platform_device_put(pdev);
 283
 284 err_free_buttons:
 285         kfree(p);
 286 }
 287
 288 /*
 289  * GPIO LEDS
 290  */
 291 struct gpio_led_platform_data adm5120_gpio_leds_data;
 292 struct platform_device adm5120_gpio_leds_device = {
 293         .name           = "leds-gpio",
 294         .id             = -1,
 295         .dev.platform_data = &adm5120_gpio_leds_data,
 296 };
 297
 298 void __init adm5120_add_device_gpio_leds(unsigned num_leds,
 299                                     struct gpio_led *leds)
 300 {
 301         struct gpio_led *p;
 302
 303         p = kmalloc(num_leds * sizeof(*p), GFP_KERNEL);
 304         if (!p)
 305                 return;
 306
 307         memcpy(p, leds, num_leds * sizeof(*p));
 308         adm5120_gpio_leds_data.num_leds = num_leds;
 309         adm5120_gpio_leds_data.leds = p;
 310
 311         platform_device_register(&adm5120_gpio_leds_device);
 312 }
 313
 314 /*
 315  * NAND flash
 316  */
 317 struct resource adm5120_nand_resources[] = {
 318         [0] = {
 319                 .start  = ADM5120_NAND_BASE,
 320                 .end    = ADM5120_NAND_BASE + ADM5120_NAND_SIZE-1,
 321                 .flags  = IORESOURCE_MEM,
 322         },
 323 };
 324
 325 static int adm5120_nand_ready(struct mtd_info *mtd)
 326 {
 327         return ((adm5120_nand_get_status() & ADM5120_NAND_STATUS_READY) != 0);
 328 }
 329
 330 static void adm5120_nand_cmd_ctrl(struct mtd_info *mtd, int cmd,
 331                                         unsigned int ctrl)
 332 {
 333         if (ctrl & NAND_CTRL_CHANGE) {
 334                 adm5120_nand_set_cle(ctrl & NAND_CLE);
 335                 adm5120_nand_set_ale(ctrl & NAND_ALE);
 336                 adm5120_nand_set_cen(ctrl & NAND_NCE);
 337         }
 338
 339         if (cmd != NAND_CMD_NONE)
 340                 NAND_WRITE_REG(NAND_REG_DATA, cmd);
 341 }
 342
 343 void __init adm5120_add_device_nand(struct platform_nand_data *pdata)
 344 {
 345         struct platform_device *pdev;
 346         int err;
 347
 348         pdev = platform_device_alloc("gen_nand", -1);
 349         if (!pdev)
 350                 goto err_out;
 351
 352         err = platform_device_add_resources(pdev, adm5120_nand_resources,
 353                                         ARRAY_SIZE(adm5120_nand_resources));
 354         if (err)
 355                 goto err_put;
 356
 357         err = platform_device_add_data(pdev, pdata, sizeof(*pdata));
 358         if (err)
 359                 goto err_put;
 360
 361         pdata = pdev->dev.platform_data;
 362         pdata->ctrl.dev_ready = adm5120_nand_ready;
 363         pdata->ctrl.cmd_ctrl = adm5120_nand_cmd_ctrl;
 364
 365         err = platform_device_add(pdev);
 366         if (err)
 367                 goto err_put;
 368
 369         return;
 370
 371 err_put:
 372         platform_device_put(pdev);
 373 err_out:
 374         return;
 375 }