9 * Originated from ppcboot-2.0.0/board/esd/cpci440/strataflash.c
12 * Brad Kemp, Seranoa Networks, Brad.Kemp@seranoa.com
14 * See file CREDITS for list of people who contributed to this
17 * This program is free software; you can redistribute it and/or
18 * modify it under the terms of the GNU General Public License as
19 * published by the Free Software Foundation; either version 2 of
20 * the License, or (at your option) any later version.
22 * This program is distributed in the hope that it will be useful,
23 * but WITHOUT ANY WARRANTY; without even the implied warranty of
24 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
25 * GNU General Public License for more details.
27 * You should have received a copy of the GNU General Public License
28 * along with this program; if not, write to the Free Software
29 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
34 #include <asm/processor.h>
38 * This file implements a Common Flash Interface (CFI) driver for ppcboot.
39 * The width of the port and the width of the chips are determined at initialization.
40 * These widths are used to calculate the address for access CFI data structures.
41 * It has been tested on an Intel Strataflash implementation.
44 * JEDEC Standard JESD68 - Common Flash Interface (CFI)
45 * JEDEC Standard JEP137-A Common Flash Interface (CFI) ID Codes
46 * Intel Application Note 646 Common Flash Interface (CFI) and Command Sets
47 * Intel 290667-008 3 Volt Intel StrataFlash Memory datasheet
50 * Use Primary Extended Query table (PRI) and Alternate Algorithm Query Table (ALT) to determine if protection is available
51 * Add support for other command sets Use the PRI and ALT to determine command set
52 * Verify erase and program timeouts.
55 #define FLASH_CMD_CFI 0x98
56 #define FLASH_CMD_READ_ID 0x90
57 #define FLASH_CMD_RESET 0xff
58 #define FLASH_CMD_BLOCK_ERASE 0x20
59 #define FLASH_CMD_ERASE_CONFIRM 0xD0
60 #define FLASH_CMD_WRITE 0x40
61 #define FLASH_CMD_PROTECT 0x60
62 #define FLASH_CMD_PROTECT_SET 0x01
63 #define FLASH_CMD_PROTECT_CLEAR 0xD0
64 #define FLASH_CMD_CLEAR_STATUS 0x50
65 #define FLASH_CMD_WRITE_TO_BUFFER 0xE8
66 #define FLASH_CMD_WRITE_BUFFER_CONFIRM 0xD0
68 #define FLASH_STATUS_DONE 0x80
69 #define FLASH_STATUS_ESS 0x40
70 #define FLASH_STATUS_ECLBS 0x20
71 #define FLASH_STATUS_PSLBS 0x10
72 #define FLASH_STATUS_VPENS 0x08
73 #define FLASH_STATUS_PSS 0x04
74 #define FLASH_STATUS_DPS 0x02
75 #define FLASH_STATUS_R 0x01
76 #define FLASH_STATUS_PROTECT 0x01
78 #define FLASH_OFFSET_CFI 0x55
79 #define FLASH_OFFSET_CFI_RESP 0x10
80 #define FLASH_OFFSET_WTOUT 0x1F
81 #define FLASH_OFFSET_WBTOUT 0x20
82 #define FLASH_OFFSET_ETOUT 0x21
83 #define FLASH_OFFSET_CETOUT 0x22
84 #define FLASH_OFFSET_WMAX_TOUT 0x23
85 #define FLASH_OFFSET_WBMAX_TOUT 0x24
86 #define FLASH_OFFSET_EMAX_TOUT 0x25
87 #define FLASH_OFFSET_CEMAX_TOUT 0x26
88 #define FLASH_OFFSET_SIZE 0x27
89 #define FLASH_OFFSET_INTERFACE 0x28
90 #define FLASH_OFFSET_BUFFER_SIZE 0x2A
91 #define FLASH_OFFSET_NUM_ERASE_REGIONS 0x2C
92 #define FLASH_OFFSET_ERASE_REGIONS 0x2D
93 #define FLASH_OFFSET_PROTECT 0x02
94 #define FLASH_OFFSET_USER_PROTECTION 0x85
95 #define FLASH_OFFSET_INTEL_PROTECTION 0x81
97 #define FLASH_MAN_CFI 0x01000000
111 #define NUM_ERASE_REGIONS 4
113 flash_info_t flash_info
[CONFIG_SYS_MAX_FLASH_BANKS
]; /* info for FLASH chips */
115 /*-----------------------------------------------------------------------
119 static void flash_add_byte (flash_info_t
* info
, cfiword_t
* cword
, uchar c
);
120 static void flash_make_cmd (flash_info_t
* info
, uchar cmd
, void *cmdbuf
);
121 static void flash_write_cmd (flash_info_t
* info
, int sect
, uchar offset
,
123 static int flash_isequal (flash_info_t
* info
, int sect
, uchar offset
,
125 static int flash_isset (flash_info_t
* info
, int sect
, uchar offset
,
127 static int flash_detect_cfi (flash_info_t
* info
);
128 static ulong
flash_get_size (ulong base
, int banknum
);
129 static int flash_write_cfiword (flash_info_t
* info
, ulong dest
,
131 static int flash_full_status_check (flash_info_t
* info
, ulong sector
,
132 ulong tout
, char *prompt
);
133 #ifdef CONFIG_SYS_FLASH_USE_BUFFER_WRITE
134 static int flash_write_cfibuffer (flash_info_t
* info
, ulong dest
, uchar
* cp
,
137 /*-----------------------------------------------------------------------
138 * create an address based on the offset and the port width
140 uchar
*flash_make_addr (flash_info_t
* info
, int sect
, int offset
)
142 return ((uchar
*) (info
->start
[sect
] + (offset
* info
->chipwidth
)));
145 /*-----------------------------------------------------------------------
146 * read a character at a port width address
148 uchar
flash_read_uchar (flash_info_t
* info
, uchar offset
)
150 if (info
->portwidth
== FLASH_CFI_8BIT
) {
154 cp
= flash_make_addr (info
, 0, offset
);
157 printf ("flash_read_uchar offset=%04x ptr=%08x c=%02x\n",
158 offset
, (unsigned int) cp
, c
);
162 } else if (info
->portwidth
== FLASH_CFI_16BIT
) {
167 sp
= (ushort
*) flash_make_addr (info
, 0, offset
);
171 printf ("flash_read_uchar offset=%04x ptr=%08x s=%04x c=%02x\n", offset
, (unsigned int) sp
, s
, c
);
180 /*-----------------------------------------------------------------------
181 * read a short word by swapping for ppc format.
183 ushort
flash_read_ushort (flash_info_t
* info
, int sect
, uchar offset
)
185 if (info
->portwidth
== FLASH_CFI_8BIT
) {
190 cp
= flash_make_addr (info
, 0, offset
);
195 printf ("flash_read_ushort offset=%04x ptr=%08x c1=%02x c0=%02x s=%04x\n", offset
, (unsigned int) cp
, c1
, c0
, s
);
199 } else if (info
->portwidth
== FLASH_CFI_16BIT
) {
204 sp
= (ushort
*) flash_make_addr (info
, 0, offset
);
210 printf ("flash_read_ushort offset=%04x ptr=%08x c1=%02x c0=%02x s=%04x\n", offset
, (unsigned int) sp
, c1
, c0
, s
);
219 /*-----------------------------------------------------------------------
220 * read a long word by picking the least significant byte of each maiximum
221 * port size word. Swap for ppc format.
223 ulong
flash_read_long (flash_info_t
* info
, int sect
, uchar offset
)
225 if (info
->portwidth
== FLASH_CFI_8BIT
) {
227 uchar c0
, c1
, c2
, c3
;
230 cp
= flash_make_addr (info
, 0, offset
);
235 l
= c3
<< 24 | c2
<< 16 | c1
<< 8 | c0
;
237 printf ("flash_read_long offset=%04x ptr=%08x c3=%02x c2=%02x c1=%02x c0=%02x l=%08x\n", offset
, (unsigned int) cp
, c3
, c2
, c1
, c0
, l
);
241 } else if (info
->portwidth
== FLASH_CFI_16BIT
) {
243 uchar c0
, c1
, c2
, c3
;
246 sp
= (ushort
*) flash_make_addr (info
, 0, offset
);
251 l
= c3
<< 24 | c2
<< 16 | c1
<< 8 | c0
;
253 printf ("flash_read_long offset=%04x ptr=%08x c3=%02x c2=%02x c1=%02x c0=%02x l=%08x\n", offset
, (unsigned int) sp
, c3
, c2
, c1
, c0
, l
);
262 /*-----------------------------------------------------------------------
264 unsigned long flash_init (void)
270 flash_info
[0].flash_id
= FLASH_UNKNOWN
;
271 flash_info
[0].portwidth
= FLASH_CFI_16BIT
;
272 flash_info
[0].chipwidth
= FLASH_CFI_16BIT
;
273 size
+= flash_info
[0].size
= flash_get_size (CONFIG_SYS_PROGFLASH_BASE
, 0);
274 if (flash_info
[0].flash_id
== FLASH_UNKNOWN
) {
275 printf ("## Unknown FLASH on Bank %d - Size = 0x%08lx = %ld MB\n", 1, flash_info
[0].size
, flash_info
[0].size
<< 20);
278 flash_info
[1].flash_id
= FLASH_UNKNOWN
;
279 flash_info
[1].portwidth
= FLASH_CFI_8BIT
;
280 flash_info
[1].chipwidth
= FLASH_CFI_16BIT
;
281 size
+= flash_info
[1].size
= flash_get_size (CONFIG_SYS_CONFFLASH_BASE
, 1);
282 if (flash_info
[1].flash_id
== FLASH_UNKNOWN
) {
283 printf ("## Unknown FLASH on Bank %d - Size = 0x%08lx = %ld MB\n", 2, flash_info
[1].size
, flash_info
[1].size
<< 20);
289 /*-----------------------------------------------------------------------
291 int flash_erase (flash_info_t
* info
, int s_first
, int s_last
)
297 if (info
->flash_id
!= FLASH_MAN_CFI
) {
298 printf ("Can't erase unknown flash type - aborted\n");
301 if ((s_first
< 0) || (s_first
> s_last
)) {
302 printf ("- no sectors to erase\n");
307 for (sect
= s_first
; sect
<= s_last
; ++sect
) {
308 if (info
->protect
[sect
]) {
313 printf ("- Warning: %d protected sectors will not be erased!\n", prot
);
318 for (sect
= s_first
; sect
<= s_last
; sect
++) {
319 if (info
->protect
[sect
] == 0) { /* not protected */
320 flash_write_cmd (info
, sect
, 0,
321 FLASH_CMD_CLEAR_STATUS
);
322 flash_write_cmd (info
, sect
, 0,
323 FLASH_CMD_BLOCK_ERASE
);
324 flash_write_cmd (info
, sect
, 0,
325 FLASH_CMD_ERASE_CONFIRM
);
327 if (flash_full_status_check
328 (info
, sect
, info
->erase_blk_tout
, "erase")) {
338 /*-----------------------------------------------------------------------
340 void flash_print_info (flash_info_t
* info
)
344 if (info
->flash_id
!= FLASH_MAN_CFI
) {
345 printf ("missing or unknown FLASH type\n");
349 printf ("CFI conformant FLASH (x%d device in x%d mode)",
350 (info
->chipwidth
<< 3), (info
->portwidth
<< 3));
351 printf (" Size: %ld MB in %d Sectors\n",
352 info
->size
>> 20, info
->sector_count
);
353 printf (" Erase timeout %ld ms, write timeout %ld ms, buffer write timeout %ld ms, buffer size %d\n", info
->erase_blk_tout
, info
->write_tout
, info
->buffer_write_tout
, info
->buffer_size
);
355 printf (" Sector Start Addresses:");
356 for (i
= 0; i
< info
->sector_count
; ++i
) {
360 info
->start
[i
], info
->protect
[i
] ? " (RO)" : " ");
366 /*-----------------------------------------------------------------------
367 * Copy memory to flash, returns:
370 * 2 - Flash not erased
372 int write_buff (flash_info_t
* info
, uchar
* src
, ulong addr
, ulong cnt
)
380 /* get lower aligned address */
381 wp
= (addr
& ~(info
->portwidth
- 1));
383 /* handle unaligned start */
384 if ((aln
= addr
- wp
) != 0) {
387 for (i
= 0; i
< aln
; ++i
, ++cp
)
388 flash_add_byte (info
, &cword
, (*(uchar
*) cp
));
390 for (; (i
< info
->portwidth
) && (cnt
> 0); i
++) {
391 flash_add_byte (info
, &cword
, *src
++);
395 for (; (cnt
== 0) && (i
< info
->portwidth
); ++i
, ++cp
)
396 flash_add_byte (info
, &cword
, (*(uchar
*) cp
));
397 if ((rc
= flash_write_cfiword (info
, wp
, cword
)) != 0)
401 #ifdef CONFIG_SYS_FLASH_USE_BUFFER_WRITE
402 while (cnt
>= info
->portwidth
) {
403 i
= info
->buffer_size
> cnt
? cnt
: info
->buffer_size
;
404 if ((rc
= flash_write_cfibuffer (info
, wp
, src
, i
)) != ERR_OK
)
411 /* handle the aligned part */
412 while (cnt
>= info
->portwidth
) {
414 for (i
= 0; i
< info
->portwidth
; i
++) {
415 flash_add_byte (info
, &cword
, *src
++);
417 if ((rc
= flash_write_cfiword (info
, wp
, cword
)) != 0)
419 wp
+= info
->portwidth
;
420 cnt
-= info
->portwidth
;
422 #endif /* CONFIG_SYS_FLASH_USE_BUFFER_WRITE */
428 * handle unaligned tail bytes
431 for (i
= 0, cp
= wp
; (i
< info
->portwidth
) && (cnt
> 0); ++i
, ++cp
) {
432 flash_add_byte (info
, &cword
, *src
++);
435 for (; i
< info
->portwidth
; ++i
, ++cp
) {
436 flash_add_byte (info
, &cword
, (*(uchar
*) cp
));
439 return flash_write_cfiword (info
, wp
, cword
);
442 /*-----------------------------------------------------------------------
444 int flash_real_protect (flash_info_t
* info
, long sector
, int prot
)
448 flash_write_cmd (info
, sector
, 0, FLASH_CMD_CLEAR_STATUS
);
449 flash_write_cmd (info
, sector
, 0, FLASH_CMD_PROTECT
);
451 flash_write_cmd (info
, sector
, 0, FLASH_CMD_PROTECT_SET
);
453 flash_write_cmd (info
, sector
, 0, FLASH_CMD_PROTECT_CLEAR
);
456 flash_full_status_check (info
, sector
, info
->erase_blk_tout
,
457 prot
? "protect" : "unprotect")) == 0) {
459 info
->protect
[sector
] = prot
;
460 /* Intel's unprotect unprotects all locking */
464 for (i
= 0; i
< info
->sector_count
; i
++) {
465 if (info
->protect
[i
])
466 flash_real_protect (info
, i
, 1);
474 /*-----------------------------------------------------------------------
475 * wait for XSR.7 to be set. Time out with an error if it does not.
476 * This routine does not set the flash to read-array mode.
478 static int flash_status_check (flash_info_t
* info
, ulong sector
, ulong tout
,
483 /* Wait for command completion */
484 start
= get_timer (0);
485 while (!flash_isset (info
, sector
, 0, FLASH_STATUS_DONE
)) {
486 if (get_timer (start
) > info
->erase_blk_tout
) {
487 printf ("Flash %s timeout at address %lx\n", prompt
,
488 info
->start
[sector
]);
489 flash_write_cmd (info
, sector
, 0, FLASH_CMD_RESET
);
496 /*-----------------------------------------------------------------------
497 * Wait for XSR.7 to be set, if it times out print an error, otherwise do a full status check.
498 * This routine sets the flash to read-array mode.
500 static int flash_full_status_check (flash_info_t
* info
, ulong sector
,
501 ulong tout
, char *prompt
)
505 retcode
= flash_status_check (info
, sector
, tout
, prompt
);
506 if ((retcode
== ERR_OK
)
507 && !flash_isequal (info
, sector
, 0, FLASH_STATUS_DONE
)) {
509 printf ("Flash %s error at address %lx\n", prompt
,
510 info
->start
[sector
]);
513 FLASH_STATUS_ECLBS
| FLASH_STATUS_PSLBS
)) {
514 printf ("Command Sequence Error.\n");
515 } else if (flash_isset (info
, sector
, 0, FLASH_STATUS_ECLBS
)) {
516 printf ("Block Erase Error.\n");
517 retcode
= ERR_NOT_ERASED
;
518 } else if (flash_isset (info
, sector
, 0, FLASH_STATUS_PSLBS
)) {
519 printf ("Locking Error\n");
521 if (flash_isset (info
, sector
, 0, FLASH_STATUS_DPS
)) {
522 printf ("Block locked.\n");
523 retcode
= ERR_PROTECTED
;
525 if (flash_isset (info
, sector
, 0, FLASH_STATUS_VPENS
))
526 printf ("Vpp Low Error.\n");
528 flash_write_cmd (info
, sector
, 0, FLASH_CMD_RESET
);
532 /*-----------------------------------------------------------------------
534 static void flash_add_byte (flash_info_t
* info
, cfiword_t
* cword
, uchar c
)
536 switch (info
->portwidth
) {
540 case FLASH_CFI_16BIT
:
541 cword
->w
= (cword
->w
<< 8) | c
;
543 case FLASH_CFI_32BIT
:
544 cword
->l
= (cword
->l
<< 8) | c
;
548 /*-----------------------------------------------------------------------
549 * make a proper sized command based on the port and chip widths
551 static void flash_make_cmd (flash_info_t
* info
, uchar cmd
, void *cmdbuf
)
554 uchar
*cp
= (uchar
*) cmdbuf
;
556 /* for(i=0; i< info->portwidth; i++) */
557 /* *cp++ = ((i+1) % info->chipwidth) ? '\0':cmd; */
558 if (info
->portwidth
== FLASH_CFI_8BIT
559 && info
->chipwidth
== FLASH_CFI_16BIT
) {
561 } else if (info
->portwidth
== FLASH_CFI_16BIT
562 && info
->chipwidth
== FLASH_CFI_16BIT
) {
569 * Write a proper sized command to the correct address
571 static void flash_write_cmd (flash_info_t
* info
, int sect
, uchar offset
,
575 volatile cfiptr_t addr
;
578 addr
.cp
= flash_make_addr (info
, sect
, offset
);
579 flash_make_cmd (info
, cmd
, &cword
);
580 switch (info
->portwidth
) {
584 case FLASH_CFI_16BIT
:
587 case FLASH_CFI_32BIT
:
593 /*-----------------------------------------------------------------------
595 static int flash_isequal (flash_info_t
* info
, int sect
, uchar offset
,
602 cptr
.cp
= flash_make_addr (info
, sect
, offset
);
603 flash_make_cmd (info
, cmd
, &cword
);
604 switch (info
->portwidth
) {
606 retval
= (cptr
.cp
[0] == cword
.c
);
608 case FLASH_CFI_16BIT
:
609 retval
= (cptr
.wp
[0] == cword
.w
);
611 case FLASH_CFI_32BIT
:
612 retval
= (cptr
.lp
[0] == cword
.l
);
621 /*-----------------------------------------------------------------------
623 static int flash_isset (flash_info_t
* info
, int sect
, uchar offset
,
630 cptr
.cp
= flash_make_addr (info
, sect
, offset
);
631 flash_make_cmd (info
, cmd
, &cword
);
632 switch (info
->portwidth
) {
634 retval
= ((cptr
.cp
[0] & cword
.c
) == cword
.c
);
636 case FLASH_CFI_16BIT
:
637 retval
= ((cptr
.wp
[0] & cword
.w
) == cword
.w
);
639 case FLASH_CFI_32BIT
:
640 retval
= ((cptr
.lp
[0] & cword
.l
) == cword
.l
);
649 /*-----------------------------------------------------------------------
650 * detect if flash is compatible with the Common Flash Interface (CFI)
651 * http://www.jedec.org/download/search/jesd68.pdf
654 static int flash_detect_cfi (flash_info_t
* info
)
658 for (info
->portwidth
= FLASH_CFI_8BIT
;
659 info
->portwidth
<= FLASH_CFI_32BIT
; info
->portwidth
<<= 1) {
660 for (info
->chipwidth
= FLASH_CFI_BY8
;
661 info
->chipwidth
<= info
->portwidth
;
662 info
->chipwidth
<<= 1) {
663 flash_write_cmd (info
, 0, 0, FLASH_CMD_RESET
);
664 flash_write_cmd (info
, 0, FLASH_OFFSET_CFI
,
667 (info
, 0, FLASH_OFFSET_CFI_RESP
, 'Q')
668 && flash_isequal (info
, 0,
669 FLASH_OFFSET_CFI_RESP
+ 1, 'R')
670 && flash_isequal (info
, 0,
671 FLASH_OFFSET_CFI_RESP
+ 2, 'Y'))
676 flash_write_cmd (info
, 0, 0, FLASH_CMD_RESET
);
677 flash_write_cmd (info
, 0, FLASH_OFFSET_CFI
, FLASH_CMD_CFI
);
678 if (flash_isequal (info
, 0, FLASH_OFFSET_CFI_RESP
, 'Q') &&
679 flash_isequal (info
, 0, FLASH_OFFSET_CFI_RESP
+ 1, 'R') &&
680 flash_isequal (info
, 0, FLASH_OFFSET_CFI_RESP
+ 2, 'Y')) {
688 * The following code cannot be run from FLASH!
691 static ulong
flash_get_size (ulong base
, int banknum
)
693 flash_info_t
*info
= &flash_info
[banknum
];
696 unsigned long sector
;
699 uchar num_erase_regions
;
700 int erase_region_size
;
701 int erase_region_count
;
703 info
->start
[0] = base
;
705 if (flash_detect_cfi (info
)) {
707 printf ("portwidth=%d chipwidth=%d\n", info
->portwidth
, info
->chipwidth
); /* test-only */
709 size_ratio
= 1; /* info->portwidth / info->chipwidth; */
711 flash_read_uchar (info
,
712 FLASH_OFFSET_NUM_ERASE_REGIONS
);
714 printf ("found %d erase regions\n", num_erase_regions
);
718 for (i
= 0; i
< num_erase_regions
; i
++) {
719 if (i
> NUM_ERASE_REGIONS
) {
720 printf ("%d erase regions found, only %d used\n", num_erase_regions
, NUM_ERASE_REGIONS
);
723 tmp
= flash_read_long (info
, 0,
724 FLASH_OFFSET_ERASE_REGIONS
);
725 erase_region_count
= (tmp
& 0xffff) + 1;
728 (tmp
& 0xffff) ? ((tmp
& 0xffff) * 256) : 128;
729 for (j
= 0; j
< erase_region_count
; j
++) {
730 info
->start
[sect_cnt
] = sector
;
731 sector
+= (erase_region_size
* size_ratio
);
732 info
->protect
[sect_cnt
] =
733 flash_isset (info
, sect_cnt
,
734 FLASH_OFFSET_PROTECT
,
735 FLASH_STATUS_PROTECT
);
740 info
->sector_count
= sect_cnt
;
741 /* multiply the size by the number of chips */
743 (1 << flash_read_uchar (info
, FLASH_OFFSET_SIZE
)) *
747 flash_read_ushort (info
, 0,
748 FLASH_OFFSET_BUFFER_SIZE
));
749 tmp
= 1 << flash_read_uchar (info
, FLASH_OFFSET_ETOUT
);
750 info
->erase_blk_tout
=
753 flash_read_uchar (info
, FLASH_OFFSET_EMAX_TOUT
)));
754 tmp
= 1 << flash_read_uchar (info
, FLASH_OFFSET_WBTOUT
);
755 info
->buffer_write_tout
=
758 flash_read_uchar (info
, FLASH_OFFSET_WBMAX_TOUT
)));
759 tmp
= 1 << flash_read_uchar (info
, FLASH_OFFSET_WTOUT
);
763 flash_read_uchar (info
,
764 FLASH_OFFSET_WMAX_TOUT
))) / 1000;
765 info
->flash_id
= FLASH_MAN_CFI
;
768 flash_write_cmd (info
, 0, 0, FLASH_CMD_RESET
);
772 /*-----------------------------------------------------------------------
774 static int flash_write_cfiword (flash_info_t
* info
, ulong dest
,
782 ctladdr
.cp
= flash_make_addr (info
, 0, 0);
783 cptr
.cp
= (uchar
*) dest
;
785 /* Check if Flash is (sufficiently) erased */
786 switch (info
->portwidth
) {
788 flag
= ((cptr
.cp
[0] & cword
.c
) == cword
.c
);
790 case FLASH_CFI_16BIT
:
791 flag
= ((cptr
.wp
[0] & cword
.w
) == cword
.w
);
793 case FLASH_CFI_32BIT
:
794 flag
= ((cptr
.lp
[0] & cword
.l
) == cword
.l
);
802 /* Disable interrupts which might cause a timeout here */
803 flag
= disable_interrupts ();
805 flash_write_cmd (info
, 0, 0, FLASH_CMD_CLEAR_STATUS
);
806 flash_write_cmd (info
, 0, 0, FLASH_CMD_WRITE
);
808 switch (info
->portwidth
) {
810 cptr
.cp
[0] = cword
.c
;
812 case FLASH_CFI_16BIT
:
813 cptr
.wp
[0] = cword
.w
;
815 case FLASH_CFI_32BIT
:
816 cptr
.lp
[0] = cword
.l
;
820 /* re-enable interrupts if necessary */
822 enable_interrupts ();
824 return flash_full_status_check (info
, 0, info
->write_tout
, "write");
827 #ifdef CONFIG_SYS_FLASH_USE_BUFFER_WRITE
829 /* loop through the sectors from the highest address
830 * when the passed address is greater or equal to the sector address
833 static int find_sector (flash_info_t
* info
, ulong addr
)
837 for (sector
= info
->sector_count
- 1; sector
>= 0; sector
--) {
838 if (addr
>= info
->start
[sector
])
844 static int flash_write_cfibuffer (flash_info_t
* info
, ulong dest
, uchar
* cp
,
851 volatile cfiptr_t src
;
852 volatile cfiptr_t dst
;
855 dst
.cp
= (uchar
*) dest
;
856 sector
= find_sector (info
, dest
);
857 flash_write_cmd (info
, sector
, 0, FLASH_CMD_CLEAR_STATUS
);
858 flash_write_cmd (info
, sector
, 0, FLASH_CMD_WRITE_TO_BUFFER
);
860 flash_status_check (info
, sector
, info
->buffer_write_tout
,
861 "write to buffer")) == ERR_OK
) {
862 switch (info
->portwidth
) {
866 case FLASH_CFI_16BIT
:
869 case FLASH_CFI_32BIT
:
876 flash_write_cmd (info
, sector
, 0, (uchar
) cnt
- 1);
878 switch (info
->portwidth
) {
880 *dst
.cp
++ = *src
.cp
++;
882 case FLASH_CFI_16BIT
:
883 *dst
.wp
++ = *src
.wp
++;
885 case FLASH_CFI_32BIT
:
886 *dst
.lp
++ = *src
.lp
++;
893 flash_write_cmd (info
, sector
, 0,
894 FLASH_CMD_WRITE_BUFFER_CONFIRM
);
896 flash_full_status_check (info
, sector
,
897 info
->buffer_write_tout
,
900 flash_write_cmd (info
, sector
, 0, FLASH_CMD_CLEAR_STATUS
);
903 #endif /* CONFIG_SYS_USE_FLASH_BUFFER_WRITE */