1 // SPDX-License-Identifier: GPL-2.0-or-later
3 /***************************************************************************
4 * Copyright (C) 2006 by Magnus Lundin *
7 * Copyright (C) 2008 by Gheorghe Guran (atlas) *
8 ****************************************************************************/
10 /***************************************************************************
12 * New flash setup command:
14 * flash bank <driver> <base_addr> <size> <chip_width> <bus_width> <target_id>
15 * [<chip_type> <banks>
16 * <sectors_per_bank> <pages_per_sector>
17 * <page_size> <num_nvmbits>
20 * <ext_freq_khz> - MUST be used if clock is from external source,
21 * CAN be used if main oscillator frequency is known (recommended)
23 * ==== RECOMMENDED (covers clock speed) ============
24 * flash bank at91sam7 0x00100000 0 0 4 $_TARGETNAME AT91SAM7XC256 1 16 64 256 3 25000
25 * (if auto-detect fails; provides clock spec)
26 * flash bank at91sam7 0 0 0 0 $_TARGETNAME 0 0 0 0 0 0 25000
27 * (auto-detect everything except the clock)
28 * ==== NOT RECOMMENDED !!! (clock speed is not configured) ====
29 * flash bank at91sam7 0x00100000 0 0 4 $_TARGETNAME AT91SAM7XC256 1 16 64 256 3 0
30 * (if auto-detect fails)
31 * flash bank at91sam7 0 0 0 0 $_TARGETNAME
32 * (old style, auto-detect everything)
33 ****************************************************************************/
40 #include <helper/binarybuffer.h>
42 /* AT91SAM7 control registers */
43 #define DBGU_CIDR 0xFFFFF240
44 #define CKGR_MCFR 0xFFFFFC24
45 #define CKGR_MOR 0xFFFFFC20
46 #define CKGR_MCFR_MAINRDY 0x10000
47 #define CKGR_PLLR 0xFFFFFC2c
48 #define CKGR_PLLR_DIV 0xff
49 #define CKGR_PLLR_MUL 0x07ff0000
50 #define PMC_MCKR 0xFFFFFC30
51 #define PMC_MCKR_CSS 0x03
52 #define PMC_MCKR_PRES 0x1c
54 /* Flash Controller Commands */
64 /* MC_FSR bit definitions */
68 /* AT91SAM7 constants */
71 /* Flash timing modes */
72 #define FMR_TIMING_NONE 0
73 #define FMR_TIMING_NVBITS 1
74 #define FMR_TIMING_FLASH 2
76 /* Flash size constants */
77 #define FLASH_SIZE_8KB 1
78 #define FLASH_SIZE_16KB 2
79 #define FLASH_SIZE_32KB 3
80 #define FLASH_SIZE_64KB 5
81 #define FLASH_SIZE_128KB 7
82 #define FLASH_SIZE_256KB 9
83 #define FLASH_SIZE_512KB 10
84 #define FLASH_SIZE_1024KB 12
85 #define FLASH_SIZE_2048KB 14
87 static int at91sam7_protect_check(struct flash_bank
*bank
);
88 static int at91sam7_write(struct flash_bank
*bank
, const uint8_t *buffer
, uint32_t offset
,
91 static uint32_t at91sam7_get_flash_status(struct target
*target
, int bank_number
);
92 static void at91sam7_set_flash_mode(struct flash_bank
*bank
, int mode
);
93 static uint32_t at91sam7_wait_status_busy(struct flash_bank
*bank
, uint32_t waitbits
, int timeout
);
94 static int at91sam7_flash_command(struct flash_bank
*bank
, uint8_t cmd
, uint16_t pagen
);
96 static const uint32_t mc_fmr
[4] = { 0xFFFFFF60, 0xFFFFFF70, 0xFFFFFF80, 0xFFFFFF90 };
97 static const uint32_t mc_fcr
[4] = { 0xFFFFFF64, 0xFFFFFF74, 0xFFFFFF84, 0xFFFFFF94 };
98 static const uint32_t mc_fsr
[4] = { 0xFFFFFF68, 0xFFFFFF78, 0xFFFFFF88, 0xFFFFFF98 };
100 static const char *eproc
[8] = {
101 "Unknown", "ARM946-E", "ARM7TDMI", "Unknown", "ARM920T", "ARM926EJ-S", "Unknown", "Unknown"
104 struct at91sam7_flash_bank
{
105 /* chip id register */
108 uint16_t cidr_nvptyp
;
110 uint16_t cidr_sramsiz
;
111 uint16_t cidr_nvpsiz
;
112 uint16_t cidr_nvpsiz2
;
114 uint16_t cidr_version
;
115 const char *target_name
;
117 /* flash auto-detection */
118 uint8_t flash_autodetection
;
121 uint16_t pages_per_sector
;
123 uint16_t pages_in_lockregion
;
126 uint16_t num_lockbits_on
;
128 uint16_t num_nvmbits
;
129 uint16_t num_nvmbits_on
;
134 * 1: fmcn for nvbits (1uS)
135 * 2: fmcn for flash (1.5uS) */
138 /* main clock status */
142 /* external clock frequency */
148 static long SRAMSIZ
[16] = {
168 static uint32_t at91sam7_get_flash_status(struct target
*target
, int bank_number
)
171 target_read_u32(target
, mc_fsr
[bank_number
], &fsr
);
176 /* Read clock configuration and set at91sam7_info->mck_freq */
177 static void at91sam7_read_clock_info(struct flash_bank
*bank
)
179 struct at91sam7_flash_bank
*at91sam7_info
= bank
->driver_priv
;
180 struct target
*target
= bank
->target
;
181 uint32_t mckr
, mcfr
, pllr
, mor
;
182 unsigned long tmp
= 0, mainfreq
;
184 /* Read Clock Generator Main Oscillator Register */
185 target_read_u32(target
, CKGR_MOR
, &mor
);
186 /* Read Clock Generator Main Clock Frequency Register */
187 target_read_u32(target
, CKGR_MCFR
, &mcfr
);
188 /* Read Master Clock Register*/
189 target_read_u32(target
, PMC_MCKR
, &mckr
);
190 /* Read Clock Generator PLL Register */
191 target_read_u32(target
, CKGR_PLLR
, &pllr
);
193 at91sam7_info
->mck_valid
= 0;
194 at91sam7_info
->mck_freq
= 0;
195 switch (mckr
& PMC_MCKR_CSS
) {
196 case 0: /* Slow Clock */
197 at91sam7_info
->mck_valid
= 1;
201 case 1: /* Main Clock */
202 if ((mcfr
& CKGR_MCFR_MAINRDY
) &&
203 (at91sam7_info
->ext_freq
== 0)) {
204 at91sam7_info
->mck_valid
= 1;
205 tmp
= RC_FREQ
/ 16ul * (mcfr
& 0xffff);
206 } else if (at91sam7_info
->ext_freq
!= 0) {
207 at91sam7_info
->mck_valid
= 1;
208 tmp
= at91sam7_info
->ext_freq
;
212 case 2: /* Reserved */
215 case 3: /* PLL Clock */
216 if ((mcfr
& CKGR_MCFR_MAINRDY
) &&
217 (at91sam7_info
->ext_freq
== 0)) {
218 target_read_u32(target
, CKGR_PLLR
, &pllr
);
219 if (!(pllr
& CKGR_PLLR_DIV
))
221 at91sam7_info
->mck_valid
= 1;
222 mainfreq
= RC_FREQ
/ 16ul * (mcfr
& 0xffff);
223 /* Integer arithmetic should have sufficient precision
224 * as long as PLL is properly configured. */
225 tmp
= mainfreq
/ (pllr
& CKGR_PLLR_DIV
)*
226 (((pllr
& CKGR_PLLR_MUL
) >> 16) + 1);
227 } else if ((at91sam7_info
->ext_freq
!= 0) &&
228 ((pllr
&CKGR_PLLR_DIV
) != 0)) {
229 at91sam7_info
->mck_valid
= 1;
230 tmp
= at91sam7_info
->ext_freq
/ (pllr
&CKGR_PLLR_DIV
)*
231 (((pllr
& CKGR_PLLR_MUL
) >> 16) + 1);
236 /* Prescaler adjust */
237 if ((((mckr
& PMC_MCKR_PRES
) >> 2) == 7) || (tmp
== 0)) {
238 at91sam7_info
->mck_valid
= 0;
239 at91sam7_info
->mck_freq
= 0;
240 } else if (((mckr
& PMC_MCKR_PRES
) >> 2) != 0)
241 at91sam7_info
->mck_freq
= tmp
>> ((mckr
& PMC_MCKR_PRES
) >> 2);
243 at91sam7_info
->mck_freq
= tmp
;
246 /* Setup the timing registers for nvbits or normal flash */
247 static void at91sam7_set_flash_mode(struct flash_bank
*bank
, int mode
)
249 uint32_t fmr
, fmcn
= 0, fws
= 0;
250 struct at91sam7_flash_bank
*at91sam7_info
= bank
->driver_priv
;
251 struct target
*target
= bank
->target
;
253 if (mode
&& (mode
!= at91sam7_info
->flashmode
)) {
254 /* Always round up (ceil) */
255 if (mode
== FMR_TIMING_NVBITS
) {
256 if (at91sam7_info
->cidr_arch
== 0x60) {
257 /* AT91SAM7A3 uses master clocks in 100 ns */
258 fmcn
= (at91sam7_info
->mck_freq
/10000000ul) + 1;
260 /* master clocks in 1uS for ARCH 0x7 types */
261 fmcn
= (at91sam7_info
->mck_freq
/1000000ul) + 1;
263 } else if (mode
== FMR_TIMING_FLASH
) {
264 /* main clocks in 1.5uS */
265 fmcn
= (at91sam7_info
->mck_freq
/1000000ul)+
266 (at91sam7_info
->mck_freq
/2000000ul) + 1;
269 /* hard overclocking */
273 /* Only allow fmcn = 0 if clock period is > 30 us = 33kHz. */
274 if (at91sam7_info
->mck_freq
<= 33333ul)
276 /* Only allow fws = 0 if clock frequency is < 30 MHz. */
277 if (at91sam7_info
->mck_freq
> 30000000ul)
280 LOG_DEBUG("fmcn[%i]: %i", bank
->bank_number
, (int)(fmcn
));
281 fmr
= fmcn
<< 16 | fws
<< 8;
282 target_write_u32(target
, mc_fmr
[bank
->bank_number
], fmr
);
285 at91sam7_info
->flashmode
= mode
;
288 static uint32_t at91sam7_wait_status_busy(struct flash_bank
*bank
, uint32_t waitbits
, int timeout
)
292 while ((!((status
= at91sam7_get_flash_status(bank
->target
,
293 bank
->bank_number
)) & waitbits
)) && (timeout
-- > 0)) {
294 LOG_DEBUG("status[%i]: 0x%" PRIx32
"", (int)bank
->bank_number
, status
);
298 LOG_DEBUG("status[%i]: 0x%" PRIx32
"", bank
->bank_number
, status
);
301 LOG_ERROR("status register: 0x%" PRIx32
"", status
);
303 LOG_ERROR("Lock Error Bit Detected, Operation Abort");
305 LOG_ERROR("Invalid command and/or bad keyword, Operation Abort");
307 LOG_ERROR("Security Bit Set, Operation Abort");
313 /* Send one command to the AT91SAM flash controller */
314 static int at91sam7_flash_command(struct flash_bank
*bank
, uint8_t cmd
, uint16_t pagen
)
317 struct at91sam7_flash_bank
*at91sam7_info
= bank
->driver_priv
;
318 struct target
*target
= bank
->target
;
320 fcr
= (0x5A << 24) | ((pagen
&0x3FF) << 8) | cmd
;
321 target_write_u32(target
, mc_fcr
[bank
->bank_number
], fcr
);
322 LOG_DEBUG("Flash command: 0x%" PRIx32
", flash bank: %i, page number: %u",
324 bank
->bank_number
+ 1,
327 if ((at91sam7_info
->cidr_arch
== 0x60) && ((cmd
== SLB
) | (cmd
== CLB
))) {
328 /* Lock bit manipulation on AT91SAM7A3 waits for FC_FSR bit 1, EOL */
329 if (at91sam7_wait_status_busy(bank
, MC_FSR_EOL
, 10)&0x0C)
330 return ERROR_FLASH_OPERATION_FAILED
;
334 if (at91sam7_wait_status_busy(bank
, MC_FSR_FRDY
, 10)&0x0C)
335 return ERROR_FLASH_OPERATION_FAILED
;
340 /* Read device id register, main clock frequency register and fill in driver info structure */
341 static int at91sam7_read_part_info(struct flash_bank
*bank
)
343 struct at91sam7_flash_bank
*at91sam7_info
;
344 struct target
*target
= bank
->target
;
349 uint8_t banks_num
= 0;
350 uint16_t num_nvmbits
= 0;
351 uint16_t sectors_num
= 0;
352 uint16_t pages_per_sector
= 0;
353 uint16_t page_size
= 0;
356 uint32_t base_address
= 0;
357 char *target_name_t
= "Unknown";
359 at91sam7_info
= bank
->driver_priv
;
361 if (at91sam7_info
->cidr
!= 0) {
362 /* flash already configured, update clock and check for protected sectors */
363 for (struct flash_bank
*t_bank
= bank
; t_bank
; t_bank
= t_bank
->next
) {
364 if (t_bank
->target
!= target
)
366 /* re-calculate master clock frequency */
367 at91sam7_read_clock_info(t_bank
);
370 at91sam7_set_flash_mode(t_bank
, FMR_TIMING_NONE
);
372 /* check protect state */
373 at91sam7_protect_check(t_bank
);
379 /* Read and parse chip identification register */
380 target_read_u32(target
, DBGU_CIDR
, &cidr
);
382 LOG_WARNING("Cannot identify target as an AT91SAM");
383 return ERROR_FLASH_OPERATION_FAILED
;
386 if (at91sam7_info
->flash_autodetection
== 0) {
387 /* banks and sectors are already created, based on data from input file */
388 for (struct flash_bank
*t_bank
= bank
; t_bank
; t_bank
= t_bank
->next
) {
389 if (t_bank
->target
!= target
)
392 at91sam7_info
= t_bank
->driver_priv
;
394 at91sam7_info
->cidr
= cidr
;
395 at91sam7_info
->cidr_ext
= (cidr
>> 31)&0x0001;
396 at91sam7_info
->cidr_nvptyp
= (cidr
>> 28)&0x0007;
397 at91sam7_info
->cidr_arch
= (cidr
>> 20)&0x00FF;
398 at91sam7_info
->cidr_sramsiz
= (cidr
>> 16)&0x000F;
399 at91sam7_info
->cidr_nvpsiz2
= (cidr
>> 12)&0x000F;
400 at91sam7_info
->cidr_nvpsiz
= (cidr
>> 8)&0x000F;
401 at91sam7_info
->cidr_eproc
= (cidr
>> 5)&0x0007;
402 at91sam7_info
->cidr_version
= cidr
&0x001F;
404 /* calculate master clock frequency */
405 at91sam7_read_clock_info(t_bank
);
408 at91sam7_set_flash_mode(t_bank
, FMR_TIMING_NONE
);
410 /* check protect state */
411 at91sam7_protect_check(t_bank
);
417 arch
= (cidr
>> 20)&0x00FF;
419 /* check flash size */
420 switch ((cidr
>> 8)&0x000F) {
424 case FLASH_SIZE_16KB
:
427 pages_per_sector
= 32;
429 base_address
= 0x00100000;
432 target_name_t
= "AT91SAM7S161/16";
436 case FLASH_SIZE_32KB
:
439 pages_per_sector
= 32;
441 base_address
= 0x00100000;
444 target_name_t
= "AT91SAM7S321/32";
448 target_name_t
= "AT91SAM7SE32";
452 case FLASH_SIZE_64KB
:
455 pages_per_sector
= 32;
457 base_address
= 0x00100000;
460 target_name_t
= "AT91SAM7S64";
464 case FLASH_SIZE_128KB
:
467 pages_per_sector
= 64;
469 base_address
= 0x00100000;
472 target_name_t
= "AT91SAM7S128";
476 target_name_t
= "AT91SAM7XC128";
480 target_name_t
= "AT91SAM7SE128";
484 target_name_t
= "AT91SAM7X128";
488 case FLASH_SIZE_256KB
:
491 pages_per_sector
= 64;
493 base_address
= 0x00100000;
496 target_name_t
= "AT91SAM7A3";
500 target_name_t
= "AT91SAM7S256";
504 target_name_t
= "AT91SAM7XC256";
508 target_name_t
= "AT91SAM7SE256";
512 target_name_t
= "AT91SAM7X256";
516 case FLASH_SIZE_512KB
:
519 pages_per_sector
= 64;
521 base_address
= 0x00100000;
524 target_name_t
= "AT91SAM7S512";
528 target_name_t
= "AT91SAM7XC512";
532 target_name_t
= "AT91SAM7SE512";
536 target_name_t
= "AT91SAM7X512";
540 case FLASH_SIZE_1024KB
:
543 case FLASH_SIZE_2048KB
:
547 if (strcmp(target_name_t
, "Unknown") == 0) {
549 "Target autodetection failed! Please specify target parameters in configuration file");
550 return ERROR_FLASH_OPERATION_FAILED
;
553 ext_freq
= at91sam7_info
->ext_freq
;
555 /* calculate bank size */
556 bank_size
= sectors_num
* pages_per_sector
* page_size
;
558 for (bnk
= 0; bnk
< banks_num
; bnk
++) {
559 struct flash_bank
*t_bank
= bank
;
562 /* create a new flash bank element */
563 struct flash_bank
*fb
= calloc(sizeof(struct flash_bank
), 1);
565 LOG_ERROR("No memory for flash bank");
569 fb
->driver
= bank
->driver
;
570 fb
->default_padded_value
= 0xff;
571 fb
->erased_value
= 0xff;
572 fb
->driver_priv
= malloc(sizeof(struct at91sam7_flash_bank
));
573 if (!fb
->driver_priv
) {
575 LOG_ERROR("No memory for flash driver priv");
578 fb
->name
= strdup("sam7_probed");
581 /* link created bank in 'flash_banks' list */
584 t_bank
= t_bank
->next
;
587 t_bank
->bank_number
= bnk
;
588 t_bank
->base
= base_address
+ bnk
* bank_size
;
589 t_bank
->size
= bank_size
;
590 t_bank
->num_sectors
= sectors_num
;
592 /* allocate sectors */
593 t_bank
->sectors
= malloc(sectors_num
* sizeof(struct flash_sector
));
594 for (sec
= 0; sec
< sectors_num
; sec
++) {
595 t_bank
->sectors
[sec
].offset
= sec
* pages_per_sector
* page_size
;
596 t_bank
->sectors
[sec
].size
= pages_per_sector
* page_size
;
597 t_bank
->sectors
[sec
].is_erased
= -1;
598 t_bank
->sectors
[sec
].is_protected
= -1;
601 at91sam7_info
= t_bank
->driver_priv
;
603 at91sam7_info
->cidr
= cidr
;
604 at91sam7_info
->cidr_ext
= (cidr
>> 31)&0x0001;
605 at91sam7_info
->cidr_nvptyp
= (cidr
>> 28)&0x0007;
606 at91sam7_info
->cidr_arch
= (cidr
>> 20)&0x00FF;
607 at91sam7_info
->cidr_sramsiz
= (cidr
>> 16)&0x000F;
608 at91sam7_info
->cidr_nvpsiz2
= (cidr
>> 12)&0x000F;
609 at91sam7_info
->cidr_nvpsiz
= (cidr
>> 8)&0x000F;
610 at91sam7_info
->cidr_eproc
= (cidr
>> 5)&0x0007;
611 at91sam7_info
->cidr_version
= cidr
&0x001F;
613 at91sam7_info
->target_name
= target_name_t
;
614 at91sam7_info
->flashmode
= 0;
615 at91sam7_info
->ext_freq
= ext_freq
;
616 at91sam7_info
->num_nvmbits
= num_nvmbits
;
617 at91sam7_info
->num_nvmbits_on
= 0;
618 at91sam7_info
->pagesize
= page_size
;
619 at91sam7_info
->pages_per_sector
= pages_per_sector
;
621 /* calculate master clock frequency */
622 at91sam7_read_clock_info(t_bank
);
625 at91sam7_set_flash_mode(t_bank
, FMR_TIMING_NONE
);
627 /* check protect state */
628 at91sam7_protect_check(t_bank
);
631 LOG_DEBUG("nvptyp: 0x%3.3x, arch: 0x%4.4x",
632 at91sam7_info
->cidr_nvptyp
,
633 at91sam7_info
->cidr_arch
);
638 static int at91sam7_erase_check(struct flash_bank
*bank
)
640 if (bank
->target
->state
!= TARGET_HALTED
) {
641 LOG_ERROR("Target not halted");
642 return ERROR_TARGET_NOT_HALTED
;
645 /* Configure the flash controller timing */
646 at91sam7_read_clock_info(bank
);
647 at91sam7_set_flash_mode(bank
, FMR_TIMING_FLASH
);
649 return default_flash_blank_check(bank
);
652 static int at91sam7_protect_check(struct flash_bank
*bank
)
654 uint8_t lock_pos
, gpnvm_pos
;
657 struct at91sam7_flash_bank
*at91sam7_info
= bank
->driver_priv
;
659 if (at91sam7_info
->cidr
== 0)
660 return ERROR_FLASH_BANK_NOT_PROBED
;
661 if (bank
->target
->state
!= TARGET_HALTED
) {
662 LOG_ERROR("Target not halted");
663 return ERROR_TARGET_NOT_HALTED
;
666 status
= at91sam7_get_flash_status(bank
->target
, bank
->bank_number
);
667 at91sam7_info
->lockbits
= (status
>> 16);
669 at91sam7_info
->num_lockbits_on
= 0;
670 for (lock_pos
= 0; lock_pos
< bank
->num_sectors
; lock_pos
++) {
671 if (((status
>> (16 + lock_pos
))&(0x0001)) == 1) {
672 at91sam7_info
->num_lockbits_on
++;
673 bank
->sectors
[lock_pos
].is_protected
= 1;
675 bank
->sectors
[lock_pos
].is_protected
= 0;
678 /* GPNVM and SECURITY bits apply only for MC_FSR of EFC0 */
679 status
= at91sam7_get_flash_status(bank
->target
, 0);
681 at91sam7_info
->securitybit
= (status
>> 4)&0x01;
682 at91sam7_info
->nvmbits
= (status
>> 8)&0xFF;
684 at91sam7_info
->num_nvmbits_on
= 0;
685 for (gpnvm_pos
= 0; gpnvm_pos
< at91sam7_info
->num_nvmbits
; gpnvm_pos
++) {
686 if (((status
>> (8 + gpnvm_pos
))&(0x01)) == 1)
687 at91sam7_info
->num_nvmbits_on
++;
693 FLASH_BANK_COMMAND_HANDLER(at91sam7_flash_bank_command
)
695 struct flash_bank
*t_bank
= bank
;
696 struct at91sam7_flash_bank
*at91sam7_info
;
697 struct target
*target
= t_bank
->target
;
699 uint32_t base_address
;
701 uint32_t ext_freq
= 0;
703 unsigned int banks_num
;
704 unsigned int num_sectors
;
706 uint16_t pages_per_sector
;
708 uint16_t num_nvmbits
;
710 at91sam7_info
= malloc(sizeof(struct at91sam7_flash_bank
));
711 t_bank
->driver_priv
= at91sam7_info
;
713 /* part wasn't probed for info yet */
714 at91sam7_info
->cidr
= 0;
715 at91sam7_info
->flashmode
= 0;
716 at91sam7_info
->ext_freq
= 0;
717 at91sam7_info
->flash_autodetection
= 0;
720 at91sam7_info
->flash_autodetection
= 1;
724 COMMAND_PARSE_NUMBER(u32
, CMD_ARGV
[1], base_address
);
726 COMMAND_PARSE_NUMBER(uint
, CMD_ARGV
[8], banks_num
);
727 COMMAND_PARSE_NUMBER(uint
, CMD_ARGV
[9], num_sectors
);
728 COMMAND_PARSE_NUMBER(u16
, CMD_ARGV
[10], pages_per_sector
);
729 COMMAND_PARSE_NUMBER(u16
, CMD_ARGV
[11], page_size
);
730 COMMAND_PARSE_NUMBER(u16
, CMD_ARGV
[12], num_nvmbits
);
732 if (CMD_ARGC
== 14) {
734 COMMAND_PARSE_NUMBER(ulong
, CMD_ARGV
[13], freq
);
735 ext_freq
= freq
* 1000;
736 at91sam7_info
->ext_freq
= ext_freq
;
739 if ((banks_num
== 0) || (num_sectors
== 0) ||
740 (pages_per_sector
== 0) || (page_size
== 0) || (num_nvmbits
== 0)) {
741 at91sam7_info
->flash_autodetection
= 1;
745 /* calculate bank size */
746 bank_size
= num_sectors
* pages_per_sector
* page_size
;
748 for (unsigned int bnk
= 0; bnk
< banks_num
; bnk
++) {
751 /* create a new bank element */
752 struct flash_bank
*fb
= calloc(sizeof(struct flash_bank
), 1);
754 LOG_ERROR("No memory for flash bank");
758 fb
->driver
= bank
->driver
;
759 fb
->default_padded_value
= 0xff;
760 fb
->erased_value
= 0xff;
761 fb
->driver_priv
= malloc(sizeof(struct at91sam7_flash_bank
));
762 if (!fb
->driver_priv
) {
764 LOG_ERROR("No memory for flash driver priv");
767 fb
->name
= strdup("sam7_probed");
770 /* link created bank in 'flash_banks' list */
773 t_bank
= t_bank
->next
;
776 t_bank
->bank_number
= bnk
;
777 t_bank
->base
= base_address
+ bnk
* bank_size
;
778 t_bank
->size
= bank_size
;
779 t_bank
->num_sectors
= num_sectors
;
781 /* allocate sectors */
782 t_bank
->sectors
= malloc(num_sectors
* sizeof(struct flash_sector
));
783 for (unsigned int sec
= 0; sec
< num_sectors
; sec
++) {
784 t_bank
->sectors
[sec
].offset
= sec
* pages_per_sector
* page_size
;
785 t_bank
->sectors
[sec
].size
= pages_per_sector
* page_size
;
786 t_bank
->sectors
[sec
].is_erased
= -1;
787 t_bank
->sectors
[sec
].is_protected
= -1;
790 at91sam7_info
= t_bank
->driver_priv
;
792 at91sam7_info
->target_name
= strdup(CMD_ARGV
[7]);
793 at91sam7_info
->flashmode
= 0;
794 at91sam7_info
->ext_freq
= ext_freq
;
795 at91sam7_info
->num_nvmbits
= num_nvmbits
;
796 at91sam7_info
->num_nvmbits_on
= 0;
797 at91sam7_info
->pagesize
= page_size
;
798 at91sam7_info
->pages_per_sector
= pages_per_sector
;
804 static int at91sam7_erase(struct flash_bank
*bank
, unsigned int first
,
807 struct at91sam7_flash_bank
*at91sam7_info
= bank
->driver_priv
;
808 uint32_t nbytes
, pos
;
812 if (at91sam7_info
->cidr
== 0)
813 return ERROR_FLASH_BANK_NOT_PROBED
;
815 if (bank
->target
->state
!= TARGET_HALTED
) {
816 LOG_ERROR("Target not halted");
817 return ERROR_TARGET_NOT_HALTED
;
820 if ((last
< first
) || (last
>= bank
->num_sectors
))
821 return ERROR_FLASH_SECTOR_INVALID
;
824 if ((first
== 0) && (last
== (bank
->num_sectors
-1)))
827 /* Configure the flash controller timing */
828 at91sam7_read_clock_info(bank
);
829 at91sam7_set_flash_mode(bank
, FMR_TIMING_FLASH
);
832 if (at91sam7_flash_command(bank
, EA
, 0) != ERROR_OK
)
833 return ERROR_FLASH_OPERATION_FAILED
;
835 /* allocate and clean buffer */
836 nbytes
= (last
- first
+ 1) * bank
->sectors
[first
].size
;
837 buffer
= malloc(nbytes
* sizeof(uint8_t));
838 for (pos
= 0; pos
< nbytes
; pos
++)
841 if (at91sam7_write(bank
, buffer
, bank
->sectors
[first
].offset
, nbytes
) != ERROR_OK
) {
843 return ERROR_FLASH_OPERATION_FAILED
;
849 /* mark erased sectors */
850 for (unsigned int sec
= first
; sec
<= last
; sec
++)
851 bank
->sectors
[sec
].is_erased
= 1;
856 static int at91sam7_protect(struct flash_bank
*bank
, int set
,
857 unsigned int first
, unsigned int last
)
862 struct at91sam7_flash_bank
*at91sam7_info
= bank
->driver_priv
;
864 if (at91sam7_info
->cidr
== 0)
865 return ERROR_FLASH_BANK_NOT_PROBED
;
867 if (bank
->target
->state
!= TARGET_HALTED
) {
868 LOG_ERROR("Target not halted");
869 return ERROR_TARGET_NOT_HALTED
;
872 if ((last
< first
) || (last
>= bank
->num_sectors
))
873 return ERROR_FLASH_SECTOR_INVALID
;
875 /* Configure the flash controller timing */
876 at91sam7_read_clock_info(bank
);
877 at91sam7_set_flash_mode(bank
, FMR_TIMING_NVBITS
);
879 for (unsigned int sector
= first
; sector
<= last
; sector
++) {
885 /* if we lock a page from one sector then entire sector will be locked, also,
886 * if we unlock a page from a locked sector, entire sector will be unlocked */
887 pagen
= sector
* at91sam7_info
->pages_per_sector
;
889 if (at91sam7_flash_command(bank
, cmd
, pagen
) != ERROR_OK
)
890 return ERROR_FLASH_OPERATION_FAILED
;
893 at91sam7_protect_check(bank
);
898 static int at91sam7_write(struct flash_bank
*bank
, const uint8_t *buffer
, uint32_t offset
, uint32_t count
)
901 struct at91sam7_flash_bank
*at91sam7_info
= bank
->driver_priv
;
902 struct target
*target
= bank
->target
;
903 uint32_t dst_min_alignment
, wcount
, bytes_remaining
= count
;
904 uint32_t first_page
, last_page
, pagen
, buffer_pos
;
906 if (at91sam7_info
->cidr
== 0)
907 return ERROR_FLASH_BANK_NOT_PROBED
;
909 if (bank
->target
->state
!= TARGET_HALTED
) {
910 LOG_ERROR("Target not halted");
911 return ERROR_TARGET_NOT_HALTED
;
914 if (offset
+ count
> bank
->size
)
915 return ERROR_FLASH_DST_OUT_OF_BANK
;
917 dst_min_alignment
= at91sam7_info
->pagesize
;
919 if (offset
% dst_min_alignment
) {
920 LOG_WARNING("offset 0x%" PRIx32
" breaks required alignment 0x%" PRIx32
"",
923 return ERROR_FLASH_DST_BREAKS_ALIGNMENT
;
926 if (at91sam7_info
->cidr_arch
== 0)
927 return ERROR_FLASH_BANK_NOT_PROBED
;
929 first_page
= offset
/dst_min_alignment
;
930 last_page
= DIV_ROUND_UP(offset
+ count
, dst_min_alignment
);
932 LOG_DEBUG("first_page: %i, last_page: %i, count %i",
937 /* Configure the flash controller timing */
938 at91sam7_read_clock_info(bank
);
939 at91sam7_set_flash_mode(bank
, FMR_TIMING_FLASH
);
941 for (pagen
= first_page
; pagen
< last_page
; pagen
++) {
942 if (bytes_remaining
< dst_min_alignment
)
943 count
= bytes_remaining
;
945 count
= dst_min_alignment
;
946 bytes_remaining
-= count
;
948 /* Write one block to the PageWriteBuffer */
949 buffer_pos
= (pagen
-first_page
)*dst_min_alignment
;
950 wcount
= DIV_ROUND_UP(count
, 4);
951 retval
= target_write_memory(target
, bank
->base
+ pagen
*dst_min_alignment
, 4,
952 wcount
, buffer
+ buffer_pos
);
953 if (retval
!= ERROR_OK
)
956 /* Send Write Page command to Flash Controller */
957 if (at91sam7_flash_command(bank
, WP
, pagen
) != ERROR_OK
)
958 return ERROR_FLASH_OPERATION_FAILED
;
959 LOG_DEBUG("Write flash bank:%u page number:%" PRIu32
, bank
->bank_number
, pagen
);
965 static int at91sam7_probe(struct flash_bank
*bank
)
967 /* we can't probe on an at91sam7
968 * if this is an at91sam7, it has the configured flash */
971 if (bank
->target
->state
!= TARGET_HALTED
) {
972 LOG_ERROR("Target not halted");
973 return ERROR_TARGET_NOT_HALTED
;
976 retval
= at91sam7_read_part_info(bank
);
977 if (retval
!= ERROR_OK
)
983 static int get_at91sam7_info(struct flash_bank
*bank
, struct command_invocation
*cmd
)
985 struct at91sam7_flash_bank
*at91sam7_info
= bank
->driver_priv
;
987 if (at91sam7_info
->cidr
== 0)
988 return ERROR_FLASH_BANK_NOT_PROBED
;
990 command_print_sameline(cmd
, "\n at91sam7 driver information: Chip is %s\n",
991 at91sam7_info
->target_name
);
993 command_print_sameline(cmd
,
994 " Cidr: 0x%8.8" PRIx32
" | Arch: 0x%4.4x | Eproc: %s | Version: 0x%3.3x | "
995 "Flashsize: 0x%8.8" PRIx32
"\n",
997 at91sam7_info
->cidr_arch
,
998 eproc
[at91sam7_info
->cidr_eproc
],
999 at91sam7_info
->cidr_version
,
1002 command_print_sameline(cmd
,
1003 " Master clock (estimated): %u kHz | External clock: %u kHz\n",
1004 (unsigned)(at91sam7_info
->mck_freq
/ 1000),
1005 (unsigned)(at91sam7_info
->ext_freq
/ 1000));
1007 command_print_sameline(cmd
,
1008 " Pagesize: %i bytes | Lockbits(%u): %i 0x%4.4x | Pages in lock region: %i\n",
1009 at91sam7_info
->pagesize
,
1011 at91sam7_info
->num_lockbits_on
,
1012 at91sam7_info
->lockbits
,
1013 at91sam7_info
->pages_per_sector
* at91sam7_info
->num_lockbits_on
);
1015 command_print_sameline(cmd
, " Securitybit: %i | Nvmbits(%i): %i 0x%1.1x\n",
1016 at91sam7_info
->securitybit
, at91sam7_info
->num_nvmbits
,
1017 at91sam7_info
->num_nvmbits_on
, at91sam7_info
->nvmbits
);
1023 * On AT91SAM7S: When the gpnvm bits are set with
1024 * > at91sam7 gpnvm bitnr set
1025 * the changes are not visible in the flash controller status register MC_FSR
1026 * until the processor has been reset.
1027 * On the Olimex board this requires a power cycle.
1028 * Note that the AT91SAM7S has the following errata (doc6175.pdf sec 14.1.3):
1029 * The maximum number of write/erase cycles for Non volatile Memory bits is 100. this includes
1030 * Lock Bits (LOCKx), General Purpose NVM bits (GPNVMx) and the Security Bit.
1032 COMMAND_HANDLER(at91sam7_handle_gpnvm_command
)
1034 struct flash_bank
*bank
;
1038 struct at91sam7_flash_bank
*at91sam7_info
;
1042 return ERROR_COMMAND_SYNTAX_ERROR
;
1044 bank
= get_flash_bank_by_num_noprobe(0);
1046 return ERROR_FLASH_BANK_INVALID
;
1047 if (strcmp(bank
->driver
->name
, "at91sam7")) {
1048 command_print(CMD
, "not an at91sam7 flash bank '%s'", CMD_ARGV
[0]);
1049 return ERROR_FLASH_BANK_INVALID
;
1051 if (bank
->target
->state
!= TARGET_HALTED
) {
1052 LOG_ERROR("target has to be halted to perform flash operation");
1053 return ERROR_TARGET_NOT_HALTED
;
1056 if (strcmp(CMD_ARGV
[1], "set") == 0)
1058 else if (strcmp(CMD_ARGV
[1], "clear") == 0)
1061 return ERROR_COMMAND_SYNTAX_ERROR
;
1063 at91sam7_info
= bank
->driver_priv
;
1064 if (at91sam7_info
->cidr
== 0) {
1065 retval
= at91sam7_read_part_info(bank
);
1066 if (retval
!= ERROR_OK
)
1070 COMMAND_PARSE_NUMBER(int, CMD_ARGV
[0], bit
);
1071 if ((bit
< 0) || (bit
>= at91sam7_info
->num_nvmbits
)) {
1073 "gpnvm bit '#%s' is out of bounds for target %s",
1075 at91sam7_info
->target_name
);
1079 /* Configure the flash controller timing */
1080 at91sam7_read_clock_info(bank
);
1081 at91sam7_set_flash_mode(bank
, FMR_TIMING_NVBITS
);
1083 if (at91sam7_flash_command(bank
, flashcmd
, bit
) != ERROR_OK
)
1084 return ERROR_FLASH_OPERATION_FAILED
;
1086 /* GPNVM and SECURITY bits apply only for MC_FSR of EFC0 */
1087 status
= at91sam7_get_flash_status(bank
->target
, 0);
1088 LOG_DEBUG("at91sam7_handle_gpnvm_command: cmd 0x%x, value %d, status 0x%" PRIx32
,
1093 /* check protect state */
1094 at91sam7_protect_check(bank
);
1099 static const struct command_registration at91sam7_exec_command_handlers
[] = {
1102 .handler
= at91sam7_handle_gpnvm_command
,
1103 .mode
= COMMAND_EXEC
,
1104 .help
= "set or clear one General Purpose Non-Volatile Memory "
1106 .usage
= "bitnum ('set'|'clear')",
1108 COMMAND_REGISTRATION_DONE
1110 static const struct command_registration at91sam7_command_handlers
[] = {
1113 .mode
= COMMAND_ANY
,
1114 .help
= "at91sam7 flash command group",
1116 .chain
= at91sam7_exec_command_handlers
,
1118 COMMAND_REGISTRATION_DONE
1121 const struct flash_driver at91sam7_flash
= {
1123 .usage
= "gpnvm <bit> <set | clear>",
1124 .commands
= at91sam7_command_handlers
,
1125 .flash_bank_command
= at91sam7_flash_bank_command
,
1126 .erase
= at91sam7_erase
,
1127 .protect
= at91sam7_protect
,
1128 .write
= at91sam7_write
,
1129 .read
= default_flash_read
,
1130 .probe
= at91sam7_probe
,
1131 .auto_probe
= at91sam7_probe
,
1132 .erase_check
= at91sam7_erase_check
,
1133 .protect_check
= at91sam7_protect_check
,
1134 .info
= get_at91sam7_info
,
Linking to existing account procedure
If you already have an account and want to add another login method
you
MUST first sign in with your existing account and
then change URL to read
https://review.openocd.org/login/?link
to get to this page again but this time it'll work for linking. Thank you.
SSH host keys fingerprints
1024 SHA256:YKx8b7u5ZWdcbp7/4AeXNaqElP49m6QrwfXaqQGJAOk gerrit-code-review@openocd.zylin.com (DSA)
384 SHA256:jHIbSQa4REvwCFG4cq5LBlBLxmxSqelQPem/EXIrxjk gerrit-code-review@openocd.org (ECDSA)
521 SHA256:UAOPYkU9Fjtcao0Ul/Rrlnj/OsQvt+pgdYSZ4jOYdgs gerrit-code-review@openocd.org (ECDSA)
256 SHA256:A13M5QlnozFOvTllybRZH6vm7iSt0XLxbA48yfc2yfY gerrit-code-review@openocd.org (ECDSA)
256 SHA256:spYMBqEYoAOtK7yZBrcwE8ZpYt6b68Cfh9yEVetvbXg gerrit-code-review@openocd.org (ED25519)
+--[ED25519 256]--+
|=.. |
|+o.. . |
|*.o . . |
|+B . . . |
|Bo. = o S |
|Oo.+ + = |
|oB=.* = . o |
| =+=.+ + E |
|. .=o . o |
+----[SHA256]-----+
2048 SHA256:0Onrb7/PHjpo6iVZ7xQX2riKN83FJ3KGU0TvI0TaFG4 gerrit-code-review@openocd.zylin.com (RSA)