static rtems_status_code is_valid_block(uint32_t page_begin) { rtems_status_code sc = RTEMS_SUCCESSFUL; if (lpc32xx_mlc_page_size() == 512 && lpc32xx_mlc_io_width() == 8) { sc = is_valid_page(page_begin, 0); if (sc == RTEMS_SUCCESSFUL) { sc = is_valid_page(page_begin, 1); } } else { sc = RTEMS_NOT_IMPLEMENTED; } return sc; }
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; }