Lines Matching full:ns
9 * Note: NS means "NAND Simulator".
190 #define NS_IS_INITIALIZED(ns) ((ns)->geom.totsz != 0) argument
193 #define NS_STATUS_OK(ns) (NAND_STATUS_READY | (NAND_STATUS_WP * ((ns)->lines.wp == 0))) argument
196 #define NS_STATUS_FAILED(ns) (NAND_STATUS_FAIL | NS_STATUS_OK(ns)) argument
199 #define NS_RAW_OFFSET(ns) \ argument
200 (((ns)->regs.row * (ns)->geom.pgszoob) + (ns)->regs.column)
203 #define NS_RAW_OFFSET_OOB(ns) (NS_RAW_OFFSET(ns) + ns->geom.pgsz) argument
489 DEFINE_SHOW_ATTRIBUTE(ns);
493 * @ns: nandsim device description object
498 static int ns_debugfs_create(struct nandsim *ns) in ns_debugfs_create() argument
513 ns->dent = debugfs_create_file("nandsim_wear_report", 0400, root, ns, in ns_debugfs_create()
515 if (IS_ERR_OR_NULL(ns->dent)) { in ns_debugfs_create()
523 static void ns_debugfs_remove(struct nandsim *ns) in ns_debugfs_remove() argument
525 debugfs_remove_recursive(ns->dent); in ns_debugfs_remove()
534 static int __init ns_alloc_device(struct nandsim *ns) in ns_alloc_device() argument
553 ns->pages_written = in ns_alloc_device()
555 BITS_TO_LONGS(ns->geom.pgnum))); in ns_alloc_device()
556 if (!ns->pages_written) { in ns_alloc_device()
561 ns->file_buf = kmalloc(ns->geom.pgszoob, GFP_KERNEL); in ns_alloc_device()
562 if (!ns->file_buf) { in ns_alloc_device()
567 ns->cfile = cfile; in ns_alloc_device()
572 vfree(ns->pages_written); in ns_alloc_device()
579 ns->pages = vmalloc(array_size(sizeof(union ns_mem), ns->geom.pgnum)); in ns_alloc_device()
580 if (!ns->pages) { in ns_alloc_device()
584 for (i = 0; i < ns->geom.pgnum; i++) { in ns_alloc_device()
585 ns->pages[i].byte = NULL; in ns_alloc_device()
587 ns->nand_pages_slab = kmem_cache_create("nandsim", in ns_alloc_device()
588 ns->geom.pgszoob, 0, 0, NULL); in ns_alloc_device()
589 if (!ns->nand_pages_slab) { in ns_alloc_device()
598 vfree(ns->pages); in ns_alloc_device()
606 static void ns_free_device(struct nandsim *ns) in ns_free_device() argument
610 if (ns->cfile) { in ns_free_device()
611 kfree(ns->file_buf); in ns_free_device()
612 vfree(ns->pages_written); in ns_free_device()
613 filp_close(ns->cfile, NULL); in ns_free_device()
617 if (ns->pages) { in ns_free_device()
618 for (i = 0; i < ns->geom.pgnum; i++) { in ns_free_device()
619 if (ns->pages[i].byte) in ns_free_device()
620 kmem_cache_free(ns->nand_pages_slab, in ns_free_device()
621 ns->pages[i].byte); in ns_free_device()
623 kmem_cache_destroy(ns->nand_pages_slab); in ns_free_device()
624 vfree(ns->pages); in ns_free_device()
641 struct nandsim *ns = nand_get_controller_data(chip); in ns_init() local
646 if (NS_IS_INITIALIZED(ns)) { in ns_init()
652 ns->busw = chip->options & NAND_BUSWIDTH_16 ? 16 : 8; in ns_init()
653 ns->geom.totsz = mtd->size; in ns_init()
654 ns->geom.pgsz = mtd->writesize; in ns_init()
655 ns->geom.oobsz = mtd->oobsize; in ns_init()
656 ns->geom.secsz = mtd->erasesize; in ns_init()
657 ns->geom.pgszoob = ns->geom.pgsz + ns->geom.oobsz; in ns_init()
658 ns->geom.pgnum = div_u64(ns->geom.totsz, ns->geom.pgsz); in ns_init()
659 ns->geom.totszoob = ns->geom.totsz + (uint64_t)ns->geom.pgnum * ns->geom.oobsz; in ns_init()
660 ns->geom.secshift = ffs(ns->geom.secsz) - 1; in ns_init()
661 ns->geom.pgshift = chip->page_shift; in ns_init()
662 ns->geom.pgsec = ns->geom.secsz / ns->geom.pgsz; in ns_init()
663 ns->geom.secszoob = ns->geom.secsz + ns->geom.oobsz * ns->geom.pgsec; in ns_init()
664 ns->options = 0; in ns_init()
666 if (ns->geom.pgsz == 512) { in ns_init()
667 ns->options |= OPT_PAGE512; in ns_init()
668 if (ns->busw == 8) in ns_init()
669 ns->options |= OPT_PAGE512_8BIT; in ns_init()
670 } else if (ns->geom.pgsz == 2048) { in ns_init()
671 ns->options |= OPT_PAGE2048; in ns_init()
672 } else if (ns->geom.pgsz == 4096) { in ns_init()
673 ns->options |= OPT_PAGE4096; in ns_init()
675 NS_ERR("init_nandsim: unknown page size %u\n", ns->geom.pgsz); in ns_init()
679 if (ns->options & OPT_SMALLPAGE) { in ns_init()
680 if (ns->geom.totsz <= (32 << 20)) { in ns_init()
681 ns->geom.pgaddrbytes = 3; in ns_init()
682 ns->geom.secaddrbytes = 2; in ns_init()
684 ns->geom.pgaddrbytes = 4; in ns_init()
685 ns->geom.secaddrbytes = 3; in ns_init()
688 if (ns->geom.totsz <= (128 << 20)) { in ns_init()
689 ns->geom.pgaddrbytes = 4; in ns_init()
690 ns->geom.secaddrbytes = 2; in ns_init()
692 ns->geom.pgaddrbytes = 5; in ns_init()
693 ns->geom.secaddrbytes = 3; in ns_init()
698 if (parts_num > ARRAY_SIZE(ns->partitions)) { in ns_init()
702 remains = ns->geom.totsz; in ns_init()
705 uint64_t part_sz = (uint64_t)parts[i] * ns->geom.secsz; in ns_init()
711 ns->partitions[i].name = ns_get_partition_name(i); in ns_init()
712 if (!ns->partitions[i].name) { in ns_init()
716 ns->partitions[i].offset = next_offset; in ns_init()
717 ns->partitions[i].size = part_sz; in ns_init()
718 next_offset += ns->partitions[i].size; in ns_init()
719 remains -= ns->partitions[i].size; in ns_init()
721 ns->nbparts = parts_num; in ns_init()
723 if (parts_num + 1 > ARRAY_SIZE(ns->partitions)) { in ns_init()
728 ns->partitions[i].name = ns_get_partition_name(i); in ns_init()
729 if (!ns->partitions[i].name) { in ns_init()
734 ns->partitions[i].offset = next_offset; in ns_init()
735 ns->partitions[i].size = remains; in ns_init()
736 ns->nbparts += 1; in ns_init()
739 if (ns->busw == 16) in ns_init()
743 (unsigned long long)ns->geom.totsz >> 20); in ns_init()
744 printk("page size: %u bytes\n", ns->geom.pgsz); in ns_init()
745 printk("OOB area size: %u bytes\n", ns->geom.oobsz); in ns_init()
746 printk("sector size: %u KiB\n", ns->geom.secsz >> 10); in ns_init()
747 printk("pages number: %u\n", ns->geom.pgnum); in ns_init()
748 printk("pages per sector: %u\n", ns->geom.pgsec); in ns_init()
749 printk("bus width: %u\n", ns->busw); in ns_init()
750 printk("bits in sector size: %u\n", ns->geom.secshift); in ns_init()
751 printk("bits in page size: %u\n", ns->geom.pgshift); in ns_init()
752 printk("bits in OOB size: %u\n", ffs(ns->geom.oobsz) - 1); in ns_init()
754 (unsigned long long)ns->geom.totszoob >> 10); in ns_init()
755 printk("page address bytes: %u\n", ns->geom.pgaddrbytes); in ns_init()
756 printk("sector address bytes: %u\n", ns->geom.secaddrbytes); in ns_init()
757 printk("options: %#x\n", ns->options); in ns_init()
759 ret = ns_alloc_device(ns); in ns_init()
764 ns->buf.byte = kmalloc(ns->geom.pgszoob, GFP_KERNEL); in ns_init()
765 if (!ns->buf.byte) { in ns_init()
767 ns->geom.pgszoob); in ns_init()
771 memset(ns->buf.byte, 0xFF, ns->geom.pgszoob); in ns_init()
776 ns_free_device(ns); in ns_init()
778 for (i = 0; i < ARRAY_SIZE(ns->partitions); ++i) in ns_init()
779 kfree(ns->partitions[i].name); in ns_init()
787 static void ns_free(struct nandsim *ns) in ns_free() argument
791 for (i = 0; i < ARRAY_SIZE(ns->partitions); ++i) in ns_free()
792 kfree(ns->partitions[i].name); in ns_free()
794 kfree(ns->buf.byte); in ns_free()
795 ns_free_device(ns); in ns_free()
800 static int ns_parse_badblocks(struct nandsim *ns, struct mtd_info *mtd) in ns_parse_badblocks() argument
817 offset = (loff_t)erase_block_no * ns->geom.secsz; in ns_parse_badblocks()
1143 static inline void ns_accept_addr_byte(struct nandsim *ns, u_char bt) in ns_accept_addr_byte() argument
1147 if (ns->regs.count < (ns->geom.pgaddrbytes - ns->geom.secaddrbytes)) in ns_accept_addr_byte()
1148 ns->regs.column |= (byte << 8 * ns->regs.count); in ns_accept_addr_byte()
1150 ns->regs.row |= (byte << 8 * (ns->regs.count - in ns_accept_addr_byte()
1151 ns->geom.pgaddrbytes + in ns_accept_addr_byte()
1152 ns->geom.secaddrbytes)); in ns_accept_addr_byte()
1161 static inline void ns_switch_to_ready_state(struct nandsim *ns, u_char status) in ns_switch_to_ready_state() argument
1166 ns->state = STATE_READY; in ns_switch_to_ready_state()
1167 ns->nxstate = STATE_UNKNOWN; in ns_switch_to_ready_state()
1168 ns->op = NULL; in ns_switch_to_ready_state()
1169 ns->npstates = 0; in ns_switch_to_ready_state()
1170 ns->stateidx = 0; in ns_switch_to_ready_state()
1171 ns->regs.num = 0; in ns_switch_to_ready_state()
1172 ns->regs.count = 0; in ns_switch_to_ready_state()
1173 ns->regs.off = 0; in ns_switch_to_ready_state()
1174 ns->regs.row = 0; in ns_switch_to_ready_state()
1175 ns->regs.column = 0; in ns_switch_to_ready_state()
1176 ns->regs.status = status; in ns_switch_to_ready_state()
1185 * correspondent states chain. In this case ns->npstates = 0;
1189 * case the ns->pstates[] array contains previous states.
1193 * ns->pstates[0], ... ns->pstates[ns->npstates], ns->state
1196 * ns->ops, ns->state, ns->nxstate are initialized, ns->npstate is
1200 * ns->pstates.
1206 * ns->pstates[0], ... ns->pstates[ns->npstates], <address input>
1221 static int ns_find_operation(struct nandsim *ns, uint32_t flag) in ns_find_operation() argument
1230 if (!(ns->options & ops[i].reqopts)) in ns_find_operation()
1235 if (!(ops[i].states[ns->npstates] & STATE_ADDR_MASK)) in ns_find_operation()
1238 if (NS_STATE(ns->state) != NS_STATE(ops[i].states[ns->npstates])) in ns_find_operation()
1242 for (j = 0; j < ns->npstates; j++) in ns_find_operation()
1243 if (NS_STATE(ops[i].states[j]) != NS_STATE(ns->pstates[j]) in ns_find_operation()
1244 && (ns->options & ops[idx].reqopts)) { in ns_find_operation()
1257 ns->op = &ops[idx].states[0]; in ns_find_operation()
1264 * state must be the next state (ns->nxstate). in ns_find_operation()
1266 ns->stateidx = ns->npstates - 1; in ns_find_operation()
1268 ns->stateidx = ns->npstates; in ns_find_operation()
1270 ns->npstates = 0; in ns_find_operation()
1271 ns->state = ns->op[ns->stateidx]; in ns_find_operation()
1272 ns->nxstate = ns->op[ns->stateidx + 1]; in ns_find_operation()
1274 idx, ns_get_state_name(ns->state), in ns_find_operation()
1275 ns_get_state_name(ns->nxstate)); in ns_find_operation()
1281 if (ns->npstates != 0) { in ns_find_operation()
1283 ns_get_state_name(ns->state)); in ns_find_operation()
1284 ns->npstates = 0; in ns_find_operation()
1285 return ns_find_operation(ns, 0); in ns_find_operation()
1289 ns_switch_to_ready_state(ns, NS_STATUS_FAILED(ns)); in ns_find_operation()
1301 ns->pstates[ns->npstates++] = ns->state; in ns_find_operation()
1306 static void ns_put_pages(struct nandsim *ns) in ns_put_pages() argument
1310 for (i = 0; i < ns->held_cnt; i++) in ns_put_pages()
1311 put_page(ns->held_pages[i]); in ns_put_pages()
1315 static int ns_get_pages(struct nandsim *ns, struct file *file, size_t count, in ns_get_pages() argument
1326 ns->held_cnt = 0; in ns_get_pages()
1336 ns_put_pages(ns); in ns_get_pages()
1341 ns->held_pages[ns->held_cnt++] = page; in ns_get_pages()
1346 static ssize_t ns_read_file(struct nandsim *ns, struct file *file, void *buf, in ns_read_file() argument
1353 err = ns_get_pages(ns, file, count, pos); in ns_read_file()
1359 ns_put_pages(ns); in ns_read_file()
1363 static ssize_t ns_write_file(struct nandsim *ns, struct file *file, void *buf, in ns_write_file() argument
1370 err = ns_get_pages(ns, file, count, pos); in ns_write_file()
1376 ns_put_pages(ns); in ns_write_file()
1383 static inline union ns_mem *NS_GET_PAGE(struct nandsim *ns) in NS_GET_PAGE() argument
1385 return &(ns->pages[ns->regs.row]); in NS_GET_PAGE()
1391 static inline u_char *NS_PAGE_BYTE_OFF(struct nandsim *ns) in NS_PAGE_BYTE_OFF() argument
1393 return NS_GET_PAGE(ns)->byte + ns->regs.column + ns->regs.off; in NS_PAGE_BYTE_OFF()
1396 static int ns_do_read_error(struct nandsim *ns, int num) in ns_do_read_error() argument
1398 unsigned int page_no = ns->regs.row; in ns_do_read_error()
1401 prandom_bytes(ns->buf.byte, num); in ns_do_read_error()
1408 static void ns_do_bit_flips(struct nandsim *ns, int num) in ns_do_bit_flips() argument
1416 ns->buf.byte[pos / 8] ^= (1 << (pos % 8)); in ns_do_bit_flips()
1419 pos, ns->regs.row, ns->regs.column + ns->regs.off, in ns_do_bit_flips()
1428 static void ns_read_page(struct nandsim *ns, int num) in ns_read_page() argument
1432 if (ns->cfile) { in ns_read_page()
1433 if (!test_bit(ns->regs.row, ns->pages_written)) { in ns_read_page()
1434 NS_DBG("read_page: page %d not written\n", ns->regs.row); in ns_read_page()
1435 memset(ns->buf.byte, 0xFF, num); in ns_read_page()
1441 ns->regs.row, ns->regs.column + ns->regs.off); in ns_read_page()
1442 if (ns_do_read_error(ns, num)) in ns_read_page()
1444 pos = (loff_t)NS_RAW_OFFSET(ns) + ns->regs.off; in ns_read_page()
1445 tx = ns_read_file(ns, ns->cfile, ns->buf.byte, num, in ns_read_page()
1448 NS_ERR("read_page: read error for page %d ret %ld\n", ns->regs.row, (long)tx); in ns_read_page()
1451 ns_do_bit_flips(ns, num); in ns_read_page()
1456 mypage = NS_GET_PAGE(ns); in ns_read_page()
1458 NS_DBG("read_page: page %d not allocated\n", ns->regs.row); in ns_read_page()
1459 memset(ns->buf.byte, 0xFF, num); in ns_read_page()
1462 ns->regs.row, ns->regs.column + ns->regs.off); in ns_read_page()
1463 if (ns_do_read_error(ns, num)) in ns_read_page()
1465 memcpy(ns->buf.byte, NS_PAGE_BYTE_OFF(ns), num); in ns_read_page()
1466 ns_do_bit_flips(ns, num); in ns_read_page()
1473 static void ns_erase_sector(struct nandsim *ns) in ns_erase_sector() argument
1478 if (ns->cfile) { in ns_erase_sector()
1479 for (i = 0; i < ns->geom.pgsec; i++) in ns_erase_sector()
1480 if (__test_and_clear_bit(ns->regs.row + i, in ns_erase_sector()
1481 ns->pages_written)) { in ns_erase_sector()
1482 NS_DBG("erase_sector: freeing page %d\n", ns->regs.row + i); in ns_erase_sector()
1487 mypage = NS_GET_PAGE(ns); in ns_erase_sector()
1488 for (i = 0; i < ns->geom.pgsec; i++) { in ns_erase_sector()
1490 NS_DBG("erase_sector: freeing page %d\n", ns->regs.row+i); in ns_erase_sector()
1491 kmem_cache_free(ns->nand_pages_slab, mypage->byte); in ns_erase_sector()
1501 static int ns_prog_page(struct nandsim *ns, int num) in ns_prog_page() argument
1507 if (ns->cfile) { in ns_prog_page()
1512 NS_DBG("prog_page: writing page %d\n", ns->regs.row); in ns_prog_page()
1513 pg_off = ns->file_buf + ns->regs.column + ns->regs.off; in ns_prog_page()
1514 off = (loff_t)NS_RAW_OFFSET(ns) + ns->regs.off; in ns_prog_page()
1515 if (!test_bit(ns->regs.row, ns->pages_written)) { in ns_prog_page()
1517 memset(ns->file_buf, 0xff, ns->geom.pgszoob); in ns_prog_page()
1520 tx = ns_read_file(ns, ns->cfile, pg_off, num, off); in ns_prog_page()
1522 NS_ERR("prog_page: read error for page %d ret %ld\n", ns->regs.row, (long)tx); in ns_prog_page()
1527 pg_off[i] &= ns->buf.byte[i]; in ns_prog_page()
1529 loff_t pos = (loff_t)ns->regs.row * ns->geom.pgszoob; in ns_prog_page()
1530 tx = ns_write_file(ns, ns->cfile, ns->file_buf, in ns_prog_page()
1531 ns->geom.pgszoob, pos); in ns_prog_page()
1532 if (tx != ns->geom.pgszoob) { in ns_prog_page()
1533 NS_ERR("prog_page: write error for page %d ret %ld\n", ns->regs.row, (long)tx); in ns_prog_page()
1536 __set_bit(ns->regs.row, ns->pages_written); in ns_prog_page()
1538 tx = ns_write_file(ns, ns->cfile, pg_off, num, off); in ns_prog_page()
1540 NS_ERR("prog_page: write error for page %d ret %ld\n", ns->regs.row, (long)tx); in ns_prog_page()
1547 mypage = NS_GET_PAGE(ns); in ns_prog_page()
1549 NS_DBG("prog_page: allocating page %d\n", ns->regs.row); in ns_prog_page()
1556 mypage->byte = kmem_cache_alloc(ns->nand_pages_slab, GFP_NOFS); in ns_prog_page()
1558 NS_ERR("prog_page: error allocating memory for page %d\n", ns->regs.row); in ns_prog_page()
1561 memset(mypage->byte, 0xFF, ns->geom.pgszoob); in ns_prog_page()
1564 pg_off = NS_PAGE_BYTE_OFF(ns); in ns_prog_page()
1566 pg_off[i] &= ns->buf.byte[i]; in ns_prog_page()
1576 static int ns_do_state_action(struct nandsim *ns, uint32_t action) in ns_do_state_action() argument
1579 int busdiv = ns->busw == 8 ? 1 : 2; in ns_do_state_action()
1585 if (action != ACTION_SECERASE && ns->regs.row >= ns->geom.pgnum) { in ns_do_state_action()
1586 NS_WARN("do_state_action: wrong page number (%#x)\n", ns->regs.row); in ns_do_state_action()
1598 if (ns->regs.column >= (ns->geom.pgszoob - ns->regs.off)) { in ns_do_state_action()
1602 num = ns->geom.pgszoob - ns->regs.off - ns->regs.column; in ns_do_state_action()
1603 ns_read_page(ns, num); in ns_do_state_action()
1606 num, NS_RAW_OFFSET(ns) + ns->regs.off); in ns_do_state_action()
1608 if (ns->regs.off == 0) in ns_do_state_action()
1609 NS_LOG("read page %d\n", ns->regs.row); in ns_do_state_action()
1610 else if (ns->regs.off < ns->geom.pgsz) in ns_do_state_action()
1611 NS_LOG("read page %d (second half)\n", ns->regs.row); in ns_do_state_action()
1613 NS_LOG("read OOB of page %d\n", ns->regs.row); in ns_do_state_action()
1616 NS_UDELAY(input_cycle * ns->geom.pgsz / 1000 / busdiv); in ns_do_state_action()
1625 if (ns->lines.wp) { in ns_do_state_action()
1630 if (ns->regs.row >= ns->geom.pgnum - ns->geom.pgsec in ns_do_state_action()
1631 || (ns->regs.row & ~(ns->geom.secsz - 1))) { in ns_do_state_action()
1632 NS_ERR("do_state_action: wrong sector address (%#x)\n", ns->regs.row); in ns_do_state_action()
1636 ns->regs.row = (ns->regs.row << in ns_do_state_action()
1637 8 * (ns->geom.pgaddrbytes - ns->geom.secaddrbytes)) | ns->regs.column; in ns_do_state_action()
1638 ns->regs.column = 0; in ns_do_state_action()
1640 erase_block_no = ns->regs.row >> (ns->geom.secshift - ns->geom.pgshift); in ns_do_state_action()
1643 ns->regs.row, NS_RAW_OFFSET(ns)); in ns_do_state_action()
1646 ns_erase_sector(ns); in ns_do_state_action()
1665 if (ns->lines.wp) { in ns_do_state_action()
1670 num = ns->geom.pgszoob - ns->regs.off - ns->regs.column; in ns_do_state_action()
1671 if (num != ns->regs.count) { in ns_do_state_action()
1673 ns->regs.count, num); in ns_do_state_action()
1677 if (ns_prog_page(ns, num) == -1) in ns_do_state_action()
1680 page_no = ns->regs.row; in ns_do_state_action()
1683 num, ns->regs.row, ns->regs.column, NS_RAW_OFFSET(ns) + ns->regs.off); in ns_do_state_action()
1684 NS_LOG("programm page %d\n", ns->regs.row); in ns_do_state_action()
1687 NS_UDELAY(output_cycle * ns->geom.pgsz / 1000 / busdiv); in ns_do_state_action()
1698 ns->regs.off = 0; in ns_do_state_action()
1702 if (!(ns->options & OPT_PAGE512_8BIT)) { in ns_do_state_action()
1707 NS_DBG("do_state_action: set internal offset to %d\n", ns->geom.pgsz/2); in ns_do_state_action()
1708 ns->regs.off = ns->geom.pgsz/2; in ns_do_state_action()
1712 NS_DBG("do_state_action: set internal offset to %d\n", ns->geom.pgsz); in ns_do_state_action()
1713 ns->regs.off = ns->geom.pgsz; in ns_do_state_action()
1726 static void ns_switch_state(struct nandsim *ns) in ns_switch_state() argument
1728 if (ns->op) { in ns_switch_state()
1734 ns->stateidx += 1; in ns_switch_state()
1735 ns->state = ns->nxstate; in ns_switch_state()
1736 ns->nxstate = ns->op[ns->stateidx + 1]; in ns_switch_state()
1740 ns_get_state_name(ns->state), in ns_switch_state()
1741 ns_get_state_name(ns->nxstate)); in ns_switch_state()
1744 if ((ns->state & ACTION_MASK) && in ns_switch_state()
1745 ns_do_state_action(ns, ns->state) < 0) { in ns_switch_state()
1746 ns_switch_to_ready_state(ns, NS_STATUS_FAILED(ns)); in ns_switch_state()
1760 ns->state = ns_get_state_by_command(ns->regs.command); in ns_switch_state()
1764 if (ns_find_operation(ns, 0)) in ns_switch_state()
1767 if ((ns->state & ACTION_MASK) && in ns_switch_state()
1768 ns_do_state_action(ns, ns->state) < 0) { in ns_switch_state()
1769 ns_switch_to_ready_state(ns, NS_STATUS_FAILED(ns)); in ns_switch_state()
1775 if ((ns->nxstate & STATE_ADDR_MASK) && ns->busw == 16) { in ns_switch_state()
1777 ns->regs.column <<= 1; in ns_switch_state()
1780 if (NS_STATE(ns->nxstate) == STATE_READY) { in ns_switch_state()
1785 u_char status = NS_STATUS_OK(ns); in ns_switch_state()
1788 if ((ns->state & (STATE_DATAIN_MASK | STATE_DATAOUT_MASK)) in ns_switch_state()
1789 && ns->regs.count != ns->regs.num) { in ns_switch_state()
1791 ns->regs.num - ns->regs.count); in ns_switch_state()
1792 status = NS_STATUS_FAILED(ns); in ns_switch_state()
1797 ns_switch_to_ready_state(ns, status); in ns_switch_state()
1800 } else if (ns->nxstate & (STATE_DATAIN_MASK | STATE_DATAOUT_MASK)) { in ns_switch_state()
1805 ns->state = ns->nxstate; in ns_switch_state()
1806 ns->nxstate = ns->op[++ns->stateidx + 1]; in ns_switch_state()
1807 ns->regs.num = ns->regs.count = 0; in ns_switch_state()
1811 ns_get_state_name(ns->state), in ns_switch_state()
1812 ns_get_state_name(ns->nxstate)); in ns_switch_state()
1818 switch (NS_STATE(ns->state)) { in ns_switch_state()
1821 ns->regs.num = ns->geom.pgszoob - ns->regs.off - ns->regs.column; in ns_switch_state()
1825 ns->regs.num = ns->geom.idbytes; in ns_switch_state()
1829 ns->regs.count = ns->regs.num = 0; in ns_switch_state()
1836 } else if (ns->nxstate & STATE_ADDR_MASK) { in ns_switch_state()
1842 ns->regs.count = 0; in ns_switch_state()
1844 switch (NS_STATE(ns->nxstate)) { in ns_switch_state()
1846 ns->regs.num = ns->geom.pgaddrbytes; in ns_switch_state()
1850 ns->regs.num = ns->geom.secaddrbytes; in ns_switch_state()
1854 ns->regs.num = 1; in ns_switch_state()
1859 ns->regs.num = ns->geom.pgaddrbytes - ns->geom.secaddrbytes; in ns_switch_state()
1870 ns->regs.num = 0; in ns_switch_state()
1871 ns->regs.count = 0; in ns_switch_state()
1877 struct nandsim *ns = nand_get_controller_data(chip); in ns_nand_read_byte() local
1881 if (!ns->lines.ce) { in ns_nand_read_byte()
1885 if (ns->lines.ale || ns->lines.cle) { in ns_nand_read_byte()
1889 if (!(ns->state & STATE_DATAOUT_MASK)) { in ns_nand_read_byte()
1891 ns_get_state_name(ns->state), (uint)outb); in ns_nand_read_byte()
1896 if (NS_STATE(ns->state) == STATE_DATAOUT_STATUS) { in ns_nand_read_byte()
1897 NS_DBG("read_byte: return %#x status\n", ns->regs.status); in ns_nand_read_byte()
1898 return ns->regs.status; in ns_nand_read_byte()
1902 if (ns->regs.count == ns->regs.num) { in ns_nand_read_byte()
1907 switch (NS_STATE(ns->state)) { in ns_nand_read_byte()
1909 if (ns->busw == 8) { in ns_nand_read_byte()
1910 outb = ns->buf.byte[ns->regs.count]; in ns_nand_read_byte()
1911 ns->regs.count += 1; in ns_nand_read_byte()
1913 outb = (u_char)cpu_to_le16(ns->buf.word[ns->regs.count >> 1]); in ns_nand_read_byte()
1914 ns->regs.count += 2; in ns_nand_read_byte()
1918 NS_DBG("read_byte: read ID byte %d, total = %d\n", ns->regs.count, ns->regs.num); in ns_nand_read_byte()
1919 outb = ns->ids[ns->regs.count]; in ns_nand_read_byte()
1920 ns->regs.count += 1; in ns_nand_read_byte()
1926 if (ns->regs.count == ns->regs.num) { in ns_nand_read_byte()
1929 if (NS_STATE(ns->nxstate) == STATE_READY) in ns_nand_read_byte()
1930 ns_switch_state(ns); in ns_nand_read_byte()
1938 struct nandsim *ns = nand_get_controller_data(chip); in ns_nand_write_byte() local
1941 if (!ns->lines.ce) { in ns_nand_write_byte()
1945 if (ns->lines.ale && ns->lines.cle) { in ns_nand_write_byte()
1950 if (ns->lines.cle == 1) { in ns_nand_write_byte()
1957 ns_switch_to_ready_state(ns, NS_STATUS_OK(ns)); in ns_nand_write_byte()
1967 if (NS_STATE(ns->state) == STATE_DATAOUT_STATUS in ns_nand_write_byte()
1968 || NS_STATE(ns->state) == STATE_DATAOUT) { in ns_nand_write_byte()
1969 int row = ns->regs.row; in ns_nand_write_byte()
1971 ns_switch_state(ns); in ns_nand_write_byte()
1973 ns->regs.row = row; in ns_nand_write_byte()
1977 if (NS_STATE(ns->nxstate) != STATE_UNKNOWN && !(ns->nxstate & STATE_CMD_MASK)) { in ns_nand_write_byte()
1979 if (!(ns->regs.command == NAND_CMD_READID && in ns_nand_write_byte()
1980 NS_STATE(ns->state) == STATE_DATAOUT_ID && ns->regs.count == 2)) { in ns_nand_write_byte()
1988 ns_get_state_name(ns->nxstate)); in ns_nand_write_byte()
1990 ns_switch_to_ready_state(ns, NS_STATUS_FAILED(ns)); in ns_nand_write_byte()
1995 ns->regs.command = byte; in ns_nand_write_byte()
1996 ns_switch_state(ns); in ns_nand_write_byte()
1998 } else if (ns->lines.ale == 1) { in ns_nand_write_byte()
2003 if (NS_STATE(ns->nxstate) == STATE_UNKNOWN) { in ns_nand_write_byte()
2007 if (ns_find_operation(ns, 1) < 0) in ns_nand_write_byte()
2010 if ((ns->state & ACTION_MASK) && in ns_nand_write_byte()
2011 ns_do_state_action(ns, ns->state) < 0) { in ns_nand_write_byte()
2012 ns_switch_to_ready_state(ns, in ns_nand_write_byte()
2013 NS_STATUS_FAILED(ns)); in ns_nand_write_byte()
2017 ns->regs.count = 0; in ns_nand_write_byte()
2018 switch (NS_STATE(ns->nxstate)) { in ns_nand_write_byte()
2020 ns->regs.num = ns->geom.pgaddrbytes; in ns_nand_write_byte()
2023 ns->regs.num = ns->geom.secaddrbytes; in ns_nand_write_byte()
2026 ns->regs.num = 1; in ns_nand_write_byte()
2034 if (!(ns->nxstate & STATE_ADDR_MASK)) { in ns_nand_write_byte()
2036 (uint)byte, ns_get_state_name(ns->nxstate)); in ns_nand_write_byte()
2037 ns_switch_to_ready_state(ns, NS_STATUS_FAILED(ns)); in ns_nand_write_byte()
2042 if (ns->regs.count == ns->regs.num) { in ns_nand_write_byte()
2044 ns_switch_to_ready_state(ns, NS_STATUS_FAILED(ns)); in ns_nand_write_byte()
2048 ns_accept_addr_byte(ns, byte); in ns_nand_write_byte()
2050 ns->regs.count += 1; in ns_nand_write_byte()
2053 (uint)byte, ns->regs.count, ns->regs.num); in ns_nand_write_byte()
2055 if (ns->regs.count == ns->regs.num) { in ns_nand_write_byte()
2056 NS_DBG("address (%#x, %#x) is accepted\n", ns->regs.row, ns->regs.column); in ns_nand_write_byte()
2057 ns_switch_state(ns); in ns_nand_write_byte()
2066 if (!(ns->state & STATE_DATAIN_MASK)) { in ns_nand_write_byte()
2068 (uint)byte, ns_get_state_name(ns->state), in ns_nand_write_byte()
2070 ns_switch_to_ready_state(ns, NS_STATUS_FAILED(ns)); in ns_nand_write_byte()
2075 if (ns->regs.count == ns->regs.num) { in ns_nand_write_byte()
2077 ns->regs.num); in ns_nand_write_byte()
2081 if (ns->busw == 8) { in ns_nand_write_byte()
2082 ns->buf.byte[ns->regs.count] = byte; in ns_nand_write_byte()
2083 ns->regs.count += 1; in ns_nand_write_byte()
2085 ns->buf.word[ns->regs.count >> 1] = cpu_to_le16((uint16_t)byte); in ns_nand_write_byte()
2086 ns->regs.count += 2; in ns_nand_write_byte()
2096 struct nandsim *ns = nand_get_controller_data(chip); in ns_nand_write_buf() local
2099 if (!(ns->state & STATE_DATAIN_MASK)) { in ns_nand_write_buf()
2101 ns_get_state_name(ns->state)); in ns_nand_write_buf()
2102 ns_switch_to_ready_state(ns, NS_STATUS_FAILED(ns)); in ns_nand_write_buf()
2107 if (ns->regs.count + len > ns->regs.num) { in ns_nand_write_buf()
2109 ns_switch_to_ready_state(ns, NS_STATUS_FAILED(ns)); in ns_nand_write_buf()
2113 memcpy(ns->buf.byte + ns->regs.count, buf, len); in ns_nand_write_buf()
2114 ns->regs.count += len; in ns_nand_write_buf()
2116 if (ns->regs.count == ns->regs.num) { in ns_nand_write_buf()
2117 NS_DBG("write_buf: %d bytes were written\n", ns->regs.count); in ns_nand_write_buf()
2123 struct nandsim *ns = nand_get_controller_data(chip); in ns_nand_read_buf() local
2126 if (!ns->lines.ce) { in ns_nand_read_buf()
2130 if (ns->lines.ale || ns->lines.cle) { in ns_nand_read_buf()
2134 if (!(ns->state & STATE_DATAOUT_MASK)) { in ns_nand_read_buf()
2136 ns_get_state_name(ns->state)); in ns_nand_read_buf()
2140 if (NS_STATE(ns->state) != STATE_DATAOUT) { in ns_nand_read_buf()
2150 if (ns->regs.count + len > ns->regs.num) { in ns_nand_read_buf()
2152 ns_switch_to_ready_state(ns, NS_STATUS_FAILED(ns)); in ns_nand_read_buf()
2156 memcpy(buf, ns->buf.byte + ns->regs.count, len); in ns_nand_read_buf()
2157 ns->regs.count += len; in ns_nand_read_buf()
2159 if (ns->regs.count == ns->regs.num) { in ns_nand_read_buf()
2160 if (NS_STATE(ns->nxstate) == STATE_READY) in ns_nand_read_buf()
2161 ns_switch_state(ns); in ns_nand_read_buf()
2173 struct nandsim *ns = nand_get_controller_data(chip); in ns_exec_op() local
2178 ns->lines.ce = 1; in ns_exec_op()
2182 ns->lines.cle = 0; in ns_exec_op()
2183 ns->lines.ale = 0; in ns_exec_op()
2187 ns->lines.cle = 1; in ns_exec_op()
2191 ns->lines.ale = 1; in ns_exec_op()
2260 struct nandsim *ns; in ns_init_module() local
2268 ns = kzalloc(sizeof(struct nandsim), GFP_KERNEL); in ns_init_module()
2269 if (!ns) { in ns_init_module()
2273 chip = &ns->chip; in ns_init_module()
2275 nand_set_controller_data(chip, (void *)ns); in ns_init_module()
2302 ns->geom.idbytes = 8; in ns_init_module()
2304 ns->geom.idbytes = 6; in ns_init_module()
2306 ns->geom.idbytes = 4; in ns_init_module()
2308 ns->geom.idbytes = 2; in ns_init_module()
2309 ns->regs.status = NS_STATUS_OK(ns); in ns_init_module()
2310 ns->nxstate = STATE_UNKNOWN; in ns_init_module()
2311 ns->options |= OPT_PAGE512; /* temporary value */ in ns_init_module()
2312 memcpy(ns->ids, id_bytes, sizeof(ns->ids)); in ns_init_module()
2314 ns->busw = 16; in ns_init_module()
2332 nand_controller_init(&ns->base); in ns_init_module()
2333 ns->base.ops = &ns_controller_ops; in ns_init_module()
2334 chip->controller = &ns->base; in ns_init_module()
2375 ret = ns_parse_badblocks(ns, nsmtd); in ns_init_module()
2380 ret = mtd_device_register(nsmtd, &ns->partitions[0], ns->nbparts); in ns_init_module()
2384 ret = ns_debugfs_create(ns); in ns_init_module()
2393 ns_free(ns); in ns_init_module()
2414 kfree(ns); in ns_init_module()
2427 struct nandsim *ns = nand_get_controller_data(chip); in ns_cleanup_module() local
2430 ns_debugfs_remove(ns); in ns_cleanup_module()
2432 ns_free(ns); in ns_cleanup_module()
2451 kfree(ns); in ns_cleanup_module()