git.oblomov.eu Git - linux-2.6/blob - arch/sparc64/kernel/central.c

   1 /* central.c: Central FHC driver for Sunfire/Starfire/Wildfire.
   2  *
   3  * Copyright (C) 1997, 1999 David S. Miller (davem@davemloft.net)
   4  */
   5
   6 #include <linux/kernel.h>
   7 #include <linux/types.h>
   8 #include <linux/string.h>
   9 #include <linux/timer.h>
  10 #include <linux/sched.h>
  11 #include <linux/delay.h>
  12 #include <linux/init.h>
  13 #include <linux/bootmem.h>
  14
  15 #include <asm/page.h>
  16 #include <asm/fhc.h>
  17 #include <asm/starfire.h>
  18
  19 struct linux_central *central_bus = NULL;
  20 struct linux_fhc *fhc_list = NULL;
  21
  22 #define IS_CENTRAL_FHC(__fhc)   ((__fhc) == central_bus->child)
  23
  24 static void central_probe_failure(int line)
  25 {
  26         prom_printf("CENTRAL: Critical device probe failure at central.c:%d\n",
  27                     line);
  28         prom_halt();
  29 }
  30
  31 static void central_ranges_init(struct linux_central *central)
  32 {
  33         struct device_node *dp = central->prom_node;
  34         const void *pval;
  35         int len;
  36
  37         central->num_central_ranges = 0;
  38         pval = of_get_property(dp, "ranges", &len);
  39         if (pval) {
  40                 memcpy(central->central_ranges, pval, len);
  41                 central->num_central_ranges =
  42                         (len / sizeof(struct linux_prom_ranges));
  43         }
  44 }
  45
  46 static void fhc_ranges_init(struct linux_fhc *fhc)
  47 {
  48         struct device_node *dp = fhc->prom_node;
  49         const void *pval;
  50         int len;
  51
  52         fhc->num_fhc_ranges = 0;
  53         pval = of_get_property(dp, "ranges", &len);
  54         if (pval) {
  55                 memcpy(fhc->fhc_ranges, pval, len);
  56                 fhc->num_fhc_ranges =
  57                         (len / sizeof(struct linux_prom_ranges));
  58         }
  59 }
  60
  61 /* Range application routines are exported to various drivers,
  62  * so do not __init this.
  63  */
  64 static void adjust_regs(struct linux_prom_registers *regp, int nregs,
  65                         struct linux_prom_ranges *rangep, int nranges)
  66 {
  67         int regc, rngc;
  68
  69         for (regc = 0; regc < nregs; regc++) {
  70                 for (rngc = 0; rngc < nranges; rngc++)
  71                         if (regp[regc].which_io == rangep[rngc].ot_child_space)
  72                                 break; /* Fount it */
  73                 if (rngc == nranges) /* oops */
  74                         central_probe_failure(__LINE__);
  75                 regp[regc].which_io = rangep[rngc].ot_parent_space;
  76                 regp[regc].phys_addr -= rangep[rngc].ot_child_base;
  77                 regp[regc].phys_addr += rangep[rngc].ot_parent_base;
  78         }
  79 }
  80
  81 /* Apply probed fhc ranges to registers passed, if no ranges return. */
  82 void apply_fhc_ranges(struct linux_fhc *fhc,
  83                       struct linux_prom_registers *regs,
  84                       int nregs)
  85 {
  86         if (fhc->num_fhc_ranges)
  87                 adjust_regs(regs, nregs, fhc->fhc_ranges,
  88                             fhc->num_fhc_ranges);
  89 }
  90
  91 /* Apply probed central ranges to registers passed, if no ranges return. */
  92 void apply_central_ranges(struct linux_central *central,
  93                           struct linux_prom_registers *regs, int nregs)
  94 {
  95         if (central->num_central_ranges)
  96                 adjust_regs(regs, nregs, central->central_ranges,
  97                             central->num_central_ranges);
  98 }
  99
 100 static void * __init central_alloc_bootmem(unsigned long size)
 101 {
 102         void *ret;
 103
 104         ret = __alloc_bootmem(size, SMP_CACHE_BYTES, 0UL);
 105         if (ret != NULL)
 106                 memset(ret, 0, size);
 107
 108         return ret;
 109 }
 110
 111 static unsigned long prom_reg_to_paddr(struct linux_prom_registers *r)
 112 {
 113         unsigned long ret = ((unsigned long) r->which_io) << 32;
 114
 115         return ret | (unsigned long) r->phys_addr;
 116 }
 117
 118 static void __init probe_other_fhcs(void)
 119 {
 120         struct device_node *dp;
 121         const struct linux_prom64_registers *fpregs;
 122
 123         for_each_node_by_name(dp, "fhc") {
 124                 struct linux_fhc *fhc;
 125                 int board;
 126                 u32 tmp;
 127
 128                 if (dp->parent &&
 129                     dp->parent->parent != NULL)
 130                         continue;
 131
 132                 fhc = (struct linux_fhc *)
 133                         central_alloc_bootmem(sizeof(struct linux_fhc));
 134                 if (fhc == NULL)
 135                         central_probe_failure(__LINE__);
 136
 137                 /* Link it into the FHC chain. */
 138                 fhc->next = fhc_list;
 139                 fhc_list = fhc;
 140
 141                 /* Toplevel FHCs have no parent. */
 142                 fhc->parent = NULL;
 143
 144                 fhc->prom_node = dp;
 145                 fhc_ranges_init(fhc);
 146
 147                 /* Non-central FHC's have 64-bit OBP format registers. */
 148                 fpregs = of_get_property(dp, "reg", NULL);
 149                 if (!fpregs)
 150                         central_probe_failure(__LINE__);
 151
 152                 /* Only central FHC needs special ranges applied. */
 153                 fhc->fhc_regs.pregs = fpregs[0].phys_addr;
 154                 fhc->fhc_regs.ireg = fpregs[1].phys_addr;
 155                 fhc->fhc_regs.ffregs = fpregs[2].phys_addr;
 156                 fhc->fhc_regs.sregs = fpregs[3].phys_addr;
 157                 fhc->fhc_regs.uregs = fpregs[4].phys_addr;
 158                 fhc->fhc_regs.tregs = fpregs[5].phys_addr;
 159
 160                 board = of_getintprop_default(dp, "board#", -1);
 161                 fhc->board = board;
 162
 163                 tmp = upa_readl(fhc->fhc_regs.pregs + FHC_PREGS_JCTRL);
 164                 if ((tmp & FHC_JTAG_CTRL_MENAB) != 0)
 165                         fhc->jtag_master = 1;
 166                 else
 167                         fhc->jtag_master = 0;
 168
 169                 tmp = upa_readl(fhc->fhc_regs.pregs + FHC_PREGS_ID);
 170                 printk("FHC(board %d): Version[%x] PartID[%x] Manuf[%x] %s\n",
 171                        board,
 172                        (tmp & FHC_ID_VERS) >> 28,
 173                        (tmp & FHC_ID_PARTID) >> 12,
 174                        (tmp & FHC_ID_MANUF) >> 1,
 175                        (fhc->jtag_master ? "(JTAG Master)" : ""));
 176
 177                 /* This bit must be set in all non-central FHC's in
 178                  * the system.  When it is clear, this identifies
 179                  * the central board.
 180                  */
 181                 tmp = upa_readl(fhc->fhc_regs.pregs + FHC_PREGS_CTRL);
 182                 tmp |= FHC_CONTROL_IXIST;
 183                 upa_writel(tmp, fhc->fhc_regs.pregs + FHC_PREGS_CTRL);
 184         }
 185 }
 186
 187 static void probe_clock_board(struct linux_central *central,
 188                               struct linux_fhc *fhc,
 189                               struct device_node *fp)
 190 {
 191         struct device_node *dp;
 192         struct linux_prom_registers cregs[3];
 193         const struct linux_prom_registers *pr;
 194         int nslots, tmp, nregs;
 195
 196         dp = fp->child;
 197         while (dp) {
 198                 if (!strcmp(dp->name, "clock-board"))
 199                         break;
 200                 dp = dp->sibling;
 201         }
 202         if (!dp)
 203                 central_probe_failure(__LINE__);
 204
 205         pr = of_get_property(dp, "reg", &nregs);
 206         if (!pr)
 207                 central_probe_failure(__LINE__);
 208
 209         memcpy(cregs, pr, nregs);
 210         nregs /= sizeof(struct linux_prom_registers);
 211
 212         apply_fhc_ranges(fhc, &cregs[0], nregs);
 213         apply_central_ranges(central, &cregs[0], nregs);
 214         central->cfreg = prom_reg_to_paddr(&cregs[0]);
 215         central->clkregs = prom_reg_to_paddr(&cregs[1]);
 216
 217         if (nregs == 2)
 218                 central->clkver = 0UL;
 219         else
 220                 central->clkver = prom_reg_to_paddr(&cregs[2]);
 221
 222         tmp = upa_readb(central->clkregs + CLOCK_STAT1);
 223         tmp &= 0xc0;
 224         switch(tmp) {
 225         case 0x40:
 226                 nslots = 16;
 227                 break;
 228         case 0xc0:
 229                 nslots = 8;
 230                 break;
 231         case 0x80:
 232                 if (central->clkver != 0UL &&
 233                    upa_readb(central->clkver) != 0) {
 234                         if ((upa_readb(central->clkver) & 0x80) != 0)
 235                                 nslots = 4;
 236                         else
 237                                 nslots = 5;
 238                         break;
 239                 }
 240         default:
 241                 nslots = 4;
 242                 break;
 243         };
 244         central->slots = nslots;
 245         printk("CENTRAL: Detected %d slot Enterprise system. cfreg[%02x] cver[%02x]\n",
 246                central->slots, upa_readb(central->cfreg),
 247                (central->clkver ? upa_readb(central->clkver) : 0x00));
 248 }
 249
 250 static void ZAP(unsigned long iclr, unsigned long imap)
 251 {
 252         u32 imap_tmp;
 253
 254         upa_writel(0, iclr);
 255         upa_readl(iclr);
 256         imap_tmp = upa_readl(imap);
 257         imap_tmp &= ~(0x80000000);
 258         upa_writel(imap_tmp, imap);
 259         upa_readl(imap);
 260 }
 261
 262 static void init_all_fhc_hw(void)
 263 {
 264         struct linux_fhc *fhc;
 265
 266         for (fhc = fhc_list; fhc != NULL; fhc = fhc->next) {
 267                 u32 tmp;
 268
 269                 /* Clear all of the interrupt mapping registers
 270                  * just in case OBP left them in a foul state.
 271                  */
 272                 ZAP(fhc->fhc_regs.ffregs + FHC_FFREGS_ICLR,
 273                     fhc->fhc_regs.ffregs + FHC_FFREGS_IMAP);
 274                 ZAP(fhc->fhc_regs.sregs + FHC_SREGS_ICLR,
 275                     fhc->fhc_regs.sregs + FHC_SREGS_IMAP);
 276                 ZAP(fhc->fhc_regs.uregs + FHC_UREGS_ICLR,
 277                     fhc->fhc_regs.uregs + FHC_UREGS_IMAP);
 278                 ZAP(fhc->fhc_regs.tregs + FHC_TREGS_ICLR,
 279                     fhc->fhc_regs.tregs + FHC_TREGS_IMAP);
 280
 281                 /* Setup FHC control register. */
 282                 tmp = upa_readl(fhc->fhc_regs.pregs + FHC_PREGS_CTRL);
 283
 284                 /* All non-central boards have this bit set. */
 285                 if (! IS_CENTRAL_FHC(fhc))
 286                         tmp |= FHC_CONTROL_IXIST;
 287
 288                 /* For all FHCs, clear the firmware synchronization
 289                  * line and both low power mode enables.
 290                  */
 291                 tmp &= ~(FHC_CONTROL_AOFF | FHC_CONTROL_BOFF |
 292                          FHC_CONTROL_SLINE);
 293
 294                 upa_writel(tmp, fhc->fhc_regs.pregs + FHC_PREGS_CTRL);
 295                 upa_readl(fhc->fhc_regs.pregs + FHC_PREGS_CTRL);
 296         }
 297
 298 }
 299
 300 void __init central_probe(void)
 301 {
 302         struct linux_prom_registers fpregs[6];
 303         const struct linux_prom_registers *pr;
 304         struct linux_fhc *fhc;
 305         struct device_node *dp, *fp;
 306         int err;
 307
 308         dp = of_find_node_by_name(NULL, "central");
 309         if (!dp) {
 310                 if (this_is_starfire)
 311                         starfire_cpu_setup();
 312                 return;
 313         }
 314
 315         /* Ok we got one, grab some memory for software state. */
 316         central_bus = (struct linux_central *)
 317                 central_alloc_bootmem(sizeof(struct linux_central));
 318         if (central_bus == NULL)
 319                 central_probe_failure(__LINE__);
 320
 321         fhc = (struct linux_fhc *)
 322                 central_alloc_bootmem(sizeof(struct linux_fhc));
 323         if (fhc == NULL)
 324                 central_probe_failure(__LINE__);
 325
 326         /* First init central. */
 327         central_bus->child = fhc;
 328         central_bus->prom_node = dp;
 329         central_ranges_init(central_bus);
 330
 331         /* And then central's FHC. */
 332         fhc->next = fhc_list;
 333         fhc_list = fhc;
 334
 335         fhc->parent = central_bus;
 336         fp = dp->child;
 337         while (fp) {
 338                 if (!strcmp(fp->name, "fhc"))
 339                         break;
 340                 fp = fp->sibling;
 341         }
 342         if (!fp)
 343                 central_probe_failure(__LINE__);
 344
 345         fhc->prom_node = fp;
 346         fhc_ranges_init(fhc);
 347
 348         /* Now, map in FHC register set. */
 349         pr = of_get_property(fp, "reg", NULL);
 350         if (!pr)
 351                 central_probe_failure(__LINE__);
 352         memcpy(fpregs, pr, sizeof(fpregs));
 353
 354         apply_central_ranges(central_bus, &fpregs[0], 6);
 355
 356         fhc->fhc_regs.pregs = prom_reg_to_paddr(&fpregs[0]);
 357         fhc->fhc_regs.ireg = prom_reg_to_paddr(&fpregs[1]);
 358         fhc->fhc_regs.ffregs = prom_reg_to_paddr(&fpregs[2]);
 359         fhc->fhc_regs.sregs = prom_reg_to_paddr(&fpregs[3]);
 360         fhc->fhc_regs.uregs = prom_reg_to_paddr(&fpregs[4]);
 361         fhc->fhc_regs.tregs = prom_reg_to_paddr(&fpregs[5]);
 362
 363         /* Obtain board number from board status register, Central's
 364          * FHC lacks "board#" property.
 365          */
 366         err = upa_readl(fhc->fhc_regs.pregs + FHC_PREGS_BSR);
 367         fhc->board = (((err >> 16) & 0x01) |
 368                       ((err >> 12) & 0x0e));
 369
 370         fhc->jtag_master = 0;
 371
 372         /* Attach the clock board registers for CENTRAL. */
 373         probe_clock_board(central_bus, fhc, fp);
 374
 375         err = upa_readl(fhc->fhc_regs.pregs + FHC_PREGS_ID);
 376         printk("FHC(board %d): Version[%x] PartID[%x] Manuf[%x] (CENTRAL)\n",
 377                fhc->board,
 378                ((err & FHC_ID_VERS) >> 28),
 379                ((err & FHC_ID_PARTID) >> 12),
 380                ((err & FHC_ID_MANUF) >> 1));
 381
 382         probe_other_fhcs();
 383
 384         init_all_fhc_hw();
 385 }
 386
 387 static inline void fhc_ledblink(struct linux_fhc *fhc, int on)
 388 {
 389         u32 tmp;
 390
 391         tmp = upa_readl(fhc->fhc_regs.pregs + FHC_PREGS_CTRL);
 392
 393         /* NOTE: reverse logic on this bit */
 394         if (on)
 395                 tmp &= ~(FHC_CONTROL_RLED);
 396         else
 397                 tmp |= FHC_CONTROL_RLED;
 398         tmp &= ~(FHC_CONTROL_AOFF | FHC_CONTROL_BOFF | FHC_CONTROL_SLINE);
 399
 400         upa_writel(tmp, fhc->fhc_regs.pregs + FHC_PREGS_CTRL);
 401         upa_readl(fhc->fhc_regs.pregs + FHC_PREGS_CTRL);
 402 }
 403
 404 static inline void central_ledblink(struct linux_central *central, int on)
 405 {
 406         u8 tmp;
 407
 408         tmp = upa_readb(central->clkregs + CLOCK_CTRL);
 409
 410         /* NOTE: reverse logic on this bit */
 411         if (on)
 412                 tmp &= ~(CLOCK_CTRL_RLED);
 413         else
 414                 tmp |= CLOCK_CTRL_RLED;
 415
 416         upa_writeb(tmp, central->clkregs + CLOCK_CTRL);
 417         upa_readb(central->clkregs + CLOCK_CTRL);
 418 }
 419
 420 static struct timer_list sftimer;
 421 static int led_state;
 422
 423 static void sunfire_timer(unsigned long __ignored)
 424 {
 425         struct linux_fhc *fhc;
 426
 427         central_ledblink(central_bus, led_state);
 428         for (fhc = fhc_list; fhc != NULL; fhc = fhc->next)
 429                 if (! IS_CENTRAL_FHC(fhc))
 430                         fhc_ledblink(fhc, led_state);
 431         led_state = ! led_state;
 432         sftimer.expires = jiffies + (HZ >> 1);
 433         add_timer(&sftimer);
 434 }
 435
 436 /* After PCI/SBUS busses have been probed, this is called to perform
 437  * final initialization of all FireHose Controllers in the system.
 438  */
 439 void firetruck_init(void)
 440 {
 441         struct linux_central *central = central_bus;
 442         u8 ctrl;
 443
 444         /* No central bus, nothing to do. */
 445         if (central == NULL)
 446                 return;
 447
 448         /* OBP leaves it on, turn it off so clock board timer LED
 449          * is in sync with FHC ones.
 450          */
 451         ctrl = upa_readb(central->clkregs + CLOCK_CTRL);
 452         ctrl &= ~(CLOCK_CTRL_RLED);
 453         upa_writeb(ctrl, central->clkregs + CLOCK_CTRL);
 454
 455         led_state = 0;
 456         init_timer(&sftimer);
 457         sftimer.data = 0;
 458         sftimer.function = &sunfire_timer;
 459         sftimer.expires = jiffies + (HZ >> 1);
 460         add_timer(&sftimer);
 461 }