Change return value on error.
[fw/openocd] / src / flash / nor / lpc288x.c
1 /***************************************************************************
2  *   Copyright (C) 2008 by                                                             *
3  *   Karl RobinSod <karl.robinsod@gmail.com>                               *
4  *                                                                         *
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.                                   *
9  *                                                                         *
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.                          *
14  *                                                                         *
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  ***************************************************************************/
20
21 /***************************************************************************
22 * There are some things to notice
23 *
24 * You need to unprotect flash sectors each time you connect the OpenOCD
25 * Dumping 1MB takes about 60 Seconds
26 * Full erase (sectors 0-22 inclusive) takes 2-4 seconds
27 * Writing 1MB takes 88 seconds
28 *
29  ***************************************************************************/
30 #ifdef HAVE_CONFIG_H
31 #include "config.h"
32 #endif
33
34 #include "imp.h"
35 #include <helper/binarybuffer.h>
36
37
38 #define LOAD_TIMER_ERASE        0
39 #define LOAD_TIMER_WRITE        1
40
41 #define FLASH_PAGE_SIZE         512
42
43 /* LPC288X control registers */
44 #define DBGU_CIDR               0x8000507C
45 /* LPC288X flash registers */
46 #define F_CTRL                  0x80102000      /* Flash control register R/W 0x5 */
47 #define F_STAT                  0x80102004      /* Flash status register RO 0x45 */
48 #define F_PROG_TIME             0x80102008      /* Flash program time register R/W 0 */
49 #define F_WAIT                  0x80102010      /* Flash read wait state register R/W 0xC004 */
50 #define F_CLK_TIME              0x8010201C      /* Flash clock divider for 66 kHz generation R/W 0 */
51 #define F_INTEN_CLR             0x80102FD8      /* Clear interrupt enable bits WO - */
52 #define F_INTEN_SET             0x80102FDC      /* Set interrupt enable bits WO - */
53 #define F_INT_STAT              0x80102FE0      /* Interrupt status bits RO 0 */
54 #define F_INTEN                 0x80102FE4      /* Interrupt enable bits RO 0 */
55 #define F_INT_CLR               0x80102FE8      /* Clear interrupt status bits WO */
56 #define F_INT_SET               0x80102FEC      /* Set interrupt status bits WO - */
57 #define FLASH_PD                0x80005030      /* Allows turning off the Flash memory for power savings. R/W 1*/
58 #define FLASH_INIT              0x80005034      /* Monitors Flash readiness, such as recovery from Power Down mode. R/W -*/
59
60 /* F_CTRL bits */
61 #define FC_CS                   0x0001
62 #define FC_FUNC                 0x0002
63 #define FC_WEN                  0x0004
64 #define FC_RD_LATCH             0x0020
65 #define FC_PROTECT              0x0080
66 #define FC_SET_DATA             0x0400
67 #define FC_RSSL                 0x0800
68 #define FC_PROG_REQ             0x1000
69 #define FC_CLR_BUF              0x4000
70 #define FC_LOAD_REQ             0x8000
71 /* F_STAT bits */
72 #define FS_DONE                 0x0001
73 #define FS_PROGGNT              0x0002
74 #define FS_RDY                  0x0004
75 #define FS_ERR                  0x0020
76 /* F_PROG_TIME */
77 #define FPT_TIME_MASK   0x7FFF
78
79 #define FPT_ENABLE              0x8000
80 /* F_WAIT */
81 #define FW_WAIT_STATES_MASK             0x00FF
82 #define FW_SET_MASK                             0xC000
83
84 /* F_CLK_TIME */
85 #define FCT_CLK_DIV_MASK    0x0FFF
86
87 struct lpc288x_flash_bank
88 {
89         uint32_t working_area;
90         uint32_t working_area_size;
91
92         /* chip id register */
93         uint32_t cidr;
94         const char * target_name;
95         uint32_t cclk;
96
97         uint32_t sector_size_break;
98 };
99
100 static uint32_t lpc288x_wait_status_busy(struct flash_bank *bank, int timeout);
101 static void lpc288x_load_timer(int erase, struct target *target);
102 static void lpc288x_set_flash_clk(struct flash_bank *bank);
103 static uint32_t lpc288x_system_ready(struct flash_bank *bank);
104
105 static uint32_t lpc288x_wait_status_busy(struct flash_bank *bank, int timeout)
106 {
107         uint32_t status;
108         struct target *target = bank->target;
109         do
110         {
111                 alive_sleep(1);
112                 timeout--;
113                 target_read_u32(target, F_STAT, &status);
114         } while (((status & FS_DONE) == 0) && timeout);
115
116         if (timeout == 0)
117         {
118                 LOG_DEBUG("Timedout!");
119                 return ERROR_FLASH_OPERATION_FAILED;
120         }
121         return ERROR_OK;
122 }
123
124 /* Read device id register and fill in driver info structure */
125 static int lpc288x_read_part_info(struct flash_bank *bank)
126 {
127         struct lpc288x_flash_bank *lpc288x_info = bank->driver_priv;
128         struct target *target = bank->target;
129         uint32_t cidr;
130
131         int i = 0;
132         uint32_t offset;
133
134         if (lpc288x_info->cidr == 0x0102100A)
135                 return ERROR_OK; /* already probed, multiple probes may cause memory leak, not allowed */
136
137         /* Read and parse chip identification register */
138         target_read_u32(target, DBGU_CIDR, &cidr);
139
140         if (cidr != 0x0102100A)
141         {
142                 LOG_WARNING("Cannot identify target as an LPC288X (%08" PRIx32 ")",cidr);
143                 return ERROR_FLASH_OPERATION_FAILED;
144         }
145
146         lpc288x_info->cidr = cidr;
147         lpc288x_info->sector_size_break = 0x000F0000;
148         lpc288x_info->target_name = "LPC288x";
149
150         /* setup the sector info... */
151         offset = bank->base;
152         bank->num_sectors = 23;
153         bank->sectors = malloc(sizeof(struct flash_sector) * 23);
154
155         for (i = 0; i < 15; i++)
156         {
157                 bank->sectors[i].offset = offset;
158                 bank->sectors[i].size = 64 * 1024;
159                 offset += bank->sectors[i].size;
160                 bank->sectors[i].is_erased = -1;
161                 bank->sectors[i].is_protected = 1;
162         }
163         for (i = 15; i < 23; i++)
164         {
165                 bank->sectors[i].offset = offset;
166                 bank->sectors[i].size = 8 * 1024;
167                 offset += bank->sectors[i].size;
168                 bank->sectors[i].is_erased = -1;
169                 bank->sectors[i].is_protected = 1;
170         }
171
172         return ERROR_OK;
173 }
174
175 static int lpc288x_protect_check(struct flash_bank *bank)
176 {
177         return ERROR_OK;
178 }
179
180 /* flash_bank LPC288x 0 0 0 0 <target#> <cclk> */
181 FLASH_BANK_COMMAND_HANDLER(lpc288x_flash_bank_command)
182 {
183         struct lpc288x_flash_bank *lpc288x_info;
184
185         if (CMD_ARGC < 6)
186         {
187                 return ERROR_COMMAND_SYNTAX_ERROR;
188         }
189
190         lpc288x_info = malloc(sizeof(struct lpc288x_flash_bank));
191         bank->driver_priv = lpc288x_info;
192
193         /* part wasn't probed for info yet */
194         lpc288x_info->cidr = 0;
195         COMMAND_PARSE_NUMBER(u32, CMD_ARGV[6], lpc288x_info->cclk);
196
197         return ERROR_OK;
198 }
199
200 /* The frequency is the AHB clock frequency divided by (CLK_DIV ×3) + 1.
201  * This must be programmed such that the Flash Programming clock frequency is 66 kHz ± 20%.
202  * AHB = 12 MHz ?
203  * 12000000/66000 = 182
204  * CLK_DIV = 60 ? */
205 static void lpc288x_set_flash_clk(struct flash_bank *bank)
206 {
207         uint32_t clk_time;
208         struct lpc288x_flash_bank *lpc288x_info = bank->driver_priv;
209         clk_time = (lpc288x_info->cclk / 66000) / 3;
210         target_write_u32(bank->target, F_CTRL, FC_CS | FC_WEN);
211         target_write_u32(bank->target, F_CLK_TIME, clk_time);
212 }
213
214 /* AHB tcyc (in ns) 83 ns
215  * LOAD_TIMER_ERASE             FPT_TIME        = ((400,000,000 / AHB tcyc (in ns)) - 2) / 512
216  *                                                                      = 9412 (9500) (AN10548 9375)
217  * LOAD_TIMER_WRITE             FPT_TIME        = ((1,000,000 / AHB tcyc (in ns)) - 2) / 512
218  *                                                                      = 23 (75) (AN10548 72 - is this wrong?)
219  * TODO: Sort out timing calcs ;) */
220 static void lpc288x_load_timer(int erase, struct target *target)
221 {
222         if (erase == LOAD_TIMER_ERASE)
223         {
224                 target_write_u32(target, F_PROG_TIME, FPT_ENABLE | 9500);
225         }
226         else
227         {
228                 target_write_u32(target, F_PROG_TIME, FPT_ENABLE | 75);
229         }
230 }
231
232 static uint32_t lpc288x_system_ready(struct flash_bank *bank)
233 {
234         struct lpc288x_flash_bank *lpc288x_info = bank->driver_priv;
235         if (lpc288x_info->cidr == 0)
236         {
237                 return ERROR_FLASH_BANK_NOT_PROBED;
238         }
239
240         if (bank->target->state != TARGET_HALTED)
241         {
242                 LOG_ERROR("Target not halted");
243                 return ERROR_TARGET_NOT_HALTED;
244         }
245         return ERROR_OK;
246 }
247
248 static int lpc288x_erase_check(struct flash_bank *bank)
249 {
250         uint32_t status = lpc288x_system_ready(bank);   /* probed? halted? */
251         if (status != ERROR_OK)
252         {
253                 LOG_INFO("Processor not halted/not probed");
254                 return status;
255         }
256
257         return ERROR_OK;
258 }
259
260 static int lpc288x_erase(struct flash_bank *bank, int first, int last)
261 {
262         uint32_t status;
263         int sector;
264         struct target *target = bank->target;
265
266         status = lpc288x_system_ready(bank);    /* probed? halted? */
267         if (status != ERROR_OK)
268         {
269                 return status;
270         }
271
272         if ((first < 0) || (last < first) || (last >= bank->num_sectors))
273         {
274                 LOG_INFO("Bad sector range");
275                 return ERROR_FLASH_SECTOR_INVALID;
276         }
277
278         /* Configure the flash controller timing */
279         lpc288x_set_flash_clk(bank);
280
281         for (sector = first; sector <= last; sector++)
282         {
283                 if (lpc288x_wait_status_busy(bank, 1000) != ERROR_OK)
284                 {
285                         return ERROR_FLASH_OPERATION_FAILED;
286                 }
287
288                 lpc288x_load_timer(LOAD_TIMER_ERASE,target);
289
290                 target_write_u32(target, bank->sectors[sector].offset, 0x00);
291
292                 target_write_u32(target, F_CTRL, FC_PROG_REQ | FC_PROTECT | FC_CS);
293         }
294         if (lpc288x_wait_status_busy(bank, 1000) != ERROR_OK)
295         {
296                 return ERROR_FLASH_OPERATION_FAILED;
297         }
298         return ERROR_OK;
299 }
300
301 static int lpc288x_write(struct flash_bank *bank, uint8_t *buffer, uint32_t offset, uint32_t count)
302 {
303         uint8_t page_buffer[FLASH_PAGE_SIZE];
304         uint32_t status, source_offset,dest_offset;
305         struct target *target = bank->target;
306         uint32_t bytes_remaining = count;
307         uint32_t first_sector, last_sector, sector, page;
308         int i;
309
310         /* probed? halted? */
311         status = lpc288x_system_ready(bank);
312         if (status != ERROR_OK)
313         {
314                 return status;
315         }
316
317         /* Initialise search indices */
318         first_sector = last_sector = 0xffffffff;
319
320         /* validate the write range... */
321         for (i = 0; i < bank->num_sectors; i++)
322         {
323                 if ((offset >= bank->sectors[i].offset) &&
324                         (offset < (bank->sectors[i].offset + bank->sectors[i].size)) &&
325                         (first_sector == 0xffffffff))
326                 {
327                         first_sector = i;
328                         /* all writes must start on a sector boundary... */
329                         if (offset % bank->sectors[i].size)
330                         {
331                                 LOG_INFO("offset 0x%" PRIx32 " breaks required alignment 0x%" PRIx32 "", offset, bank->sectors[i].size);
332                                 return ERROR_FLASH_DST_BREAKS_ALIGNMENT;
333                         }
334                 }
335                 if (((offset + count) > bank->sectors[i].offset) &&
336                         ((offset + count) <= (bank->sectors[i].offset + bank->sectors[i].size)) &&
337                         (last_sector == 0xffffffff))
338                 {
339                         last_sector = i;
340                 }
341         }
342
343         /* Range check... */
344         if (first_sector == 0xffffffff || last_sector == 0xffffffff)
345         {
346                 LOG_INFO("Range check failed %" PRIx32 " %" PRIx32 "", offset, count);
347                 return ERROR_FLASH_DST_OUT_OF_BANK;
348         }
349
350         /* Configure the flash controller timing */
351         lpc288x_set_flash_clk(bank);
352
353         /* initialise the offsets */
354         source_offset = 0;
355         dest_offset = 0;
356
357         for (sector = first_sector; sector <= last_sector; sector++)
358         {
359                 for (page = 0; page < bank->sectors[sector].size / FLASH_PAGE_SIZE; page++)
360                 {
361                         if (bytes_remaining == 0)
362                         {
363                                 count = 0;
364                                 memset(page_buffer, 0xFF, FLASH_PAGE_SIZE);
365                         }
366                         else if (bytes_remaining < FLASH_PAGE_SIZE)
367                         {
368                                 count = bytes_remaining;
369                                 memset(page_buffer, 0xFF, FLASH_PAGE_SIZE);
370                                 memcpy(page_buffer, &buffer[source_offset], count);
371                         }
372                         else
373                         {
374                                 count = FLASH_PAGE_SIZE;
375                                 memcpy(page_buffer, &buffer[source_offset], count);
376                         }
377
378                         /* Wait for flash to become ready */
379                         if (lpc288x_wait_status_busy(bank, 1000) != ERROR_OK)
380                         {
381                                 return ERROR_FLASH_OPERATION_FAILED;
382                         }
383
384                         /* fill flash data latches with 1's */
385                         target_write_u32(target, F_CTRL, FC_CS | FC_SET_DATA | FC_WEN | FC_FUNC);
386
387                         target_write_u32(target, F_CTRL, FC_CS | FC_WEN | FC_FUNC);
388                         /*would be better to use the clean target_write_buffer() interface but
389                          * it seems not to be a LOT slower....
390                          * bulk_write_memory() is no quicker :(*/
391 #if 1
392                         if (target_write_memory(target, offset + dest_offset, 4, 128, page_buffer) != ERROR_OK)
393                         {
394                                 LOG_ERROR("Write failed s %" PRIx32 " p %" PRIx32 "", sector, page);
395                                 return ERROR_FLASH_OPERATION_FAILED;
396                         }
397 #else
398                         if (target_write_buffer(target, offset + dest_offset, FLASH_PAGE_SIZE, page_buffer) != ERROR_OK)
399                         {
400                                 LOG_INFO("Write to flash buffer failed");
401                                 return ERROR_FLASH_OPERATION_FAILED;
402                         }
403 #endif
404                         dest_offset += FLASH_PAGE_SIZE;
405                         source_offset += count;
406                         bytes_remaining -= count;
407
408                         lpc288x_load_timer(LOAD_TIMER_WRITE, target);
409
410                         target_write_u32(target, F_CTRL, FC_PROG_REQ | FC_PROTECT | FC_FUNC | FC_CS);
411                 }
412         }
413
414         return ERROR_OK;
415 }
416
417 static int lpc288x_probe(struct flash_bank *bank)
418 {
419         /* we only deal with LPC2888 so flash config is fixed */
420         struct lpc288x_flash_bank *lpc288x_info = bank->driver_priv;
421         int retval;
422
423         if (lpc288x_info->cidr != 0)
424         {
425                 return ERROR_OK; /* already probed */
426         }
427
428         if (bank->target->state != TARGET_HALTED)
429         {
430                 LOG_ERROR("Target not halted");
431                 return ERROR_TARGET_NOT_HALTED;
432         }
433
434         retval = lpc288x_read_part_info(bank);
435         if (retval != ERROR_OK)
436                 return retval;
437         return ERROR_OK;
438 }
439
440 static int lpc288x_info(struct flash_bank *bank, char *buf, int buf_size)
441 {
442         snprintf(buf, buf_size, "lpc288x flash driver");
443         return ERROR_OK;
444 }
445
446 static int lpc288x_protect(struct flash_bank *bank, int set, int first, int last)
447 {
448         int lockregion, status;
449         uint32_t value;
450         struct target *target = bank->target;
451
452         /* probed? halted? */
453         status = lpc288x_system_ready(bank);
454         if (status != ERROR_OK)
455         {
456                 return status;
457         }
458
459         if ((first < 0) || (last < first) || (last >= bank->num_sectors))
460         {
461                 return ERROR_FLASH_SECTOR_INVALID;
462         }
463
464         /* Configure the flash controller timing */
465         lpc288x_set_flash_clk(bank);
466
467         for (lockregion = first; lockregion <= last; lockregion++)
468         {
469                 if (set)
470                 {
471                         /* write an odd value to base addy to protect... */
472                         value = 0x01;
473                 }
474                 else
475                 {
476                         /* write an even value to base addy to unprotect... */
477                         value = 0x00;
478                 }
479                 target_write_u32(target, bank->sectors[lockregion].offset, value);
480                 target_write_u32(target, F_CTRL, FC_LOAD_REQ | FC_PROTECT | FC_WEN | FC_FUNC | FC_CS);
481         }
482
483         return ERROR_OK;
484 }
485
486 struct flash_driver lpc288x_flash = {
487         .name = "lpc288x",
488         .flash_bank_command = lpc288x_flash_bank_command,
489         .erase = lpc288x_erase,
490         .protect = lpc288x_protect,
491         .write = lpc288x_write,
492         .read = default_flash_read,
493         .probe = lpc288x_probe,
494         .auto_probe = lpc288x_probe,
495         .erase_check = lpc288x_erase_check,
496         .protect_check = lpc288x_protect_check,
497         .info = lpc288x_info,
498 };