rtems_status_code lpc32xx_mlc_is_valid_block(uint32_t block_index)
{
uint32_t pages_per_block = lpc32xx_mlc_pages_per_block();
uint32_t page_begin = block_index * pages_per_block;
return is_valid_block(page_begin);
}
rtems_status_code lpc32xx_mlc_erase_block_safe(uint32_t block_index)
{
uint32_t pages_per_block = lpc32xx_mlc_pages_per_block();
uint32_t page_begin = block_index * pages_per_block;
uint32_t page_end = page_begin + pages_per_block;
return lpc32xx_mlc_erase_block_safe_3(
block_index,
page_begin,
page_end
);
}
rtems_status_code lpc32xx_mlc_read_blocks(
uint32_t block_begin,
uint32_t block_end,
lpc32xx_mlc_read_process process,
void *process_arg,
uint32_t page_buffer_0 [MLC_LARGE_DATA_WORD_COUNT],
uint32_t page_buffer_1 [MLC_LARGE_DATA_WORD_COUNT]
)
{
rtems_status_code sc = RTEMS_SUCCESSFUL;
uint32_t page_spare_0 [MLC_LARGE_SPARE_WORD_COUNT];
uint32_t page_spare_1 [MLC_LARGE_SPARE_WORD_COUNT];
uint32_t pages_per_block = lpc32xx_mlc_pages_per_block();
uint32_t page_size = lpc32xx_mlc_page_size();
uint32_t block = 0;
uint32_t first_page_of_block = block_begin * pages_per_block;
for (
block = block_begin;
block != block_end;
++block, first_page_of_block += pages_per_block
) {
uint32_t page = 0;
bool done = false;
sc = read_page(first_page_of_block, 0, page_buffer_0, page_spare_0);
if (sc == RTEMS_UNSATISFIED) {
continue;
} else if (sc != RTEMS_SUCCESSFUL) {
goto done;
}
sc = read_page(first_page_of_block, 1, page_buffer_1, page_spare_1);
if (sc == RTEMS_UNSATISFIED) {
continue;
} else if (sc != RTEMS_SUCCESSFUL) {
goto done;
}
done = (*process)(
process_arg,
first_page_of_block + 0,
page_size,
page_buffer_0,
page_spare_0
);
if (done) {
goto done;
}
done = (*process)(
process_arg,
first_page_of_block + 1,
page_size,
page_buffer_1,
page_spare_1
);
if (done) {
goto done;
}
for (page = 2; page < pages_per_block; ++page) {
sc = read_page(first_page_of_block, page, page_buffer_1, page_spare_1);
if (sc != RTEMS_SUCCESSFUL) {
goto done;
}
done = (*process)(
process_arg,
first_page_of_block + page,
page_size,
page_buffer_1,
page_spare_1
);
if (done) {
goto done;
}
}
}
done:
return sc;
}
rtems_status_code lpc32xx_mlc_write_blocks(
uint32_t block_begin,
uint32_t block_end,
const void *src,
size_t src_size,
uint32_t *page_data_buffer
)
{
rtems_status_code sc = RTEMS_SUCCESSFUL;
uint32_t pages_per_block = lpc32xx_mlc_pages_per_block();
uint32_t block_count = lpc32xx_mlc_block_count();
uint32_t page_size = lpc32xx_mlc_page_size();
uint32_t block = 0;
const uint8_t *current = src;
const uint8_t *last = current;
const uint8_t *end = current + src_size;
if (block_begin > block_end || block_end > block_count) {
return RTEMS_INVALID_ID;
}
for (block = block_begin; block != block_end; ++block) {
uint32_t page_begin = block * pages_per_block;
uint32_t page_end = page_begin + pages_per_block;
uint32_t page = 0;
sc = lpc32xx_mlc_erase_block_safe_3(block, page_begin, page_end);
if (sc != RTEMS_SUCCESSFUL) {
continue;
}
for (page = page_begin; page < page_end; ++page) {
uintptr_t remainder = (uintptr_t) end - (uintptr_t) current;
size_t delta = remainder < page_size ? remainder : page_size;
if (remainder > 0) {
memcpy(page_data_buffer, current, delta);
sc = lpc32xx_mlc_write_page_with_ecc(
page,
page_data_buffer,
ones_spare
);
if (sc != RTEMS_SUCCESSFUL) {
lpc32xx_mlc_erase_block_safe_3(block, page_begin, page_end);
lpc32xx_mlc_zero_pages(page_begin, page_end);
current = last;
continue;
}
current += delta;
} else {
goto done;
}
}
last = current;
}
done:
if (current != end) {
return RTEMS_IO_ERROR;
}
return RTEMS_SUCCESSFUL;
}
