PageRenderTime 30ms CodeModel.GetById 15ms app.highlight 11ms RepoModel.GetById 1ms app.codeStats 1ms

/board/esd/ocrtc/flash.c

https://gitlab.com/vogoplayer-tools/uboot
C | 156 lines | 96 code | 21 blank | 39 comment | 9 complexity | 65a3ecaaea83582e4ff2b16ac0fafb29 MD5 | raw file
  1/*
  2 * (C) Copyright 2001
  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 <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 flash_init (void)
 43{
 44	unsigned long size_b0, size_b1;
 45	int i;
 46	uint pbcr;
 47	unsigned long base_b0, base_b1;
 48	int size_val = 0;
 49
 50	/* Init: no FLASHes known */
 51	for (i = 0; i < CFG_MAX_FLASH_BANKS; ++i) {
 52		flash_info[i].flash_id = FLASH_UNKNOWN;
 53	}
 54
 55	/* Static FLASH Bank configuration here - FIXME XXX */
 56
 57	base_b0 = FLASH_BASE0_PRELIM;
 58	size_b0 = flash_get_size ((vu_long *) base_b0, &flash_info[0]);
 59
 60	if (flash_info[0].flash_id == FLASH_UNKNOWN) {
 61		printf ("## Unknown FLASH on Bank 0 - Size = 0x%08lx = %ld MB\n",
 62			size_b0, size_b0 << 20);
 63	}
 64
 65	base_b1 = FLASH_BASE1_PRELIM;
 66	size_b1 = flash_get_size ((vu_long *) base_b1, &flash_info[1]);
 67
 68	/* Re-do sizing to get full correct info */
 69
 70	if (size_b1) {
 71		mtdcr (ebccfga, pb0cr);
 72		pbcr = mfdcr (ebccfgd);
 73		mtdcr (ebccfga, pb0cr);
 74		base_b1 = -size_b1;
 75		switch (size_b1) {
 76		case 1 << 20:
 77			size_val = 0;
 78			break;
 79		case 2 << 20:
 80			size_val = 1;
 81			break;
 82		case 4 << 20:
 83			size_val = 2;
 84			break;
 85		case 8 << 20:
 86			size_val = 3;
 87			break;
 88		case 16 << 20:
 89			size_val = 4;
 90			break;
 91		}
 92		pbcr = (pbcr & 0x0001ffff) | base_b1 | (size_val << 17);
 93		mtdcr (ebccfgd, pbcr);
 94		/*          printf("pb1cr = %x\n", pbcr); */
 95	}
 96
 97	if (size_b0) {
 98		mtdcr (ebccfga, pb1cr);
 99		pbcr = mfdcr (ebccfgd);
100		mtdcr (ebccfga, pb1cr);
101		base_b0 = base_b1 - size_b0;
102		switch (size_b1) {
103		case 1 << 20:
104			size_val = 0;
105			break;
106		case 2 << 20:
107			size_val = 1;
108			break;
109		case 4 << 20:
110			size_val = 2;
111			break;
112		case 8 << 20:
113			size_val = 3;
114			break;
115		case 16 << 20:
116			size_val = 4;
117			break;
118		}
119		pbcr = (pbcr & 0x0001ffff) | base_b0 | (size_val << 17);
120		mtdcr (ebccfgd, pbcr);
121		/*            printf("pb0cr = %x\n", pbcr); */
122	}
123
124	size_b0 = flash_get_size ((vu_long *) base_b0, &flash_info[0]);
125
126	flash_get_offsets (base_b0, &flash_info[0]);
127
128	/* monitor protection ON by default */
129	flash_protect (FLAG_PROTECT_SET,
130			base_b0 + size_b0 - monitor_flash_len,
131			base_b0 + size_b0 - 1, &flash_info[0]);
132
133	if (size_b1) {
134		/* Re-do sizing to get full correct info */
135		size_b1 = flash_get_size ((vu_long *) base_b1, &flash_info[1]);
136
137		flash_get_offsets (base_b1, &flash_info[1]);
138
139		/* monitor protection ON by default */
140		flash_protect (FLAG_PROTECT_SET,
141				base_b1 + size_b1 - monitor_flash_len,
142				base_b1 + size_b1 - 1, &flash_info[1]);
143		/* monitor protection OFF by default (one is enough) */
144		flash_protect (FLAG_PROTECT_CLEAR,
145				base_b0 + size_b0 - monitor_flash_len,
146				base_b0 + size_b0 - 1, &flash_info[0]);
147	} else {
148		flash_info[1].flash_id = FLASH_UNKNOWN;
149		flash_info[1].sector_count = -1;
150	}
151
152	flash_info[0].size = size_b0;
153	flash_info[1].size = size_b1;
154
155	return (size_b0 + size_b1);
156}