1
2
3
4
5
6
7
8
9#include <common.h>
10#include <malloc.h>
11#include <post.h>
12#include <flash.h>
13
14#if CONFIG_POST & CONFIG_SYS_POST_FLASH
15
16
17
18
19
20
21
22
23
24
25
26#ifndef CONFIG_SYS_POST_FLASH_NUM
27# define CONFIG_SYS_POST_FLASH_NUM 0
28#endif
29#if CONFIG_SYS_POST_FLASH_START >= CONFIG_SYS_POST_FLASH_END
30# error "invalid flash block start/end"
31#endif
32
33extern flash_info_t flash_info[];
34
35static void *seed_src_data(void *ptr, ulong *old_len, ulong new_len)
36{
37 unsigned char *p;
38 ulong i;
39
40 p = ptr = realloc(ptr, new_len);
41 if (!ptr)
42 return ptr;
43
44 for (i = *old_len; i < new_len; ++i)
45 p[i] = i;
46
47 *old_len = new_len;
48
49 return ptr;
50}
51
52int flash_post_test(int flags)
53{
54 ulong len;
55 void *src;
56 int ret, n, n_start, n_end;
57 flash_info_t *info;
58
59
60 puts("\n");
61
62 len = 0;
63 src = NULL;
64 info = &flash_info[CONFIG_SYS_POST_FLASH_NUM];
65 n_start = CONFIG_SYS_POST_FLASH_START;
66 n_end = CONFIG_SYS_POST_FLASH_END;
67
68 for (n = n_start; n < n_end; ++n) {
69 ulong s_start, s_len, s_off;
70
71 s_start = info->start[n];
72 s_len = flash_sector_size(info, n);
73 s_off = s_start - info->start[0];
74
75 src = seed_src_data(src, &len, s_len);
76 if (!src) {
77 printf("malloc(%#lx) failed\n", s_len);
78 return 1;
79 }
80
81 printf("\tsector %i: %#lx +%#lx", n, s_start, s_len);
82
83 ret = flash_erase(info, n, n + 1);
84 if (ret) {
85 flash_perror(ret);
86 break;
87 }
88
89 ret = write_buff(info, src, s_start, s_len);
90 if (ret) {
91 flash_perror(ret);
92 break;
93 }
94
95 ret = memcmp(src, (void *)s_start, s_len);
96 if (ret) {
97 printf(" verify failed with %i\n", ret);
98 break;
99 }
100 }
101
102 free(src);
103
104 return ret;
105}
106
107#endif
108