arch/blackfin/kernel/setup.c

   1 /*
   2  * File:         arch/blackfin/kernel/setup.c
   3  * Based on:
   4  * Author:
   5  *
   6  * Created:
   7  * Description:
   8  *
   9  * Modified:
  10  *               Copyright 2004-2006 Analog Devices Inc.
  11  *
  12  * Bugs:         Enter bugs at http://blackfin.uclinux.org/
  13  *
  14  * This program is free software; you can redistribute it and/or modify
  15  * it under the terms of the GNU General Public License as published by
  16  * the Free Software Foundation; either version 2 of the License, or
  17  * (at your option) any later version.
  18  *
  19  * This program is distributed in the hope that it will be useful,
  20  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  21  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  22  * GNU General Public License for more details.
  23  *
  24  * You should have received a copy of the GNU General Public License
  25  * along with this program; if not, see the file COPYING, or write
  26  * to the Free Software Foundation, Inc.,
  27  * 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
  28  */
  29
  30 #include <linux/delay.h>
  31 #include <linux/console.h>
  32 #include <linux/bootmem.h>
  33 #include <linux/seq_file.h>
  34 #include <linux/cpu.h>
  35 #include <linux/module.h>
  36 #include <linux/console.h>
  37 #include <linux/tty.h>
  38
  39 #include <linux/ext2_fs.h>
  40 #include <linux/cramfs_fs.h>
  41 #include <linux/romfs_fs.h>
  42
  43 #include <asm/cacheflush.h>
  44 #include <asm/blackfin.h>
  45 #include <asm/cplbinit.h>
  46
  47 unsigned long memory_start, memory_end, physical_mem_end;
  48 unsigned long reserved_mem_dcache_on;
  49 unsigned long reserved_mem_icache_on;
  50 EXPORT_SYMBOL(memory_start);
  51 EXPORT_SYMBOL(memory_end);
  52 EXPORT_SYMBOL(physical_mem_end);
  53 EXPORT_SYMBOL(_ramend);
  54
  55 #ifdef CONFIG_MTD_UCLINUX
  56 unsigned long memory_mtd_end, memory_mtd_start, mtd_size;
  57 unsigned long _ebss;
  58 EXPORT_SYMBOL(memory_mtd_end);
  59 EXPORT_SYMBOL(memory_mtd_start);
  60 EXPORT_SYMBOL(mtd_size);
  61 #endif
  62
  63 char command_line[COMMAND_LINE_SIZE];
  64
  65 #if defined(CONFIG_BLKFIN_DCACHE) || defined(CONFIG_BLKFIN_CACHE)
  66 static void generate_cpl_tables(void);
  67 #endif
  68
  69 void __init bf53x_cache_init(void)
  70 {
  71 #if defined(CONFIG_BLKFIN_DCACHE) || defined(CONFIG_BLKFIN_CACHE)
  72         generate_cpl_tables();
  73 #endif
  74
  75 #ifdef CONFIG_BLKFIN_CACHE
  76         bfin_icache_init();
  77         printk(KERN_INFO "Instruction Cache Enabled\n");
  78 #endif
  79
  80 #ifdef CONFIG_BLKFIN_DCACHE
  81         bfin_dcache_init();
  82         printk(KERN_INFO "Data Cache Enabled"
  83 # if defined CONFIG_BLKFIN_WB
  84                 " (write-back)"
  85 # elif defined CONFIG_BLKFIN_WT
  86                 " (write-through)"
  87 # endif
  88                 "\n");
  89 #endif
  90 }
  91
  92 void bf53x_relocate_l1_mem(void)
  93 {
  94         unsigned long l1_code_length;
  95         unsigned long l1_data_a_length;
  96         unsigned long l1_data_b_length;
  97
  98         l1_code_length = _etext_l1 - _stext_l1;
  99         if (l1_code_length > L1_CODE_LENGTH)
 100                 l1_code_length = L1_CODE_LENGTH;
 101         /* cannot complain as printk is not available as yet.
 102          * But we can continue booting and complain later!
 103          */
 104
 105         /* Copy _stext_l1 to _etext_l1 to L1 instruction SRAM */
 106         dma_memcpy(_stext_l1, _l1_lma_start, l1_code_length);
 107
 108         l1_data_a_length = _ebss_l1 - _sdata_l1;
 109         if (l1_data_a_length > L1_DATA_A_LENGTH)
 110                 l1_data_a_length = L1_DATA_A_LENGTH;
 111
 112         /* Copy _sdata_l1 to _ebss_l1 to L1 data bank A SRAM */
 113         dma_memcpy(_sdata_l1, _l1_lma_start + l1_code_length, l1_data_a_length);
 114
 115         l1_data_b_length = _ebss_b_l1 - _sdata_b_l1;
 116         if (l1_data_b_length > L1_DATA_B_LENGTH)
 117                 l1_data_b_length = L1_DATA_B_LENGTH;
 118
 119         /* Copy _sdata_b_l1 to _ebss_b_l1 to L1 data bank B SRAM */
 120         dma_memcpy(_sdata_b_l1, _l1_lma_start + l1_code_length +
 121                         l1_data_a_length, l1_data_b_length);
 122
 123 }
 124
 125 /*
 126  * Initial parsing of the command line.  Currently, we support:
 127  *  - Controlling the linux memory size: mem=xxx[KMG]
 128  *  - Controlling the physical memory size: max_mem=xxx[KMG][$][#]
 129  *       $ -> reserved memory is dcacheable
 130  *       # -> reserved memory is icacheable
 131  */
 132 static __init void parse_cmdline_early(char *cmdline_p)
 133 {
 134         char c = ' ', *to = cmdline_p;
 135         unsigned int memsize;
 136         for (;;) {
 137                 if (c == ' ') {
 138
 139                         if (!memcmp(to, "mem=", 4)) {
 140                                 to += 4;
 141                                 memsize = memparse(to, &to);
 142                                 if (memsize)
 143                                         _ramend = memsize;
 144
 145                         } else if (!memcmp(to, "max_mem=", 8)) {
 146                                 to += 8;
 147                                 memsize = memparse(to, &to);
 148                                 if (memsize) {
 149                                         physical_mem_end = memsize;
 150                                         if (*to != ' ') {
 151                                                 if (*to == '$'
 152                                                     || *(to + 1) == '$')
 153                                                         reserved_mem_dcache_on =
 154                                                             1;
 155                                                 if (*to == '#'
 156                                                     || *(to + 1) == '#')
 157                                                         reserved_mem_icache_on =
 158                                                             1;
 159                                         }
 160                                 }
 161                         }
 162
 163                 }
 164                 c = *(to++);
 165                 if (!c)
 166                         break;
 167         }
 168 }
 169
 170 void __init setup_arch(char **cmdline_p)
 171 {
 172         int bootmap_size;
 173         unsigned long l1_length, sclk, cclk;
 174 #ifdef CONFIG_MTD_UCLINUX
 175         unsigned long mtd_phys = 0;
 176 #endif
 177
 178         cclk = get_cclk();
 179         sclk = get_sclk();
 180
 181 #if !defined(CONFIG_BFIN_KERNEL_CLOCK) && defined(ANOMALY_05000273)
 182         if (cclk == sclk)
 183                 panic("ANOMALY 05000273, SCLK can not be same as CCLK");
 184 #endif
 185
 186 #if defined(ANOMALY_05000266)
 187         bfin_read_IMDMA_D0_IRQ_STATUS();
 188         bfin_read_IMDMA_D1_IRQ_STATUS();
 189 #endif
 190
 191 #ifdef DEBUG_SERIAL_EARLY_INIT
 192         bfin_console_init();    /* early console registration */
 193         /* this give a chance to get printk() working before crash. */
 194 #endif
 195
 196 #if defined(CONFIG_CHR_DEV_FLASH) || defined(CONFIG_BLK_DEV_FLASH)
 197         /* we need to initialize the Flashrom device here since we might
 198          * do things with flash early on in the boot
 199          */
 200         flash_probe();
 201 #endif
 202
 203 #if defined(CONFIG_CMDLINE_BOOL)
 204         memset(command_line, 0, sizeof(command_line));
 205         strncpy(&command_line[0], CONFIG_CMDLINE, sizeof(command_line));
 206         command_line[sizeof(command_line) - 1] = 0;
 207 #endif
 208
 209         /* Keep a copy of command line */
 210         *cmdline_p = &command_line[0];
 211         memcpy(boot_command_line, command_line, COMMAND_LINE_SIZE);
 212         boot_command_line[COMMAND_LINE_SIZE - 1] = 0;
 213
 214         /* setup memory defaults from the user config */
 215         physical_mem_end = 0;
 216         _ramend = CONFIG_MEM_SIZE * 1024 * 1024;
 217
 218         parse_cmdline_early(&command_line[0]);
 219
 220         if (physical_mem_end == 0)
 221                 physical_mem_end = _ramend;
 222
 223         /* by now the stack is part of the init task */
 224         memory_end = _ramend - DMA_UNCACHED_REGION;
 225
 226         _ramstart = (unsigned long)__bss_stop;
 227         memory_start = PAGE_ALIGN(_ramstart);
 228
 229 #if defined(CONFIG_MTD_UCLINUX)
 230         /* generic memory mapped MTD driver */
 231         memory_mtd_end = memory_end;
 232
 233         mtd_phys = _ramstart;
 234         mtd_size = PAGE_ALIGN(*((unsigned long *)(mtd_phys + 8)));
 235
 236 # if defined(CONFIG_EXT2_FS) || defined(CONFIG_EXT3_FS)
 237         if (*((unsigned short *)(mtd_phys + 0x438)) == EXT2_SUPER_MAGIC)
 238                 mtd_size =
 239                     PAGE_ALIGN(*((unsigned long *)(mtd_phys + 0x404)) << 10);
 240 # endif
 241
 242 # if defined(CONFIG_CRAMFS)
 243         if (*((unsigned long *)(mtd_phys)) == CRAMFS_MAGIC)
 244                 mtd_size = PAGE_ALIGN(*((unsigned long *)(mtd_phys + 0x4)));
 245 # endif
 246
 247 # if defined(CONFIG_ROMFS_FS)
 248         if (((unsigned long *)mtd_phys)[0] == ROMSB_WORD0
 249             && ((unsigned long *)mtd_phys)[1] == ROMSB_WORD1)
 250                 mtd_size =
 251                     PAGE_ALIGN(be32_to_cpu(((unsigned long *)mtd_phys)[2]));
 252 #  if (defined(CONFIG_BLKFIN_CACHE) && defined(ANOMALY_05000263))
 253         /* Due to a Hardware Anomaly we need to limit the size of usable
 254          * instruction memory to max 60MB, 56 if HUNT_FOR_ZERO is on
 255          * 05000263 - Hardware loop corrupted when taking an ICPLB exception
 256          */
 257 #   if (defined(CONFIG_DEBUG_HUNT_FOR_ZERO))
 258         if (memory_end >= 56 * 1024 * 1024)
 259                 memory_end = 56 * 1024 * 1024;
 260 #   else
 261         if (memory_end >= 60 * 1024 * 1024)
 262                 memory_end = 60 * 1024 * 1024;
 263 #   endif                               /* CONFIG_DEBUG_HUNT_FOR_ZERO */
 264 #  endif                                /* ANOMALY_05000263 */
 265 # endif                         /* CONFIG_ROMFS_FS */
 266
 267         memory_end -= mtd_size;
 268
 269         if (mtd_size == 0) {
 270                 console_init();
 271                 panic("Don't boot kernel without rootfs attached.\n");
 272         }
 273
 274         /* Relocate MTD image to the top of memory after the uncached memory area */
 275         dma_memcpy((char *)memory_end, __bss_stop, mtd_size);
 276
 277         memory_mtd_start = memory_end;
 278         _ebss = memory_mtd_start;       /* define _ebss for compatible */
 279 #endif                          /* CONFIG_MTD_UCLINUX */
 280
 281 #if (defined(CONFIG_BLKFIN_CACHE) && defined(ANOMALY_05000263))
 282         /* Due to a Hardware Anomaly we need to limit the size of usable
 283          * instruction memory to max 60MB, 56 if HUNT_FOR_ZERO is on
 284          * 05000263 - Hardware loop corrupted when taking an ICPLB exception
 285          */
 286 #if (defined(CONFIG_DEBUG_HUNT_FOR_ZERO))
 287         if (memory_end >= 56 * 1024 * 1024)
 288                 memory_end = 56 * 1024 * 1024;
 289 #else
 290         if (memory_end >= 60 * 1024 * 1024)
 291                 memory_end = 60 * 1024 * 1024;
 292 #endif                          /* CONFIG_DEBUG_HUNT_FOR_ZERO */
 293         printk(KERN_NOTICE "Warning: limiting memory to %liMB due to hardware anomaly 05000263\n", memory_end >> 20);
 294 #endif                          /* ANOMALY_05000263 */
 295
 296 #if !defined(CONFIG_MTD_UCLINUX)
 297         memory_end -= SIZE_4K; /*In case there is no valid CPLB behind memory_end make sure we don't get to close*/
 298 #endif
 299         init_mm.start_code = (unsigned long)_stext;
 300         init_mm.end_code = (unsigned long)_etext;
 301         init_mm.end_data = (unsigned long)_edata;
 302         init_mm.brk = (unsigned long)0;
 303
 304         init_leds();
 305
 306         printk(KERN_INFO "Blackfin support (C) 2004-2007 Analog Devices, Inc.\n");
 307         printk(KERN_INFO "Compiled for ADSP-%s Rev 0.%d\n", CPU, bfin_compiled_revid());
 308         if (bfin_revid() != bfin_compiled_revid())
 309                 printk(KERN_ERR "Warning: Compiled for Rev %d, but running on Rev %d\n",
 310                        bfin_compiled_revid(), bfin_revid());
 311         if (bfin_revid() < SUPPORTED_REVID)
 312                 printk(KERN_ERR "Warning: Unsupported Chip Revision ADSP-%s Rev 0.%d detected\n",
 313                        CPU, bfin_revid());
 314         printk(KERN_INFO "Blackfin Linux support by http://blackfin.uclinux.org/\n");
 315
 316         printk(KERN_INFO "Processor Speed: %lu MHz core clock and %lu Mhz System Clock\n",
 317                cclk / 1000000,  sclk / 1000000);
 318
 319 #if defined(ANOMALY_05000273)
 320         if ((cclk >> 1) <= sclk)
 321                 printk("\n\n\nANOMALY_05000273: CCLK must be >= 2*SCLK !!!\n\n\n");
 322 #endif
 323
 324         printk(KERN_INFO "Board Memory: %ldMB\n", physical_mem_end >> 20);
 325         printk(KERN_INFO "Kernel Managed Memory: %ldMB\n", _ramend >> 20);
 326
 327         printk(KERN_INFO "Memory map:\n"
 328                KERN_INFO "  text      = 0x%p-0x%p\n"
 329                KERN_INFO "  init      = 0x%p-0x%p\n"
 330                KERN_INFO "  data      = 0x%p-0x%p\n"
 331                KERN_INFO "  stack     = 0x%p-0x%p\n"
 332                KERN_INFO "  bss       = 0x%p-0x%p\n"
 333                KERN_INFO "  available = 0x%p-0x%p\n"
 334 #ifdef CONFIG_MTD_UCLINUX
 335                KERN_INFO "  rootfs    = 0x%p-0x%p\n"
 336 #endif
 337 #if DMA_UNCACHED_REGION > 0
 338                KERN_INFO "  DMA Zone  = 0x%p-0x%p\n"
 339 #endif
 340                , _stext, _etext,
 341                __init_begin, __init_end,
 342                _sdata, _edata,
 343                (void*)&init_thread_union, (void*)((int)(&init_thread_union) + 0x2000),
 344                __bss_start, __bss_stop,
 345                (void*)_ramstart, (void*)memory_end
 346 #ifdef CONFIG_MTD_UCLINUX
 347                , (void*)memory_mtd_start, (void*)(memory_mtd_start + mtd_size)
 348 #endif
 349 #if DMA_UNCACHED_REGION > 0
 350                , (void*)(_ramend - DMA_UNCACHED_REGION), (void*)(_ramend)
 351 #endif
 352                );
 353
 354         /*
 355          * give all the memory to the bootmap allocator,  tell it to put the
 356          * boot mem_map at the start of memory
 357          */
 358         bootmap_size = init_bootmem_node(NODE_DATA(0), memory_start >> PAGE_SHIFT,      /* map goes here */
 359                                          PAGE_OFFSET >> PAGE_SHIFT,
 360                                          memory_end >> PAGE_SHIFT);
 361         /*
 362          * free the usable memory,  we have to make sure we do not free
 363          * the bootmem bitmap so we then reserve it after freeing it :-)
 364          */
 365         free_bootmem(memory_start, memory_end - memory_start);
 366
 367         reserve_bootmem(memory_start, bootmap_size);
 368         /*
 369          * get kmalloc into gear
 370          */
 371         paging_init();
 372
 373         /* check the size of the l1 area */
 374         l1_length = _etext_l1 - _stext_l1;
 375         if (l1_length > L1_CODE_LENGTH)
 376                 panic("L1 memory overflow\n");
 377
 378         l1_length = _ebss_l1 - _sdata_l1;
 379         if (l1_length > L1_DATA_A_LENGTH)
 380                 panic("L1 memory overflow\n");
 381
 382         bf53x_cache_init();
 383
 384 #if defined(CONFIG_SMC91X) || defined(CONFIG_SMC91X_MODULE)
 385 # if defined(CONFIG_BFIN_SHARED_FLASH_ENET) && defined(CONFIG_BFIN533_STAMP)
 386         /* setup BF533_STAMP CPLD to route AMS3 to Ethernet MAC */
 387         bfin_write_FIO_DIR(bfin_read_FIO_DIR() | (1 << CONFIG_ENET_FLASH_PIN));
 388         bfin_write_FIO_FLAG_S(1 << CONFIG_ENET_FLASH_PIN);
 389         SSYNC();
 390 # endif
 391 # if defined (CONFIG_BFIN561_EZKIT)
 392         bfin_write_FIO0_DIR(bfin_read_FIO0_DIR() | (1 << 12));
 393         SSYNC();
 394 # endif /* defined (CONFIG_BFIN561_EZKIT) */
 395 #endif
 396
 397         printk(KERN_INFO "Hardware Trace Enabled\n");
 398         bfin_write_TBUFCTL(0x03);
 399 }
 400
 401 #if defined(CONFIG_BF561)
 402 static struct cpu cpu[2];
 403 #else
 404 static struct cpu cpu[1];
 405 #endif
 406 static int __init topology_init(void)
 407 {
 408 #if defined (CONFIG_BF561)
 409         register_cpu(&cpu[0], 0);
 410         register_cpu(&cpu[1], 1);
 411         return 0;
 412 #else
 413         return register_cpu(cpu, 0);
 414 #endif
 415 }
 416
 417 subsys_initcall(topology_init);
 418
 419 #if defined(CONFIG_BLKFIN_DCACHE) || defined(CONFIG_BLKFIN_CACHE)
 420 u16 lock_kernel_check(u32 start, u32 end)
 421 {
 422         if ((start <= (u32) _stext && end >= (u32) _end)
 423             || (start >= (u32) _stext && end <= (u32) _end))
 424                 return IN_KERNEL;
 425         return 0;
 426 }
 427
 428 static unsigned short __init
 429 fill_cplbtab(struct cplb_tab *table,
 430              unsigned long start, unsigned long end,
 431              unsigned long block_size, unsigned long cplb_data)
 432 {
 433         int i;
 434
 435         switch (block_size) {
 436         case SIZE_4M:
 437                 i = 3;
 438                 break;
 439         case SIZE_1M:
 440                 i = 2;
 441                 break;
 442         case SIZE_4K:
 443                 i = 1;
 444                 break;
 445         case SIZE_1K:
 446         default:
 447                 i = 0;
 448                 break;
 449         }
 450
 451         cplb_data = (cplb_data & ~(3 << 16)) | (i << 16);
 452
 453         while ((start < end) && (table->pos < table->size)) {
 454
 455                 table->tab[table->pos++] = start;
 456
 457                 if (lock_kernel_check(start, start + block_size) == IN_KERNEL)
 458                         table->tab[table->pos++] =
 459                             cplb_data | CPLB_LOCK | CPLB_DIRTY;
 460                 else
 461                         table->tab[table->pos++] = cplb_data;
 462
 463                 start += block_size;
 464         }
 465         return 0;
 466 }
 467
 468 static unsigned short __init
 469 close_cplbtab(struct cplb_tab *table)
 470 {
 471
 472         while (table->pos < table->size) {
 473
 474                 table->tab[table->pos++] = 0;
 475                 table->tab[table->pos++] = 0; /* !CPLB_VALID */
 476         }
 477         return 0;
 478 }
 479
 480 static void __init generate_cpl_tables(void)
 481 {
 482
 483         u16 i, j, process;
 484         u32 a_start, a_end, as, ae, as_1m;
 485
 486         struct cplb_tab *t_i = NULL;
 487         struct cplb_tab *t_d = NULL;
 488         struct s_cplb cplb;
 489
 490         cplb.init_i.size = MAX_CPLBS;
 491         cplb.init_d.size = MAX_CPLBS;
 492         cplb.switch_i.size = MAX_SWITCH_I_CPLBS;
 493         cplb.switch_d.size = MAX_SWITCH_D_CPLBS;
 494
 495         cplb.init_i.pos = 0;
 496         cplb.init_d.pos = 0;
 497         cplb.switch_i.pos = 0;
 498         cplb.switch_d.pos = 0;
 499
 500         cplb.init_i.tab = icplb_table;
 501         cplb.init_d.tab = dcplb_table;
 502         cplb.switch_i.tab = ipdt_table;
 503         cplb.switch_d.tab = dpdt_table;
 504
 505         cplb_data[SDRAM_KERN].end = memory_end;
 506
 507 #ifdef CONFIG_MTD_UCLINUX
 508         cplb_data[SDRAM_RAM_MTD].start = memory_mtd_start;
 509         cplb_data[SDRAM_RAM_MTD].end = memory_mtd_start + mtd_size;
 510         cplb_data[SDRAM_RAM_MTD].valid = mtd_size > 0;
 511 # if defined(CONFIG_ROMFS_FS)
 512         cplb_data[SDRAM_RAM_MTD].attr |= I_CPLB;
 513
 514         /*
 515          * The ROMFS_FS size is often not multiple of 1MB.
 516          * This can cause multiple CPLB sets covering the same memory area.
 517          * This will then cause multiple CPLB hit exceptions.
 518          * Workaround: We ensure a contiguous memory area by extending the kernel
 519          * memory section over the mtd section.
 520          * For ROMFS_FS memory must be covered with ICPLBs anyways.
 521          * So there is no difference between kernel and mtd memory setup.
 522          */
 523
 524         cplb_data[SDRAM_KERN].end = memory_mtd_start + mtd_size;;
 525         cplb_data[SDRAM_RAM_MTD].valid = 0;
 526
 527 # endif
 528 #else
 529         cplb_data[SDRAM_RAM_MTD].valid = 0;
 530 #endif
 531
 532         cplb_data[SDRAM_DMAZ].start = _ramend - DMA_UNCACHED_REGION;
 533         cplb_data[SDRAM_DMAZ].end = _ramend;
 534
 535         cplb_data[RES_MEM].start = _ramend;
 536         cplb_data[RES_MEM].end = physical_mem_end;
 537
 538         if (reserved_mem_dcache_on)
 539                 cplb_data[RES_MEM].d_conf = SDRAM_DGENERIC;
 540         else
 541                 cplb_data[RES_MEM].d_conf = SDRAM_DNON_CHBL;
 542
 543         if (reserved_mem_icache_on)
 544                 cplb_data[RES_MEM].i_conf = SDRAM_IGENERIC;
 545         else
 546                 cplb_data[RES_MEM].i_conf = SDRAM_INON_CHBL;
 547
 548         for (i = ZERO_P; i <= L2_MEM; i++) {
 549
 550                 if (cplb_data[i].valid) {
 551
 552                         as_1m = cplb_data[i].start % SIZE_1M;
 553
 554                         /* We need to make sure all sections are properly 1M aligned
 555                          * However between Kernel Memory and the Kernel mtd section, depending on the
 556                          * rootfs size, there can be overlapping memory areas.
 557                          */
 558
 559                         if (as_1m &&  i!=L1I_MEM && i!=L1D_MEM) {
 560 #ifdef CONFIG_MTD_UCLINUX
 561                                 if (i == SDRAM_RAM_MTD) {
 562                                         if ((cplb_data[SDRAM_KERN].end + 1) > cplb_data[SDRAM_RAM_MTD].start)
 563                                                 cplb_data[SDRAM_RAM_MTD].start = (cplb_data[i].start & (-2*SIZE_1M)) + SIZE_1M;
 564                                         else
 565                                                 cplb_data[SDRAM_RAM_MTD].start = (cplb_data[i].start & (-2*SIZE_1M));
 566                                 } else
 567 #endif
 568                                         printk(KERN_WARNING "Unaligned Start of %s at 0x%X\n",
 569                                                cplb_data[i].name, cplb_data[i].start);
 570                         }
 571
 572                         as = cplb_data[i].start % SIZE_4M;
 573                         ae = cplb_data[i].end % SIZE_4M;
 574
 575                         if (as)
 576                                 a_start = cplb_data[i].start + (SIZE_4M - (as));
 577                         else
 578                                 a_start = cplb_data[i].start;
 579
 580                         a_end = cplb_data[i].end - ae;
 581
 582                         for (j = INITIAL_T; j <= SWITCH_T; j++) {
 583
 584                                 switch (j) {
 585                                 case INITIAL_T:
 586                                         if (cplb_data[i].attr & INITIAL_T) {
 587                                                 t_i = &cplb.init_i;
 588                                                 t_d = &cplb.init_d;
 589                                                 process = 1;
 590                                         } else
 591                                                 process = 0;
 592                                         break;
 593                                 case SWITCH_T:
 594                                         if (cplb_data[i].attr & SWITCH_T) {
 595                                                 t_i = &cplb.switch_i;
 596                                                 t_d = &cplb.switch_d;
 597                                                 process = 1;
 598                                         } else
 599                                                 process = 0;
 600                                         break;
 601                                 default:
 602                                                 process = 0;
 603                                         break;
 604                                 }
 605
 606         if (process) {
 607                                 if (cplb_data[i].attr & I_CPLB) {
 608
 609                                         if (cplb_data[i].psize) {
 610                                                 fill_cplbtab(t_i,
 611                                                              cplb_data[i].start,
 612                                                              cplb_data[i].end,
 613                                                              cplb_data[i].psize,
 614                                                              cplb_data[i].i_conf);
 615                                         } else {
 616                                                 /*icplb_table */
 617 #if (defined(CONFIG_BLKFIN_CACHE) && defined(ANOMALY_05000263))
 618                                                 if (i == SDRAM_KERN) {
 619                                                         fill_cplbtab(t_i,
 620                                                                      cplb_data[i].start,
 621                                                                      cplb_data[i].end,
 622                                                                      SIZE_4M,
 623                                                                      cplb_data[i].i_conf);
 624                                                 } else
 625 #endif
 626                                                 {
 627                                                         fill_cplbtab(t_i,
 628                                                                      cplb_data[i].start,
 629                                                                      a_start,
 630                                                                      SIZE_1M,
 631                                                                      cplb_data[i].i_conf);
 632                                                         fill_cplbtab(t_i,
 633                                                                      a_start,
 634                                                                      a_end,
 635                                                                      SIZE_4M,
 636                                                                      cplb_data[i].i_conf);
 637                                                         fill_cplbtab(t_i, a_end,
 638                                                                      cplb_data[i].end,
 639                                                                      SIZE_1M,
 640                                                                      cplb_data[i].i_conf);
 641                                                 }
 642                                         }
 643
 644                                 }
 645                                 if (cplb_data[i].attr & D_CPLB) {
 646
 647                                         if (cplb_data[i].psize) {
 648                                                 fill_cplbtab(t_d,
 649                                                              cplb_data[i].start,
 650                                                              cplb_data[i].end,
 651                                                              cplb_data[i].psize,
 652                                                              cplb_data[i].d_conf);
 653                                         } else {
 654 /*dcplb_table*/
 655                                                 fill_cplbtab(t_d,
 656                                                              cplb_data[i].start,
 657                                                              a_start, SIZE_1M,
 658                                                              cplb_data[i].d_conf);
 659                                                 fill_cplbtab(t_d, a_start,
 660                                                              a_end, SIZE_4M,
 661                                                              cplb_data[i].d_conf);
 662                                                 fill_cplbtab(t_d, a_end,
 663                                                              cplb_data[i].end,
 664                                                              SIZE_1M,
 665                                                              cplb_data[i].d_conf);
 666
 667                                         }
 668
 669                                 }
 670                         }
 671                         }
 672
 673                 }
 674         }
 675
 676 /* close tables */
 677
 678         close_cplbtab(&cplb.init_i);
 679         close_cplbtab(&cplb.init_d);
 680
 681         cplb.init_i.tab[cplb.init_i.pos] = -1;
 682         cplb.init_d.tab[cplb.init_d.pos] = -1;
 683         cplb.switch_i.tab[cplb.switch_i.pos] = -1;
 684         cplb.switch_d.tab[cplb.switch_d.pos] = -1;
 685
 686 }
 687
 688 #endif
 689
 690 static inline u_long get_vco(void)
 691 {
 692         u_long msel;
 693         u_long vco;
 694
 695         msel = (bfin_read_PLL_CTL() >> 9) & 0x3F;
 696         if (0 == msel)
 697                 msel = 64;
 698
 699         vco = CONFIG_CLKIN_HZ;
 700         vco >>= (1 & bfin_read_PLL_CTL());      /* DF bit */
 701         vco = msel * vco;
 702         return vco;
 703 }
 704
 705 /*Get the Core clock*/
 706 u_long get_cclk(void)
 707 {
 708         u_long csel, ssel;
 709         if (bfin_read_PLL_STAT() & 0x1)
 710                 return CONFIG_CLKIN_HZ;
 711
 712         ssel = bfin_read_PLL_DIV();
 713         csel = ((ssel >> 4) & 0x03);
 714         ssel &= 0xf;
 715         if (ssel && ssel < (1 << csel)) /* SCLK > CCLK */
 716                 return get_vco() / ssel;
 717         return get_vco() >> csel;
 718 }
 719
 720 EXPORT_SYMBOL(get_cclk);
 721
 722 /* Get the System clock */
 723 u_long get_sclk(void)
 724 {
 725         u_long ssel;
 726
 727         if (bfin_read_PLL_STAT() & 0x1)
 728                 return CONFIG_CLKIN_HZ;
 729
 730         ssel = (bfin_read_PLL_DIV() & 0xf);
 731         if (0 == ssel) {
 732                 printk(KERN_WARNING "Invalid System Clock\n");
 733                 ssel = 1;
 734         }
 735
 736         return get_vco() / ssel;
 737 }
 738
 739 EXPORT_SYMBOL(get_sclk);
 740
 741 /*
 742  *      Get CPU information for use by the procfs.
 743  */
 744 static int show_cpuinfo(struct seq_file *m, void *v)
 745 {
 746         char *cpu, *mmu, *fpu, *name;
 747         uint32_t revid;
 748
 749         u_long cclk = 0, sclk = 0;
 750         u_int dcache_size = 0, dsup_banks = 0;
 751
 752         cpu = CPU;
 753         mmu = "none";
 754         fpu = "none";
 755         revid = bfin_revid();
 756         name = bfin_board_name;
 757
 758         cclk = get_cclk();
 759         sclk = get_sclk();
 760
 761         seq_printf(m, "CPU:\t\tADSP-%s Rev. 0.%d\n"
 762                    "MMU:\t\t%s\n"
 763                    "FPU:\t\t%s\n"
 764                    "Core Clock:\t%9lu Hz\n"
 765                    "System Clock:\t%9lu Hz\n"
 766                    "BogoMips:\t%lu.%02lu\n"
 767                    "Calibration:\t%lu loops\n",
 768                    cpu, revid, mmu, fpu,
 769                    cclk,
 770                    sclk,
 771                    (loops_per_jiffy * HZ) / 500000,
 772                    ((loops_per_jiffy * HZ) / 5000) % 100,
 773                    (loops_per_jiffy * HZ));
 774         seq_printf(m, "Board Name:\t%s\n", name);
 775         seq_printf(m, "Board Memory:\t%ld MB\n", physical_mem_end >> 20);
 776         seq_printf(m, "Kernel Memory:\t%ld MB\n", (unsigned long)_ramend >> 20);
 777         if (bfin_read_IMEM_CONTROL() & (ENICPLB | IMC))
 778                 seq_printf(m, "I-CACHE:\tON\n");
 779         else
 780                 seq_printf(m, "I-CACHE:\tOFF\n");
 781         if ((bfin_read_DMEM_CONTROL()) & (ENDCPLB | DMC_ENABLE))
 782                 seq_printf(m, "D-CACHE:\tON"
 783 #if defined CONFIG_BLKFIN_WB
 784                            " (write-back)"
 785 #elif defined CONFIG_BLKFIN_WT
 786                            " (write-through)"
 787 #endif
 788                            "\n");
 789         else
 790                 seq_printf(m, "D-CACHE:\tOFF\n");
 791
 792
 793         switch(bfin_read_DMEM_CONTROL() & (1 << DMC0_P | 1 << DMC1_P)) {
 794                 case ACACHE_BSRAM:
 795                         seq_printf(m, "DBANK-A:\tCACHE\n" "DBANK-B:\tSRAM\n");
 796                         dcache_size = 16;
 797                         dsup_banks = 1;
 798                         break;
 799                 case ACACHE_BCACHE:
 800                         seq_printf(m, "DBANK-A:\tCACHE\n" "DBANK-B:\tCACHE\n");
 801                         dcache_size = 32;
 802                         dsup_banks = 2;
 803                         break;
 804                 case ASRAM_BSRAM:
 805                         seq_printf(m, "DBANK-A:\tSRAM\n" "DBANK-B:\tSRAM\n");
 806                         dcache_size = 0;
 807                         dsup_banks = 0;
 808                         break;
 809                 default:
 810                 break;
 811         }
 812
 813
 814         seq_printf(m, "I-CACHE Size:\t%dKB\n", BLKFIN_ICACHESIZE / 1024);
 815         seq_printf(m, "D-CACHE Size:\t%dKB\n", dcache_size);
 816         seq_printf(m, "I-CACHE Setup:\t%d Sub-banks/%d Ways, %d Lines/Way\n",
 817                    BLKFIN_ISUBBANKS, BLKFIN_IWAYS, BLKFIN_ILINES);
 818         seq_printf(m,
 819                    "D-CACHE Setup:\t%d Super-banks/%d Sub-banks/%d Ways, %d Lines/Way\n",
 820                    dsup_banks, BLKFIN_DSUBBANKS, BLKFIN_DWAYS,
 821                    BLKFIN_DLINES);
 822 #ifdef CONFIG_BLKFIN_CACHE_LOCK
 823         switch (read_iloc()) {
 824         case WAY0_L:
 825                 seq_printf(m, "Way0 Locked-Down\n");
 826                 break;
 827         case WAY1_L:
 828                 seq_printf(m, "Way1 Locked-Down\n");
 829                 break;
 830         case WAY01_L:
 831                 seq_printf(m, "Way0,Way1 Locked-Down\n");
 832                 break;
 833         case WAY2_L:
 834                 seq_printf(m, "Way2 Locked-Down\n");
 835                 break;
 836         case WAY02_L:
 837                 seq_printf(m, "Way0,Way2 Locked-Down\n");
 838                 break;
 839         case WAY12_L:
 840                 seq_printf(m, "Way1,Way2 Locked-Down\n");
 841                 break;
 842         case WAY012_L:
 843                 seq_printf(m, "Way0,Way1 & Way2 Locked-Down\n");
 844                 break;
 845         case WAY3_L:
 846                 seq_printf(m, "Way3 Locked-Down\n");
 847                 break;
 848         case WAY03_L:
 849                 seq_printf(m, "Way0,Way3 Locked-Down\n");
 850                 break;
 851         case WAY13_L:
 852                 seq_printf(m, "Way1,Way3 Locked-Down\n");
 853                 break;
 854         case WAY013_L:
 855                 seq_printf(m, "Way 0,Way1,Way3 Locked-Down\n");
 856                 break;
 857         case WAY32_L:
 858                 seq_printf(m, "Way3,Way2 Locked-Down\n");
 859                 break;
 860         case WAY320_L:
 861                 seq_printf(m, "Way3,Way2,Way0 Locked-Down\n");
 862                 break;
 863         case WAY321_L:
 864                 seq_printf(m, "Way3,Way2,Way1 Locked-Down\n");
 865                 break;
 866         case WAYALL_L:
 867                 seq_printf(m, "All Ways are locked\n");
 868                 break;
 869         default:
 870                 seq_printf(m, "No Ways are locked\n");
 871         }
 872 #endif
 873         return 0;
 874 }
 875
 876 static void *c_start(struct seq_file *m, loff_t *pos)
 877 {
 878         return *pos < NR_CPUS ? ((void *)0x12345678) : NULL;
 879 }
 880
 881 static void *c_next(struct seq_file *m, void *v, loff_t *pos)
 882 {
 883         ++*pos;
 884         return c_start(m, pos);
 885 }
 886
 887 static void c_stop(struct seq_file *m, void *v)
 888 {
 889 }
 890
 891 struct seq_operations cpuinfo_op = {
 892         .start = c_start,
 893         .next = c_next,
 894         .stop = c_stop,
 895         .show = show_cpuinfo,
 896 };
 897
 898 void cmdline_init(unsigned long r0)
 899 {
 900         if (r0)
 901                 strncpy(command_line, (char *)r0, COMMAND_LINE_SIZE);
 902 }