arch/sparc/kernel/central.c

   1 /* central.c: Central FHC driver for Sunfire/Starfire/Wildfire.
   2  *
   3  * Copyright (C) 1997, 1999, 2008 David S. Miller ([email protected])
   4  */
   5
   6 #include <linux/kernel.h>
   7 #include <linux/types.h>
   8 #include <linux/slab.h>
   9 #include <linux/string.h>
  10 #include <linux/init.h>
  11 #include <linux/of_device.h>
  12 #include <linux/platform_device.h>
  13
  14 #include <asm/fhc.h>
  15 #include <asm/upa.h>
  16
  17 struct clock_board {
  18         void __iomem            *clock_freq_regs;
  19         void __iomem            *clock_regs;
  20         void __iomem            *clock_ver_reg;
  21         int                     num_slots;
  22         struct resource         leds_resource;
  23         struct platform_device  leds_pdev;
  24 };
  25
  26 struct fhc {
  27         void __iomem            *pregs;
  28         bool                    central;
  29         bool                    jtag_master;
  30         int                     board_num;
  31         struct resource         leds_resource;
  32         struct platform_device  leds_pdev;
  33 };
  34
  35 static int __devinit clock_board_calc_nslots(struct clock_board *p)
  36 {
  37         u8 reg = upa_readb(p->clock_regs + CLOCK_STAT1) & 0xc0;
  38
  39         switch (reg) {
  40         case 0x40:
  41                 return 16;
  42
  43         case 0xc0:
  44                 return 8;
  45
  46         case 0x80:
  47                 reg = 0;
  48                 if (p->clock_ver_reg)
  49                         reg = upa_readb(p->clock_ver_reg);
  50                 if (reg) {
  51                         if (reg & 0x80)
  52                                 return 4;
  53                         else
  54                                 return 5;
  55                 }
  56                 /* Fallthrough */
  57         default:
  58                 return 4;
  59         }
  60 }
  61
  62 static int __devinit clock_board_probe(struct platform_device *op)
  63 {
  64         struct clock_board *p = kzalloc(sizeof(*p), GFP_KERNEL);
  65         int err = -ENOMEM;
  66
  67         if (!p) {
  68                 printk(KERN_ERR "clock_board: Cannot allocate struct clock_board\n");
  69                 goto out;
  70         }
  71
  72         p->clock_freq_regs = of_ioremap(&op->resource[0], 0,
  73                                         resource_size(&op->resource[0]),
  74                                         "clock_board_freq");
  75         if (!p->clock_freq_regs) {
  76                 printk(KERN_ERR "clock_board: Cannot map clock_freq_regs\n");
  77                 goto out_free;
  78         }
  79
  80         p->clock_regs = of_ioremap(&op->resource[1], 0,
  81                                    resource_size(&op->resource[1]),
  82                                    "clock_board_regs");
  83         if (!p->clock_regs) {
  84                 printk(KERN_ERR "clock_board: Cannot map clock_regs\n");
  85                 goto out_unmap_clock_freq_regs;
  86         }
  87
  88         if (op->resource[2].flags) {
  89                 p->clock_ver_reg = of_ioremap(&op->resource[2], 0,
  90                                               resource_size(&op->resource[2]),
  91                                               "clock_ver_reg");
  92                 if (!p->clock_ver_reg) {
  93                         printk(KERN_ERR "clock_board: Cannot map clock_ver_reg\n");
  94                         goto out_unmap_clock_regs;
  95                 }
  96         }
  97
  98         p->num_slots = clock_board_calc_nslots(p);
  99
 100         p->leds_resource.start = (unsigned long)
 101                 (p->clock_regs + CLOCK_CTRL);
 102         p->leds_resource.end = p->leds_resource.start;
 103         p->leds_resource.name = "leds";
 104
 105         p->leds_pdev.name = "sunfire-clockboard-leds";
 106         p->leds_pdev.id = -1;
 107         p->leds_pdev.resource = &p->leds_resource;
 108         p->leds_pdev.num_resources = 1;
 109         p->leds_pdev.dev.parent = &op->dev;
 110
 111         err = platform_device_register(&p->leds_pdev);
 112         if (err) {
 113                 printk(KERN_ERR "clock_board: Could not register LEDS "
 114                        "platform device\n");
 115                 goto out_unmap_clock_ver_reg;
 116         }
 117
 118         printk(KERN_INFO "clock_board: Detected %d slot Enterprise system.\n",
 119                p->num_slots);
 120
 121         err = 0;
 122 out:
 123         return err;
 124
 125 out_unmap_clock_ver_reg:
 126         if (p->clock_ver_reg)
 127                 of_iounmap(&op->resource[2], p->clock_ver_reg,
 128                            resource_size(&op->resource[2]));
 129
 130 out_unmap_clock_regs:
 131         of_iounmap(&op->resource[1], p->clock_regs,
 132                    resource_size(&op->resource[1]));
 133
 134 out_unmap_clock_freq_regs:
 135         of_iounmap(&op->resource[0], p->clock_freq_regs,
 136                    resource_size(&op->resource[0]));
 137
 138 out_free:
 139         kfree(p);
 140         goto out;
 141 }
 142
 143 static const struct of_device_id clock_board_match[] = {
 144         {
 145                 .name = "clock-board",
 146         },
 147         {},
 148 };
 149
 150 static struct platform_driver clock_board_driver = {
 151         .probe          = clock_board_probe,
 152         .driver = {
 153                 .name = "clock_board",
 154                 .owner = THIS_MODULE,
 155                 .of_match_table = clock_board_match,
 156         },
 157 };
 158
 159 static int __devinit fhc_probe(struct platform_device *op)
 160 {
 161         struct fhc *p = kzalloc(sizeof(*p), GFP_KERNEL);
 162         int err = -ENOMEM;
 163         u32 reg;
 164
 165         if (!p) {
 166                 printk(KERN_ERR "fhc: Cannot allocate struct fhc\n");
 167                 goto out;
 168         }
 169
 170         if (!strcmp(op->dev.of_node->parent->name, "central"))
 171                 p->central = true;
 172
 173         p->pregs = of_ioremap(&op->resource[0], 0,
 174                               resource_size(&op->resource[0]),
 175                               "fhc_pregs");
 176         if (!p->pregs) {
 177                 printk(KERN_ERR "fhc: Cannot map pregs\n");
 178                 goto out_free;
 179         }
 180
 181         if (p->central) {
 182                 reg = upa_readl(p->pregs + FHC_PREGS_BSR);
 183                 p->board_num = ((reg >> 16) & 1) | ((reg >> 12) & 0x0e);
 184         } else {
 185                 p->board_num = of_getintprop_default(op->dev.of_node, "board#", -1);
 186                 if (p->board_num == -1) {
 187                         printk(KERN_ERR "fhc: No board# property\n");
 188                         goto out_unmap_pregs;
 189                 }
 190                 if (upa_readl(p->pregs + FHC_PREGS_JCTRL) & FHC_JTAG_CTRL_MENAB)
 191                         p->jtag_master = true;
 192         }
 193
 194         if (!p->central) {
 195                 p->leds_resource.start = (unsigned long)
 196                         (p->pregs + FHC_PREGS_CTRL);
 197                 p->leds_resource.end = p->leds_resource.start;
 198                 p->leds_resource.name = "leds";
 199
 200                 p->leds_pdev.name = "sunfire-fhc-leds";
 201                 p->leds_pdev.id = p->board_num;
 202                 p->leds_pdev.resource = &p->leds_resource;
 203                 p->leds_pdev.num_resources = 1;
 204                 p->leds_pdev.dev.parent = &op->dev;
 205
 206                 err = platform_device_register(&p->leds_pdev);
 207                 if (err) {
 208                         printk(KERN_ERR "fhc: Could not register LEDS "
 209                                "platform device\n");
 210                         goto out_unmap_pregs;
 211                 }
 212         }
 213         reg = upa_readl(p->pregs + FHC_PREGS_CTRL);
 214
 215         if (!p->central)
 216                 reg |= FHC_CONTROL_IXIST;
 217
 218         reg &= ~(FHC_CONTROL_AOFF |
 219                  FHC_CONTROL_BOFF |
 220                  FHC_CONTROL_SLINE);
 221
 222         upa_writel(reg, p->pregs + FHC_PREGS_CTRL);
 223         upa_readl(p->pregs + FHC_PREGS_CTRL);
 224
 225         reg = upa_readl(p->pregs + FHC_PREGS_ID);
 226         printk(KERN_INFO "fhc: Board #%d, Version[%x] PartID[%x] Manuf[%x] %s\n",
 227                p->board_num,
 228                (reg & FHC_ID_VERS) >> 28,
 229                (reg & FHC_ID_PARTID) >> 12,
 230                (reg & FHC_ID_MANUF) >> 1,
 231                (p->jtag_master ?
 232                 "(JTAG Master)" :
 233                 (p->central ? "(Central)" : "")));
 234
 235         err = 0;
 236
 237 out:
 238         return err;
 239
 240 out_unmap_pregs:
 241         of_iounmap(&op->resource[0], p->pregs, resource_size(&op->resource[0]));
 242
 243 out_free:
 244         kfree(p);
 245         goto out;
 246 }
 247
 248 static const struct of_device_id fhc_match[] = {
 249         {
 250                 .name = "fhc",
 251         },
 252         {},
 253 };
 254
 255 static struct platform_driver fhc_driver = {
 256         .probe          = fhc_probe,
 257         .driver = {
 258                 .name = "fhc",
 259                 .owner = THIS_MODULE,
 260                 .of_match_table = fhc_match,
 261         },
 262 };
 263
 264 static int __init sunfire_init(void)
 265 {
 266         (void) platform_driver_register(&fhc_driver);
 267         (void) platform_driver_register(&clock_board_driver);
 268         return 0;
 269 }
 270
 271 subsys_initcall(sunfire_init);