LXR uboot/board/esd/cpci405/flash.c

   1/*
   2 * (C) Copyright 2001-2003
   3 * Stefan Roese, esd gmbh germany, stefan.roese@esd-electronics.com
   4 *
   5 * See file CREDITS for list of people who contributed to this
   6 * project.
   7 *
   8 * This program is free software; you can redistribute it and/or
   9 * modify it under the terms of the GNU General Public License as
  10 * published by the Free Software Foundation; either version 2 of
  11 * the License, or (at your option) any later version.
  12 *
  13 * This program is distributed in the hope that it will be useful,
  14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16 * GNU General Public License for more details.
  17 *
  18 * You should have received a copy of the GNU General Public License
  19 * along with this program; if not, write to the Free Software
  20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  21 * MA 02111-1307 USA
  22 */
  23
  24#include <common.h>
  25#include <asm/ppc4xx.h>
  26#include <asm/processor.h>
  27
  28/*
  29 * include common flash code (for esd boards)
  30 */
  31#include "../common/flash.c"
  32
  33/*-----------------------------------------------------------------------
  34 * Functions
  35 */
  36static ulong flash_get_size (vu_long * addr, flash_info_t * info);
  37static void flash_get_offsets (ulong base, flash_info_t * info);
  38
  39/*-----------------------------------------------------------------------
  40 */
  41
  42unsigned long calc_size(unsigned long size)
  43{
  44        switch (size) {
  45        case 1 << 20:
  46                return 0;
  47        case 2 << 20:
  48                return 1;
  49        case 4 << 20:
  50                return 2;
  51        case 8 << 20:
  52                return 3;
  53        case 16 << 20:
  54                return 4;
  55        default:
  56                return 0;
  57        }
  58}
  59
  60
  61unsigned long flash_init (void)
  62{
  63        unsigned long size_b0, size_b1;
  64        int i;
  65        uint pbcr;
  66        unsigned long base_b0, base_b1;
  67
  68        /* Init: no FLASHes known */
  69        for (i = 0; i < CONFIG_SYS_MAX_FLASH_BANKS; ++i) {
  70                flash_info[i].flash_id = FLASH_UNKNOWN;
  71        }
  72
  73        /* Static FLASH Bank configuration here - FIXME XXX */
  74
  75        base_b0 = FLASH_BASE0_PRELIM;
  76        size_b0 = flash_get_size ((vu_long *) base_b0, &flash_info[0]);
  77
  78        if (flash_info[0].flash_id == FLASH_UNKNOWN) {
  79                printf ("## Unknown FLASH on Bank 0 - Size = 0x%08lx = %ld MB\n",
  80                                size_b0, size_b0 << 20);
  81        }
  82
  83        base_b1 = FLASH_BASE1_PRELIM;
  84        size_b1 = flash_get_size ((vu_long *) base_b1, &flash_info[1]);
  85
  86        /* Re-do sizing to get full correct info */
  87
  88        if (size_b1) {
  89                if (size_b1 < (1 << 20)) {
  90                        /* minimum CS size on PPC405GP is 1MB !!! */
  91                        size_b1 = 1 << 20;
  92                }
  93                base_b1 = -size_b1;
  94                mtdcr (EBC0_CFGADDR, PB0CR);
  95                pbcr = mfdcr (EBC0_CFGDATA);
  96                mtdcr (EBC0_CFGADDR, PB0CR);
  97                pbcr = (pbcr & 0x0001ffff) | base_b1 | (calc_size(size_b1) << 17);
  98                mtdcr (EBC0_CFGDATA, pbcr);
  99#if 0 /* test-only */
 100                printf("size_b1=%x base_b1=%x PB1CR = %x\n",
 101                       size_b1, base_b1, pbcr); /* test-only */
 102#endif
 103        }
 104
 105        if (size_b0) {
 106                if (size_b0 < (1 << 20)) {
 107                        /* minimum CS size on PPC405GP is 1MB !!! */
 108                        size_b0 = 1 << 20;
 109                }
 110                base_b0 = base_b1 - size_b0;
 111                mtdcr (EBC0_CFGADDR, PB1CR);
 112                pbcr = mfdcr (EBC0_CFGDATA);
 113                mtdcr (EBC0_CFGADDR, PB1CR);
 114                pbcr = (pbcr & 0x0001ffff) | base_b0 | (calc_size(size_b0) << 17);
 115                mtdcr (EBC0_CFGDATA, pbcr);
 116#if 0 /* test-only */
 117                printf("size_b0=%x base_b0=%x PB0CR = %x\n",
 118                       size_b0, base_b0, pbcr); /* test-only */
 119#endif
 120        }
 121
 122        size_b0 = flash_get_size ((vu_long *) base_b0, &flash_info[0]);
 123
 124        flash_get_offsets (base_b0, &flash_info[0]);
 125
 126        /* monitor protection ON by default */
 127        flash_protect (FLAG_PROTECT_SET,
 128                        base_b0 + size_b0 - monitor_flash_len,
 129                        base_b0 + size_b0 - 1, &flash_info[0]);
 130
 131        if (size_b1) {
 132                /* Re-do sizing to get full correct info */
 133                size_b1 = flash_get_size ((vu_long *) base_b1, &flash_info[1]);
 134
 135                flash_get_offsets (base_b1, &flash_info[1]);
 136
 137                /* monitor protection ON by default */
 138                flash_protect (FLAG_PROTECT_SET,
 139                                base_b1 + size_b1 - monitor_flash_len,
 140                                base_b1 + size_b1 - 1, &flash_info[1]);
 141                /* monitor protection OFF by default (one is enough) */
 142                flash_protect (FLAG_PROTECT_CLEAR,
 143                                base_b0 + size_b0 - monitor_flash_len,
 144                                base_b0 + size_b0 - 1, &flash_info[0]);
 145        } else {
 146                flash_info[1].flash_id = FLASH_UNKNOWN;
 147                flash_info[1].sector_count = -1;
 148        }
 149
 150        flash_info[0].size = size_b0;
 151        flash_info[1].size = size_b1;
 152
 153        return (size_b0 + size_b1);
 154}
 155