kernel/arch/xtensa/platforms/xtfpga/setup.c

   1 /*
   2  *
   3  * arch/xtensa/platform/xtavnet/setup.c
   4  *
   5  * ...
   6  *
   7  * Authors:     Chris Zankel <chris@zankel.net>
   8  *              Joe Taylor <joe@tensilica.com>
   9  *
  10  * Copyright 2001 - 2006 Tensilica Inc.
  11  *
  12  * This program is free software; you can redistribute  it and/or modify it
  13  * under  the terms of  the GNU General  Public License as published by the
  14  * Free Software Foundation;  either version 2 of the  License, or (at your
  15  * option) any later version.
  16  *
  17  */
  18 #include <linux/stddef.h>
  19 #include <linux/kernel.h>
  20 #include <linux/init.h>
  21 #include <linux/errno.h>
  22 #include <linux/reboot.h>
  23 #include <linux/kdev_t.h>
  24 #include <linux/types.h>
  25 #include <linux/major.h>
  26 #include <linux/console.h>
  27 #include <linux/delay.h>
  28 #include <linux/of.h>
  29
  30 #include <asm/timex.h>
  31 #include <asm/processor.h>
  32 #include <asm/platform.h>
  33 #include <asm/bootparam.h>
  34 #include <platform/lcd.h>
  35 #include <platform/hardware.h>
  36
  37 void platform_halt(void)
  38 {
  39         lcd_disp_at_pos(" HALT ", 0);
  40         local_irq_disable();
  41         while (1)
  42                 cpu_relax();
  43 }
  44
  45 void platform_power_off(void)
  46 {
  47         lcd_disp_at_pos("POWEROFF", 0);
  48         local_irq_disable();
  49         while (1)
  50                 cpu_relax();
  51 }
  52
  53 void platform_restart(void)
  54 {
  55         /* Flush and reset the mmu, simulate a processor reset, and
  56          * jump to the reset vector. */
  57
  58
  59         __asm__ __volatile__ ("movi     a2, 15\n\t"
  60                               "wsr      a2, icountlevel\n\t"
  61                               "movi     a2, 0\n\t"
  62                               "wsr      a2, icount\n\t"
  63 #if XCHAL_NUM_IBREAK > 0
  64                               "wsr      a2, ibreakenable\n\t"
  65 #endif
  66 #if XCHAL_HAVE_LOOPS
  67                               "wsr      a2, lcount\n\t"
  68 #endif
  69                               "movi     a2, 0x1f\n\t"
  70                               "wsr      a2, ps\n\t"
  71                               "isync\n\t"
  72                               "jx       %0\n\t"
  73                               :
  74                               : "a" (XCHAL_RESET_VECTOR_VADDR)
  75                               : "a2"
  76                               );
  77
  78         /* control never gets here */
  79 }
  80
  81 void __init platform_setup(char **cmdline)
  82 {
  83 }
  84
  85 #ifdef CONFIG_OF
  86
  87 static void __init update_clock_frequency(struct device_node *node)
  88 {
  89         struct property *newfreq;
  90         u32 freq;
  91
  92         if (!of_property_read_u32(node, "clock-frequency", &freq) && freq != 0)
  93                 return;
  94
  95         newfreq = kzalloc(sizeof(*newfreq) + sizeof(u32), GFP_KERNEL);
  96         if (!newfreq)
  97                 return;
  98         newfreq->value = newfreq + 1;
  99         newfreq->length = sizeof(freq);
 100         newfreq->name = kstrdup("clock-frequency", GFP_KERNEL);
 101         if (!newfreq->name) {
 102                 kfree(newfreq);
 103                 return;
 104         }
 105
 106         *(u32 *)newfreq->value = cpu_to_be32(*(u32 *)XTFPGA_CLKFRQ_VADDR);
 107         of_update_property(node, newfreq);
 108 }
 109
 110 #define MAC_LEN 6
 111 static void __init update_local_mac(struct device_node *node)
 112 {
 113         struct property *newmac;
 114         const u8* macaddr;
 115         int prop_len;
 116
 117         macaddr = of_get_property(node, "local-mac-address", &prop_len);
 118         if (macaddr == NULL || prop_len != MAC_LEN)
 119                 return;
 120
 121         newmac = kzalloc(sizeof(*newmac) + MAC_LEN, GFP_KERNEL);
 122         if (newmac == NULL)
 123                 return;
 124
 125         newmac->value = newmac + 1;
 126         newmac->length = MAC_LEN;
 127         newmac->name = kstrdup("local-mac-address", GFP_KERNEL);
 128         if (newmac->name == NULL) {
 129                 kfree(newmac);
 130                 return;
 131         }
 132
 133         memcpy(newmac->value, macaddr, MAC_LEN);
 134         ((u8*)newmac->value)[5] = (*(u32*)DIP_SWITCHES_VADDR) & 0x3f;
 135         of_update_property(node, newmac);
 136 }
 137
 138 static int __init machine_setup(void)
 139 {
 140         struct device_node *clock;
 141         struct device_node *eth = NULL;
 142
 143         for_each_node_by_name(clock, "main-oscillator")
 144                 update_clock_frequency(clock);
 145
 146         if ((eth = of_find_compatible_node(eth, NULL, "opencores,ethoc")))
 147                 update_local_mac(eth);
 148         return 0;
 149 }
 150 arch_initcall(machine_setup);
 151
 152 #endif
 153
 154 /* early initialization */
 155
 156 void __init platform_init(bp_tag_t *first)
 157 {
 158 }
 159
 160 /* Heartbeat. */
 161
 162 void platform_heartbeat(void)
 163 {
 164 }
 165
 166 #ifdef CONFIG_XTENSA_CALIBRATE_CCOUNT
 167
 168 void __init platform_calibrate_ccount(void)
 169 {
 170         long clk_freq = 0;
 171 #ifdef CONFIG_OF
 172         struct device_node *cpu =
 173                 of_find_compatible_node(NULL, NULL, "cdns,xtensa-cpu");
 174         if (cpu) {
 175                 u32 freq;
 176                 update_clock_frequency(cpu);
 177                 if (!of_property_read_u32(cpu, "clock-frequency", &freq))
 178                         clk_freq = freq;
 179         }
 180 #endif
 181         if (!clk_freq)
 182                 clk_freq = *(long *)XTFPGA_CLKFRQ_VADDR;
 183
 184         ccount_freq = clk_freq;
 185 }
 186
 187 #endif
 188
 189 #ifndef CONFIG_OF
 190
 191 #include <linux/serial_8250.h>
 192 #include <linux/if.h>
 193 #include <net/ethoc.h>
 194 #include <linux/usb/c67x00.h>
 195
 196 /*----------------------------------------------------------------------------
 197  *  Ethernet -- OpenCores Ethernet MAC (ethoc driver)
 198  */
 199
 200 static struct resource ethoc_res[] = {
 201         [0] = { /* register space */
 202                 .start = OETH_REGS_PADDR,
 203                 .end   = OETH_REGS_PADDR + OETH_REGS_SIZE - 1,
 204                 .flags = IORESOURCE_MEM,
 205         },
 206         [1] = { /* buffer space */
 207                 .start = OETH_SRAMBUFF_PADDR,
 208                 .end   = OETH_SRAMBUFF_PADDR + OETH_SRAMBUFF_SIZE - 1,
 209                 .flags = IORESOURCE_MEM,
 210         },
 211         [2] = { /* IRQ number */
 212                 .start = OETH_IRQ,
 213                 .end   = OETH_IRQ,
 214                 .flags = IORESOURCE_IRQ,
 215         },
 216 };
 217
 218 static struct ethoc_platform_data ethoc_pdata = {
 219         /*
 220          * The MAC address for these boards is 00:50:c2:13:6f:xx.
 221          * The last byte (here as zero) is read from the DIP switches on the
 222          * board.
 223          */
 224         .hwaddr = { 0x00, 0x50, 0xc2, 0x13, 0x6f, 0 },
 225         .phy_id = -1,
 226 };
 227
 228 static struct platform_device ethoc_device = {
 229         .name = "ethoc",
 230         .id = -1,
 231         .num_resources = ARRAY_SIZE(ethoc_res),
 232         .resource = ethoc_res,
 233         .dev = {
 234                 .platform_data = &ethoc_pdata,
 235         },
 236 };
 237
 238 /*----------------------------------------------------------------------------
 239  *  USB Host/Device -- Cypress CY7C67300
 240  */
 241
 242 static struct resource c67x00_res[] = {
 243         [0] = { /* register space */
 244                 .start = C67X00_PADDR,
 245                 .end   = C67X00_PADDR + C67X00_SIZE - 1,
 246                 .flags = IORESOURCE_MEM,
 247         },
 248         [1] = { /* IRQ number */
 249                 .start = C67X00_IRQ,
 250                 .end   = C67X00_IRQ,
 251                 .flags = IORESOURCE_IRQ,
 252         },
 253 };
 254
 255 static struct c67x00_platform_data c67x00_pdata = {
 256         .sie_config = C67X00_SIE1_HOST | C67X00_SIE2_UNUSED,
 257         .hpi_regstep = 4,
 258 };
 259
 260 static struct platform_device c67x00_device = {
 261         .name = "c67x00",
 262         .id = -1,
 263         .num_resources = ARRAY_SIZE(c67x00_res),
 264         .resource = c67x00_res,
 265         .dev = {
 266                 .platform_data = &c67x00_pdata,
 267         },
 268 };
 269
 270 /*----------------------------------------------------------------------------
 271  *  UART
 272  */
 273
 274 static struct resource serial_resource = {
 275         .start  = DUART16552_PADDR,
 276         .end    = DUART16552_PADDR + 0x1f,
 277         .flags  = IORESOURCE_MEM,
 278 };
 279
 280 static struct plat_serial8250_port serial_platform_data[] = {
 281         [0] = {
 282                 .mapbase        = DUART16552_PADDR,
 283                 .irq            = DUART16552_INTNUM,
 284                 .flags          = UPF_BOOT_AUTOCONF | UPF_SKIP_TEST |
 285                                   UPF_IOREMAP,
 286                 .iotype         = UPIO_MEM32,
 287                 .regshift       = 2,
 288                 .uartclk        = 0,    /* set in xtavnet_init() */
 289         },
 290         { },
 291 };
 292
 293 static struct platform_device xtavnet_uart = {
 294         .name           = "serial8250",
 295         .id             = PLAT8250_DEV_PLATFORM,
 296         .dev            = {
 297                 .platform_data  = serial_platform_data,
 298         },
 299         .num_resources  = 1,
 300         .resource       = &serial_resource,
 301 };
 302
 303 /* platform devices */
 304 static struct platform_device *platform_devices[] __initdata = {
 305         &ethoc_device,
 306         &c67x00_device,
 307         &xtavnet_uart,
 308 };
 309
 310
 311 static int __init xtavnet_init(void)
 312 {
 313         /* Ethernet MAC address.  */
 314         ethoc_pdata.hwaddr[5] = *(u32 *)DIP_SWITCHES_VADDR;
 315
 316         /* Clock rate varies among FPGA bitstreams; board specific FPGA register
 317          * reports the actual clock rate.
 318          */
 319         serial_platform_data[0].uartclk = *(long *)XTFPGA_CLKFRQ_VADDR;
 320
 321
 322         /* register platform devices */
 323         platform_add_devices(platform_devices, ARRAY_SIZE(platform_devices));
 324
 325         /* ETHOC driver is a bit quiet; at least display Ethernet MAC, so user
 326          * knows whether they set it correctly on the DIP switches.
 327          */
 328         pr_info("XTFPGA: Ethernet MAC %pM\n", ethoc_pdata.hwaddr);
 329         ethoc_pdata.eth_clkfreq = *(long *)XTFPGA_CLKFRQ_VADDR;
 330
 331         return 0;
 332 }
 333
 334 /*
 335  * Register to be done during do_initcalls().
 336  */
 337 arch_initcall(xtavnet_init);
 338
 339 #endif /* CONFIG_OF */