git.oblomov.eu Git - linux-2.6/blob - arch/powerpc/sysdev/tsi108_dev.c

   1 /*
   2  * tsi108/109 device setup code
   3  *
   4  * Maintained by Roy Zang < tie-fei.zang@freescale.com >
   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 as published by the
   8  * Free Software Foundation;  either version 2 of the  License, or (at your
   9  * option) any later version.
  10  */
  11
  12 #include <linux/stddef.h>
  13 #include <linux/kernel.h>
  14 #include <linux/init.h>
  15 #include <linux/errno.h>
  16 #include <linux/major.h>
  17 #include <linux/delay.h>
  18 #include <linux/irq.h>
  19 #include <linux/module.h>
  20 #include <linux/device.h>
  21 #include <linux/platform_device.h>
  22 #include <asm/tsi108.h>
  23
  24 #include <asm/system.h>
  25 #include <asm/atomic.h>
  26 #include <asm/io.h>
  27 #include <asm/irq.h>
  28 #include <asm/prom.h>
  29 #include <mm/mmu_decl.h>
  30
  31 #undef DEBUG
  32
  33 #ifdef DEBUG
  34 #define DBG(fmt...) do { printk(fmt); } while(0)
  35 #else
  36 #define DBG(fmt...) do { } while(0)
  37 #endif
  38
  39 static phys_addr_t tsi108_csr_base = -1;
  40
  41 phys_addr_t get_csrbase(void)
  42 {
  43         struct device_node *tsi;
  44
  45         if (tsi108_csr_base != -1)
  46                 return tsi108_csr_base;
  47
  48         tsi = of_find_node_by_type(NULL, "tsi-bridge");
  49         if (tsi) {
  50                 unsigned int size;
  51                 const void *prop = of_get_property(tsi, "reg", &size);
  52                 tsi108_csr_base = of_translate_address(tsi, prop);
  53                 of_node_put(tsi);
  54         };
  55         return tsi108_csr_base;
  56 }
  57
  58 u32 get_vir_csrbase(void)
  59 {
  60         return (u32) (ioremap(get_csrbase(), 0x10000));
  61 }
  62
  63 EXPORT_SYMBOL(get_csrbase);
  64 EXPORT_SYMBOL(get_vir_csrbase);
  65
  66 static int __init tsi108_eth_of_init(void)
  67 {
  68         struct device_node *np;
  69         unsigned int i;
  70         struct platform_device *tsi_eth_dev;
  71         struct resource res;
  72         int ret;
  73
  74         for (np = NULL, i = 0;
  75              (np = of_find_compatible_node(np, "network", "tsi-ethernet")) != NULL;
  76              i++) {
  77                 struct resource r[2];
  78                 struct device_node *phy;
  79                 hw_info tsi_eth_data;
  80                 const unsigned int *id;
  81                 const unsigned int *phy_id;
  82                 const void *mac_addr;
  83                 const phandle *ph;
  84
  85                 memset(r, 0, sizeof(r));
  86                 memset(&tsi_eth_data, 0, sizeof(tsi_eth_data));
  87
  88                 ret = of_address_to_resource(np, 0, &r[0]);
  89                 DBG("%s: name:start->end = %s:0x%lx-> 0x%lx\n",
  90                         __FUNCTION__,r[0].name, r[0].start, r[0].end);
  91                 if (ret)
  92                         goto err;
  93
  94                 r[1].name = "tx";
  95                 r[1].start = irq_of_parse_and_map(np, 0);
  96                 r[1].end = irq_of_parse_and_map(np, 0);
  97                 r[1].flags = IORESOURCE_IRQ;
  98                 DBG("%s: name:start->end = %s:0x%lx-> 0x%lx\n",
  99                         __FUNCTION__,r[1].name, r[1].start, r[1].end);
 100
 101                 tsi_eth_dev =
 102                     platform_device_register_simple("tsi-ethernet", i, &r[0],
 103                                                     1);
 104
 105                 if (IS_ERR(tsi_eth_dev)) {
 106                         ret = PTR_ERR(tsi_eth_dev);
 107                         goto err;
 108                 }
 109
 110                 mac_addr = of_get_property(np, "address", NULL);
 111                 memcpy(tsi_eth_data.mac_addr, mac_addr, 6);
 112
 113                 ph = of_get_property(np, "phy-handle", NULL);
 114                 phy = of_find_node_by_phandle(*ph);
 115
 116                 if (phy == NULL) {
 117                         ret = -ENODEV;
 118                         goto unreg;
 119                 }
 120
 121                 id = of_get_property(phy, "reg", NULL);
 122                 phy_id = of_get_property(phy, "phy-id", NULL);
 123                 ret = of_address_to_resource(phy, 0, &res);
 124                 if (ret) {
 125                         of_node_put(phy);
 126                         goto unreg;
 127                 }
 128                 tsi_eth_data.regs = r[0].start;
 129                 tsi_eth_data.phyregs = res.start;
 130                 tsi_eth_data.phy = *phy_id;
 131                 tsi_eth_data.irq_num = irq_of_parse_and_map(np, 0);
 132                 of_node_put(phy);
 133                 ret =
 134                     platform_device_add_data(tsi_eth_dev, &tsi_eth_data,
 135                                              sizeof(hw_info));
 136                 if (ret)
 137                         goto unreg;
 138         }
 139         return 0;
 140 unreg:
 141         platform_device_unregister(tsi_eth_dev);
 142 err:
 143         return ret;
 144 }
 145
 146 arch_initcall(tsi108_eth_of_init);