1 /***************************************************************************
2 * Copyright (C) 2007 by Pavel Chromy *
5 * This program is free software; you can redistribute it and/or modify *
6 * it under the terms of the GNU General Public License as published by *
7 * the Free Software Foundation; either version 2 of the License, or *
8 * (at your option) any later version. *
10 * This program is distributed in the hope that it will be useful, *
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
13 * GNU General Public License for more details. *
15 * You should have received a copy of the GNU General Public License *
16 * along with this program; if not, write to the *
17 * Free Software Foundation, Inc., *
18 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
19 ***************************************************************************/
23 unsigned int flash_page_count=1024;
24 unsigned int flash_page_size=256;
26 /* pages per lock bit */
27 unsigned int flash_lock_pages=1024/16;
30 /* detect chip and set loader parameters */
35 nvpsiz=(inr(DBGU_CIDR)>>8)&0xf;
42 flash_lock_pages=256/8;
48 flash_lock_pages=512/16;
54 flash_lock_pages=512/8;
58 flash_page_count=1024;
60 flash_lock_pages=1024/16;
64 flash_page_count=2048;
66 flash_lock_pages=2048/32;
69 return FLASH_STAT_INITE;
75 /* program single flash page */
76 int flash_page_program(uint32 *data, int page_num)
84 /* select proper controller */
85 if (page_num>=1024) efc_ofs=0x10;
88 /* wait until FLASH is ready, just for sure */
89 while ((inr(MC_FSR+efc_ofs)&MC_FRDY)==0);
91 /* calculate page address, only lower 8 bits are used to address the latch,
92 but the upper part of address is needed for writing to proper EFC */
93 flash_ptr=(uint32 *)(FLASH_AREA_ADDR+(page_num*flash_page_size));
96 /* copy data to latch */
97 for (i=flash_page_size/4; i; i--) {
98 /* we do not use memcpy to be sure that only 32 bit access is used */
99 *(flash_ptr++)=*(data_ptr++);
102 /* page number and page write command to FCR */
103 outr(MC_FCR+efc_ofs, ((page_num&0x3ff)<<8) | MC_KEY | MC_FCMD_WP);
105 /* wait until it's done */
106 while ((inr(MC_FSR+efc_ofs)&MC_FRDY)==0);
108 /* check for errors */
109 if ((inr(MC_FSR+efc_ofs)&MC_PROGE)) return FLASH_STAT_PROGE;
110 if ((inr(MC_FSR+efc_ofs)&MC_LOCKE)) return FLASH_STAT_LOCKE;
113 /* verify written data */
114 flash_ptr=(uint32 *)(FLASH_AREA_ADDR+(page_num*flash_page_size));
117 for (i=flash_page_size/4; i; i--) {
118 if (*(flash_ptr++)!=*(data_ptr++)) return FLASH_STAT_VERIFE;
122 return FLASH_STAT_OK;
126 int flash_erase_plane(int efc_ofs)
128 unsigned int lockbits;
132 lockbits=inr(MC_FSR+efc_ofs)>>16;
136 /* wait until FLASH is ready, just for sure */
137 while ((inr(MC_FSR+efc_ofs)&MC_FRDY)==0);
139 outr(MC_FCR+efc_ofs, ((page_num&0x3ff)<<8) | 0x5a000004);
141 /* wait until it's done */
142 while ((inr(MC_FSR+efc_ofs)&MC_FRDY)==0);
144 /* check for errors */
145 if ((inr(MC_FSR+efc_ofs)&MC_PROGE)) return FLASH_STAT_PROGE;
146 if ((inr(MC_FSR+efc_ofs)&MC_LOCKE)) return FLASH_STAT_LOCKE;
149 if ((page_num+=flash_lock_pages)>flash_page_count) break;
153 /* wait until FLASH is ready, just for sure */
154 while ((inr(MC_FSR+efc_ofs)&MC_FRDY)==0);
156 /* erase all command to FCR */
157 outr(MC_FCR+efc_ofs, 0x5a000008);
159 /* wait until it's done */
160 while ((inr(MC_FSR+efc_ofs)&MC_FRDY)==0);
162 /* check for errors */
163 if ((inr(MC_FSR+efc_ofs)&MC_PROGE)) return FLASH_STAT_PROGE;
164 if ((inr(MC_FSR+efc_ofs)&MC_LOCKE)) return FLASH_STAT_LOCKE;
166 /* set no erase before programming */
167 outr(MC_FMR+efc_ofs, inr(MC_FMR+efc_ofs)|0x80);
169 return FLASH_STAT_OK;
173 /* erase whole chip */
174 int flash_erase_all(void)
178 if ((result=flash_erase_plane(0)) != FLASH_STAT_OK) return result;
180 /* the second flash controller, if any */
181 if (flash_page_count>1024) result=flash_erase_plane(0x10);
187 int flash_verify(uint32 adr, unsigned int len, uint8 *src)
189 unsigned char *flash_ptr;
191 flash_ptr=(uint8 *)FLASH_AREA_ADDR+adr;
193 if (*(flash_ptr++)!=*(src++)) return FLASH_STAT_VERIFE;
195 return FLASH_STAT_OK;