1
2
3
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
35
49
50
51
60
61
70
71
72
73
74
75
76
77
82
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
154
155
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
/* ... */
/* ... */
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
#include "imp.h"
#include <helper/binarybuffer.h>
#include <helper/time_support.h>
#include <target/algorithm.h>
#include <target/dsp5680xx.h>
5 includes
static int dsp5680xx_build_sector_list(struct flash_bank *bank)
{
bank->sectors = malloc(sizeof(struct flash_sector) * bank->num_sectors);
for (unsigned int i = 0; i < bank->num_sectors; ++i) {
bank->sectors[i].offset = i * HFM_SECTOR_SIZE;
bank->sectors[i].size = HFM_SECTOR_SIZE;
bank->sectors[i].is_erased = -1;
bank->sectors[i].is_protected = -1;
}for (unsigned int i = 0; i < bank->num_sectors; ++i) { ... }
LOG_USER("%s not tested yet.", __func__);
return ERROR_OK;
}{ ... }
FLASH_BANK_COMMAND_HANDLER(dsp5680xx_flash_bank_command)
{
bank->base = HFM_FLASH_BASE_ADDR;
bank->size = HFM_SIZE_BYTES;
bank->num_sectors = HFM_SECTOR_COUNT;
dsp5680xx_build_sector_list(bank);
return ERROR_OK;
}{ ... }
/* ... */
static int dsp5680xx_flash_protect_check(struct flash_bank *bank)
{
int retval = ERROR_OK;
uint16_t protected = 0;
retval = dsp5680xx_f_protect_check(bank->target, &protected);
if (retval != ERROR_OK) {
for (int i = 0; i < HFM_SECTOR_COUNT; i++)
bank->sectors[i].is_protected = -1;
return ERROR_OK;
}if (retval != ERROR_OK) { ... }
for (int i = 0; i < HFM_SECTOR_COUNT / 2; i++) {
if (protected & 1) {
bank->sectors[2 * i].is_protected = 1;
bank->sectors[2 * i + 1].is_protected = 1;
}if (protected & 1) { ... } else {
bank->sectors[2 * i].is_protected = 0;
bank->sectors[2 * i + 1].is_protected = 0;
}else { ... }
protected = (protected >> 1);
}for (int i = 0; i < HFM_SECTOR_COUNT / 2; i++) { ... }
return retval;
}{ ... }
/* ... */
static int dsp5680xx_flash_protect(struct flash_bank *bank, int set,
unsigned int first, unsigned int last)
{
/* ... */
int retval;
if (set)
retval = dsp5680xx_f_lock(bank->target);
else
retval = dsp5680xx_f_unlock(bank->target);
return retval;
}{ ... }
/* ... */
static int dsp5680xx_flash_write(struct flash_bank *bank, const uint8_t *buffer,
uint32_t offset, uint32_t count)
{
if ((offset + count / 2) > bank->size) {
LOG_ERROR("%s: Flash bank cannot fit data.", __func__);
return ERROR_FAIL;
}if ((offset + count / 2) > bank->size) { ... }
if (offset % 2) {
/* ... */
LOG_ERROR("%s: Writing to odd addresses not supported for this target", __func__);
return ERROR_FAIL;
}if (offset % 2) { ... }
return dsp5680xx_f_wr(bank->target, buffer, bank->base + offset / 2, count, 0);
}{ ... }
static int dsp5680xx_probe(struct flash_bank *bank)
{
LOG_DEBUG("%s not implemented", __func__);
return ERROR_OK;
}{ ... }
/* ... */
static int dsp5680xx_flash_erase(struct flash_bank *bank, unsigned int first,
unsigned int last)
{
return dsp5680xx_f_erase(bank->target, (uint32_t) first, (uint32_t) last);
}{ ... }
/* ... */
static int dsp5680xx_flash_erase_check(struct flash_bank *bank)
{
int retval = ERROR_OK;
uint8_t erased = 0;
uint32_t i;
for (i = 0; i < HFM_SECTOR_COUNT; i++) {
retval = dsp5680xx_f_erase_check(bank->target, &erased, i);
if (retval != ERROR_OK) {
bank->sectors[i].is_erased = -1;
}if (retval != ERROR_OK) { ... } else {
if (erased)
bank->sectors[i].is_erased = 1;
else
bank->sectors[i].is_erased = 0;
}else { ... }
}for (i = 0; i < HFM_SECTOR_COUNT; i++) { ... }
return retval;
}{ ... }
const struct flash_driver dsp5680xx_flash = {
.name = "dsp5680xx_flash",
.flash_bank_command = dsp5680xx_flash_bank_command,
.erase = dsp5680xx_flash_erase,
.protect = dsp5680xx_flash_protect,
.write = dsp5680xx_flash_write,
.probe = dsp5680xx_probe,
.auto_probe = dsp5680xx_probe,
.erase_check = dsp5680xx_flash_erase_check,
.protect_check = dsp5680xx_flash_protect_check,
...};