Lines Matching refs:ns
189 #define NS_IS_INITIALIZED(ns) ((ns)->geom.totsz != 0) argument
192 #define NS_STATUS_OK(ns) (NAND_STATUS_READY | (NAND_STATUS_WP * ((ns)->lines.wp == 0))) argument
195 #define NS_STATUS_FAILED(ns) (NAND_STATUS_FAIL | NS_STATUS_OK(ns)) argument
198 #define NS_RAW_OFFSET(ns) \ argument
199 (((ns)->regs.row * (ns)->geom.pgszoob) + (ns)->regs.column)
202 #define NS_RAW_OFFSET_OOB(ns) (NS_RAW_OFFSET(ns) + ns->geom.pgsz) argument
488 DEFINE_SHOW_ATTRIBUTE(ns);
497 static int ns_debugfs_create(struct nandsim *ns) in ns_debugfs_create() argument
512 ns->dent = debugfs_create_file("nandsim_wear_report", 0400, root, ns, in ns_debugfs_create()
514 if (IS_ERR_OR_NULL(ns->dent)) { in ns_debugfs_create()
522 static void ns_debugfs_remove(struct nandsim *ns) in ns_debugfs_remove() argument
524 debugfs_remove_recursive(ns->dent); in ns_debugfs_remove()
533 static int __init ns_alloc_device(struct nandsim *ns) in ns_alloc_device() argument
552 ns->pages_written = in ns_alloc_device()
554 BITS_TO_LONGS(ns->geom.pgnum))); in ns_alloc_device()
555 if (!ns->pages_written) { in ns_alloc_device()
560 ns->file_buf = kmalloc(ns->geom.pgszoob, GFP_KERNEL); in ns_alloc_device()
561 if (!ns->file_buf) { in ns_alloc_device()
566 ns->cfile = cfile; in ns_alloc_device()
571 vfree(ns->pages_written); in ns_alloc_device()
578 ns->pages = vmalloc(array_size(sizeof(union ns_mem), ns->geom.pgnum)); in ns_alloc_device()
579 if (!ns->pages) { in ns_alloc_device()
583 for (i = 0; i < ns->geom.pgnum; i++) { in ns_alloc_device()
584 ns->pages[i].byte = NULL; in ns_alloc_device()
586 ns->nand_pages_slab = kmem_cache_create("nandsim", in ns_alloc_device()
587 ns->geom.pgszoob, 0, 0, NULL); in ns_alloc_device()
588 if (!ns->nand_pages_slab) { in ns_alloc_device()
597 vfree(ns->pages); in ns_alloc_device()
605 static void ns_free_device(struct nandsim *ns) in ns_free_device() argument
609 if (ns->cfile) { in ns_free_device()
610 kfree(ns->file_buf); in ns_free_device()
611 vfree(ns->pages_written); in ns_free_device()
612 filp_close(ns->cfile, NULL); in ns_free_device()
616 if (ns->pages) { in ns_free_device()
617 for (i = 0; i < ns->geom.pgnum; i++) { in ns_free_device()
618 if (ns->pages[i].byte) in ns_free_device()
619 kmem_cache_free(ns->nand_pages_slab, in ns_free_device()
620 ns->pages[i].byte); in ns_free_device()
622 kmem_cache_destroy(ns->nand_pages_slab); in ns_free_device()
623 vfree(ns->pages); in ns_free_device()
640 struct nandsim *ns = nand_get_controller_data(chip); in ns_init() local
645 if (NS_IS_INITIALIZED(ns)) { in ns_init()
651 ns->busw = chip->options & NAND_BUSWIDTH_16 ? 16 : 8; in ns_init()
652 ns->geom.totsz = mtd->size; in ns_init()
653 ns->geom.pgsz = mtd->writesize; in ns_init()
654 ns->geom.oobsz = mtd->oobsize; in ns_init()
655 ns->geom.secsz = mtd->erasesize; in ns_init()
656 ns->geom.pgszoob = ns->geom.pgsz + ns->geom.oobsz; in ns_init()
657 ns->geom.pgnum = div_u64(ns->geom.totsz, ns->geom.pgsz); in ns_init()
658 ns->geom.totszoob = ns->geom.totsz + (uint64_t)ns->geom.pgnum * ns->geom.oobsz; in ns_init()
659 ns->geom.secshift = ffs(ns->geom.secsz) - 1; in ns_init()
660 ns->geom.pgshift = chip->page_shift; in ns_init()
661 ns->geom.pgsec = ns->geom.secsz / ns->geom.pgsz; in ns_init()
662 ns->geom.secszoob = ns->geom.secsz + ns->geom.oobsz * ns->geom.pgsec; in ns_init()
663 ns->options = 0; in ns_init()
665 if (ns->geom.pgsz == 512) { in ns_init()
666 ns->options |= OPT_PAGE512; in ns_init()
667 if (ns->busw == 8) in ns_init()
668 ns->options |= OPT_PAGE512_8BIT; in ns_init()
669 } else if (ns->geom.pgsz == 2048) { in ns_init()
670 ns->options |= OPT_PAGE2048; in ns_init()
671 } else if (ns->geom.pgsz == 4096) { in ns_init()
672 ns->options |= OPT_PAGE4096; in ns_init()
674 NS_ERR("init_nandsim: unknown page size %u\n", ns->geom.pgsz); in ns_init()
678 if (ns->options & OPT_SMALLPAGE) { in ns_init()
679 if (ns->geom.totsz <= (32 << 20)) { in ns_init()
680 ns->geom.pgaddrbytes = 3; in ns_init()
681 ns->geom.secaddrbytes = 2; in ns_init()
683 ns->geom.pgaddrbytes = 4; in ns_init()
684 ns->geom.secaddrbytes = 3; in ns_init()
687 if (ns->geom.totsz <= (128 << 20)) { in ns_init()
688 ns->geom.pgaddrbytes = 4; in ns_init()
689 ns->geom.secaddrbytes = 2; in ns_init()
691 ns->geom.pgaddrbytes = 5; in ns_init()
692 ns->geom.secaddrbytes = 3; in ns_init()
697 if (parts_num > ARRAY_SIZE(ns->partitions)) { in ns_init()
701 remains = ns->geom.totsz; in ns_init()
704 uint64_t part_sz = (uint64_t)parts[i] * ns->geom.secsz; in ns_init()
710 ns->partitions[i].name = ns_get_partition_name(i); in ns_init()
711 if (!ns->partitions[i].name) { in ns_init()
715 ns->partitions[i].offset = next_offset; in ns_init()
716 ns->partitions[i].size = part_sz; in ns_init()
717 next_offset += ns->partitions[i].size; in ns_init()
718 remains -= ns->partitions[i].size; in ns_init()
720 ns->nbparts = parts_num; in ns_init()
722 if (parts_num + 1 > ARRAY_SIZE(ns->partitions)) { in ns_init()
727 ns->partitions[i].name = ns_get_partition_name(i); in ns_init()
728 if (!ns->partitions[i].name) { in ns_init()
733 ns->partitions[i].offset = next_offset; in ns_init()
734 ns->partitions[i].size = remains; in ns_init()
735 ns->nbparts += 1; in ns_init()
738 if (ns->busw == 16) in ns_init()
742 (unsigned long long)ns->geom.totsz >> 20); in ns_init()
743 printk("page size: %u bytes\n", ns->geom.pgsz); in ns_init()
744 printk("OOB area size: %u bytes\n", ns->geom.oobsz); in ns_init()
745 printk("sector size: %u KiB\n", ns->geom.secsz >> 10); in ns_init()
746 printk("pages number: %u\n", ns->geom.pgnum); in ns_init()
747 printk("pages per sector: %u\n", ns->geom.pgsec); in ns_init()
748 printk("bus width: %u\n", ns->busw); in ns_init()
749 printk("bits in sector size: %u\n", ns->geom.secshift); in ns_init()
750 printk("bits in page size: %u\n", ns->geom.pgshift); in ns_init()
751 printk("bits in OOB size: %u\n", ffs(ns->geom.oobsz) - 1); in ns_init()
753 (unsigned long long)ns->geom.totszoob >> 10); in ns_init()
754 printk("page address bytes: %u\n", ns->geom.pgaddrbytes); in ns_init()
755 printk("sector address bytes: %u\n", ns->geom.secaddrbytes); in ns_init()
756 printk("options: %#x\n", ns->options); in ns_init()
758 ret = ns_alloc_device(ns); in ns_init()
763 ns->buf.byte = kmalloc(ns->geom.pgszoob, GFP_KERNEL); in ns_init()
764 if (!ns->buf.byte) { in ns_init()
766 ns->geom.pgszoob); in ns_init()
770 memset(ns->buf.byte, 0xFF, ns->geom.pgszoob); in ns_init()
775 ns_free_device(ns); in ns_init()
777 for (i = 0; i < ARRAY_SIZE(ns->partitions); ++i) in ns_init()
778 kfree(ns->partitions[i].name); in ns_init()
786 static void ns_free(struct nandsim *ns) in ns_free() argument
790 for (i = 0; i < ARRAY_SIZE(ns->partitions); ++i) in ns_free()
791 kfree(ns->partitions[i].name); in ns_free()
793 kfree(ns->buf.byte); in ns_free()
794 ns_free_device(ns); in ns_free()
799 static int ns_parse_badblocks(struct nandsim *ns, struct mtd_info *mtd) in ns_parse_badblocks() argument
816 offset = (loff_t)erase_block_no * ns->geom.secsz; in ns_parse_badblocks()
1142 static inline void ns_accept_addr_byte(struct nandsim *ns, u_char bt) in ns_accept_addr_byte() argument
1146 if (ns->regs.count < (ns->geom.pgaddrbytes - ns->geom.secaddrbytes)) in ns_accept_addr_byte()
1147 ns->regs.column |= (byte << 8 * ns->regs.count); in ns_accept_addr_byte()
1149 ns->regs.row |= (byte << 8 * (ns->regs.count - in ns_accept_addr_byte()
1150 ns->geom.pgaddrbytes + in ns_accept_addr_byte()
1151 ns->geom.secaddrbytes)); in ns_accept_addr_byte()
1160 static inline void ns_switch_to_ready_state(struct nandsim *ns, u_char status) in ns_switch_to_ready_state() argument
1165 ns->state = STATE_READY; in ns_switch_to_ready_state()
1166 ns->nxstate = STATE_UNKNOWN; in ns_switch_to_ready_state()
1167 ns->op = NULL; in ns_switch_to_ready_state()
1168 ns->npstates = 0; in ns_switch_to_ready_state()
1169 ns->stateidx = 0; in ns_switch_to_ready_state()
1170 ns->regs.num = 0; in ns_switch_to_ready_state()
1171 ns->regs.count = 0; in ns_switch_to_ready_state()
1172 ns->regs.off = 0; in ns_switch_to_ready_state()
1173 ns->regs.row = 0; in ns_switch_to_ready_state()
1174 ns->regs.column = 0; in ns_switch_to_ready_state()
1175 ns->regs.status = status; in ns_switch_to_ready_state()
1220 static int ns_find_operation(struct nandsim *ns, uint32_t flag) in ns_find_operation() argument
1229 if (!(ns->options & ops[i].reqopts)) in ns_find_operation()
1234 if (!(ops[i].states[ns->npstates] & STATE_ADDR_MASK)) in ns_find_operation()
1237 if (NS_STATE(ns->state) != NS_STATE(ops[i].states[ns->npstates])) in ns_find_operation()
1241 for (j = 0; j < ns->npstates; j++) in ns_find_operation()
1242 if (NS_STATE(ops[i].states[j]) != NS_STATE(ns->pstates[j]) in ns_find_operation()
1243 && (ns->options & ops[idx].reqopts)) { in ns_find_operation()
1256 ns->op = &ops[idx].states[0]; in ns_find_operation()
1265 ns->stateidx = ns->npstates - 1; in ns_find_operation()
1267 ns->stateidx = ns->npstates; in ns_find_operation()
1269 ns->npstates = 0; in ns_find_operation()
1270 ns->state = ns->op[ns->stateidx]; in ns_find_operation()
1271 ns->nxstate = ns->op[ns->stateidx + 1]; in ns_find_operation()
1273 idx, ns_get_state_name(ns->state), in ns_find_operation()
1274 ns_get_state_name(ns->nxstate)); in ns_find_operation()
1280 if (ns->npstates != 0) { in ns_find_operation()
1282 ns_get_state_name(ns->state)); in ns_find_operation()
1283 ns->npstates = 0; in ns_find_operation()
1284 return ns_find_operation(ns, 0); in ns_find_operation()
1288 ns_switch_to_ready_state(ns, NS_STATUS_FAILED(ns)); in ns_find_operation()
1300 ns->pstates[ns->npstates++] = ns->state; in ns_find_operation()
1305 static void ns_put_pages(struct nandsim *ns) in ns_put_pages() argument
1309 for (i = 0; i < ns->held_cnt; i++) in ns_put_pages()
1310 put_page(ns->held_pages[i]); in ns_put_pages()
1314 static int ns_get_pages(struct nandsim *ns, struct file *file, size_t count, in ns_get_pages() argument
1325 ns->held_cnt = 0; in ns_get_pages()
1335 ns_put_pages(ns); in ns_get_pages()
1340 ns->held_pages[ns->held_cnt++] = page; in ns_get_pages()
1345 static ssize_t ns_read_file(struct nandsim *ns, struct file *file, void *buf, in ns_read_file() argument
1352 err = ns_get_pages(ns, file, count, pos); in ns_read_file()
1358 ns_put_pages(ns); in ns_read_file()
1362 static ssize_t ns_write_file(struct nandsim *ns, struct file *file, void *buf, in ns_write_file() argument
1369 err = ns_get_pages(ns, file, count, pos); in ns_write_file()
1375 ns_put_pages(ns); in ns_write_file()
1382 static inline union ns_mem *NS_GET_PAGE(struct nandsim *ns) in NS_GET_PAGE() argument
1384 return &(ns->pages[ns->regs.row]); in NS_GET_PAGE()
1390 static inline u_char *NS_PAGE_BYTE_OFF(struct nandsim *ns) in NS_PAGE_BYTE_OFF() argument
1392 return NS_GET_PAGE(ns)->byte + ns->regs.column + ns->regs.off; in NS_PAGE_BYTE_OFF()
1395 static int ns_do_read_error(struct nandsim *ns, int num) in ns_do_read_error() argument
1397 unsigned int page_no = ns->regs.row; in ns_do_read_error()
1400 prandom_bytes(ns->buf.byte, num); in ns_do_read_error()
1407 static void ns_do_bit_flips(struct nandsim *ns, int num) in ns_do_bit_flips() argument
1415 ns->buf.byte[pos / 8] ^= (1 << (pos % 8)); in ns_do_bit_flips()
1418 pos, ns->regs.row, ns->regs.column + ns->regs.off, in ns_do_bit_flips()
1427 static void ns_read_page(struct nandsim *ns, int num) in ns_read_page() argument
1431 if (ns->cfile) { in ns_read_page()
1432 if (!test_bit(ns->regs.row, ns->pages_written)) { in ns_read_page()
1433 NS_DBG("read_page: page %d not written\n", ns->regs.row); in ns_read_page()
1434 memset(ns->buf.byte, 0xFF, num); in ns_read_page()
1440 ns->regs.row, ns->regs.column + ns->regs.off); in ns_read_page()
1441 if (ns_do_read_error(ns, num)) in ns_read_page()
1443 pos = (loff_t)NS_RAW_OFFSET(ns) + ns->regs.off; in ns_read_page()
1444 tx = ns_read_file(ns, ns->cfile, ns->buf.byte, num, in ns_read_page()
1447 NS_ERR("read_page: read error for page %d ret %ld\n", ns->regs.row, (long)tx); in ns_read_page()
1450 ns_do_bit_flips(ns, num); in ns_read_page()
1455 mypage = NS_GET_PAGE(ns); in ns_read_page()
1457 NS_DBG("read_page: page %d not allocated\n", ns->regs.row); in ns_read_page()
1458 memset(ns->buf.byte, 0xFF, num); in ns_read_page()
1461 ns->regs.row, ns->regs.column + ns->regs.off); in ns_read_page()
1462 if (ns_do_read_error(ns, num)) in ns_read_page()
1464 memcpy(ns->buf.byte, NS_PAGE_BYTE_OFF(ns), num); in ns_read_page()
1465 ns_do_bit_flips(ns, num); in ns_read_page()
1472 static void ns_erase_sector(struct nandsim *ns) in ns_erase_sector() argument
1477 if (ns->cfile) { in ns_erase_sector()
1478 for (i = 0; i < ns->geom.pgsec; i++) in ns_erase_sector()
1479 if (__test_and_clear_bit(ns->regs.row + i, in ns_erase_sector()
1480 ns->pages_written)) { in ns_erase_sector()
1481 NS_DBG("erase_sector: freeing page %d\n", ns->regs.row + i); in ns_erase_sector()
1486 mypage = NS_GET_PAGE(ns); in ns_erase_sector()
1487 for (i = 0; i < ns->geom.pgsec; i++) { in ns_erase_sector()
1489 NS_DBG("erase_sector: freeing page %d\n", ns->regs.row+i); in ns_erase_sector()
1490 kmem_cache_free(ns->nand_pages_slab, mypage->byte); in ns_erase_sector()
1500 static int ns_prog_page(struct nandsim *ns, int num) in ns_prog_page() argument
1506 if (ns->cfile) { in ns_prog_page()
1511 NS_DBG("prog_page: writing page %d\n", ns->regs.row); in ns_prog_page()
1512 pg_off = ns->file_buf + ns->regs.column + ns->regs.off; in ns_prog_page()
1513 off = (loff_t)NS_RAW_OFFSET(ns) + ns->regs.off; in ns_prog_page()
1514 if (!test_bit(ns->regs.row, ns->pages_written)) { in ns_prog_page()
1516 memset(ns->file_buf, 0xff, ns->geom.pgszoob); in ns_prog_page()
1519 tx = ns_read_file(ns, ns->cfile, pg_off, num, off); in ns_prog_page()
1521 NS_ERR("prog_page: read error for page %d ret %ld\n", ns->regs.row, (long)tx); in ns_prog_page()
1526 pg_off[i] &= ns->buf.byte[i]; in ns_prog_page()
1528 loff_t pos = (loff_t)ns->regs.row * ns->geom.pgszoob; in ns_prog_page()
1529 tx = ns_write_file(ns, ns->cfile, ns->file_buf, in ns_prog_page()
1530 ns->geom.pgszoob, pos); in ns_prog_page()
1531 if (tx != ns->geom.pgszoob) { in ns_prog_page()
1532 NS_ERR("prog_page: write error for page %d ret %ld\n", ns->regs.row, (long)tx); in ns_prog_page()
1535 __set_bit(ns->regs.row, ns->pages_written); in ns_prog_page()
1537 tx = ns_write_file(ns, ns->cfile, pg_off, num, off); in ns_prog_page()
1539 NS_ERR("prog_page: write error for page %d ret %ld\n", ns->regs.row, (long)tx); in ns_prog_page()
1546 mypage = NS_GET_PAGE(ns); in ns_prog_page()
1548 NS_DBG("prog_page: allocating page %d\n", ns->regs.row); in ns_prog_page()
1555 mypage->byte = kmem_cache_alloc(ns->nand_pages_slab, GFP_NOFS); in ns_prog_page()
1557 NS_ERR("prog_page: error allocating memory for page %d\n", ns->regs.row); in ns_prog_page()
1560 memset(mypage->byte, 0xFF, ns->geom.pgszoob); in ns_prog_page()
1563 pg_off = NS_PAGE_BYTE_OFF(ns); in ns_prog_page()
1565 pg_off[i] &= ns->buf.byte[i]; in ns_prog_page()
1575 static int ns_do_state_action(struct nandsim *ns, uint32_t action) in ns_do_state_action() argument
1578 int busdiv = ns->busw == 8 ? 1 : 2; in ns_do_state_action()
1584 if (action != ACTION_SECERASE && ns->regs.row >= ns->geom.pgnum) { in ns_do_state_action()
1585 NS_WARN("do_state_action: wrong page number (%#x)\n", ns->regs.row); in ns_do_state_action()
1597 if (ns->regs.column >= (ns->geom.pgszoob - ns->regs.off)) { in ns_do_state_action()
1601 num = ns->geom.pgszoob - ns->regs.off - ns->regs.column; in ns_do_state_action()
1602 ns_read_page(ns, num); in ns_do_state_action()
1605 num, NS_RAW_OFFSET(ns) + ns->regs.off); in ns_do_state_action()
1607 if (ns->regs.off == 0) in ns_do_state_action()
1608 NS_LOG("read page %d\n", ns->regs.row); in ns_do_state_action()
1609 else if (ns->regs.off < ns->geom.pgsz) in ns_do_state_action()
1610 NS_LOG("read page %d (second half)\n", ns->regs.row); in ns_do_state_action()
1612 NS_LOG("read OOB of page %d\n", ns->regs.row); in ns_do_state_action()
1615 NS_UDELAY(input_cycle * ns->geom.pgsz / 1000 / busdiv); in ns_do_state_action()
1624 if (ns->lines.wp) { in ns_do_state_action()
1629 if (ns->regs.row >= ns->geom.pgnum - ns->geom.pgsec in ns_do_state_action()
1630 || (ns->regs.row & ~(ns->geom.secsz - 1))) { in ns_do_state_action()
1631 NS_ERR("do_state_action: wrong sector address (%#x)\n", ns->regs.row); in ns_do_state_action()
1635 ns->regs.row = (ns->regs.row << in ns_do_state_action()
1636 8 * (ns->geom.pgaddrbytes - ns->geom.secaddrbytes)) | ns->regs.column; in ns_do_state_action()
1637 ns->regs.column = 0; in ns_do_state_action()
1639 erase_block_no = ns->regs.row >> (ns->geom.secshift - ns->geom.pgshift); in ns_do_state_action()
1642 ns->regs.row, NS_RAW_OFFSET(ns)); in ns_do_state_action()
1645 ns_erase_sector(ns); in ns_do_state_action()
1664 if (ns->lines.wp) { in ns_do_state_action()
1669 num = ns->geom.pgszoob - ns->regs.off - ns->regs.column; in ns_do_state_action()
1670 if (num != ns->regs.count) { in ns_do_state_action()
1672 ns->regs.count, num); in ns_do_state_action()
1676 if (ns_prog_page(ns, num) == -1) in ns_do_state_action()
1679 page_no = ns->regs.row; in ns_do_state_action()
1682 num, ns->regs.row, ns->regs.column, NS_RAW_OFFSET(ns) + ns->regs.off); in ns_do_state_action()
1683 NS_LOG("programm page %d\n", ns->regs.row); in ns_do_state_action()
1686 NS_UDELAY(output_cycle * ns->geom.pgsz / 1000 / busdiv); in ns_do_state_action()
1697 ns->regs.off = 0; in ns_do_state_action()
1701 if (!(ns->options & OPT_PAGE512_8BIT)) { in ns_do_state_action()
1706 NS_DBG("do_state_action: set internal offset to %d\n", ns->geom.pgsz/2); in ns_do_state_action()
1707 ns->regs.off = ns->geom.pgsz/2; in ns_do_state_action()
1711 NS_DBG("do_state_action: set internal offset to %d\n", ns->geom.pgsz); in ns_do_state_action()
1712 ns->regs.off = ns->geom.pgsz; in ns_do_state_action()
1725 static void ns_switch_state(struct nandsim *ns) in ns_switch_state() argument
1727 if (ns->op) { in ns_switch_state()
1733 ns->stateidx += 1; in ns_switch_state()
1734 ns->state = ns->nxstate; in ns_switch_state()
1735 ns->nxstate = ns->op[ns->stateidx + 1]; in ns_switch_state()
1739 ns_get_state_name(ns->state), in ns_switch_state()
1740 ns_get_state_name(ns->nxstate)); in ns_switch_state()
1743 if ((ns->state & ACTION_MASK) && in ns_switch_state()
1744 ns_do_state_action(ns, ns->state) < 0) { in ns_switch_state()
1745 ns_switch_to_ready_state(ns, NS_STATUS_FAILED(ns)); in ns_switch_state()
1759 ns->state = ns_get_state_by_command(ns->regs.command); in ns_switch_state()
1763 if (ns_find_operation(ns, 0)) in ns_switch_state()
1766 if ((ns->state & ACTION_MASK) && in ns_switch_state()
1767 ns_do_state_action(ns, ns->state) < 0) { in ns_switch_state()
1768 ns_switch_to_ready_state(ns, NS_STATUS_FAILED(ns)); in ns_switch_state()
1774 if ((ns->nxstate & STATE_ADDR_MASK) && ns->busw == 16) { in ns_switch_state()
1776 ns->regs.column <<= 1; in ns_switch_state()
1779 if (NS_STATE(ns->nxstate) == STATE_READY) { in ns_switch_state()
1784 u_char status = NS_STATUS_OK(ns); in ns_switch_state()
1787 if ((ns->state & (STATE_DATAIN_MASK | STATE_DATAOUT_MASK)) in ns_switch_state()
1788 && ns->regs.count != ns->regs.num) { in ns_switch_state()
1790 ns->regs.num - ns->regs.count); in ns_switch_state()
1791 status = NS_STATUS_FAILED(ns); in ns_switch_state()
1796 ns_switch_to_ready_state(ns, status); in ns_switch_state()
1799 } else if (ns->nxstate & (STATE_DATAIN_MASK | STATE_DATAOUT_MASK)) { in ns_switch_state()
1804 ns->state = ns->nxstate; in ns_switch_state()
1805 ns->nxstate = ns->op[++ns->stateidx + 1]; in ns_switch_state()
1806 ns->regs.num = ns->regs.count = 0; in ns_switch_state()
1810 ns_get_state_name(ns->state), in ns_switch_state()
1811 ns_get_state_name(ns->nxstate)); in ns_switch_state()
1817 switch (NS_STATE(ns->state)) { in ns_switch_state()
1820 ns->regs.num = ns->geom.pgszoob - ns->regs.off - ns->regs.column; in ns_switch_state()
1824 ns->regs.num = ns->geom.idbytes; in ns_switch_state()
1828 ns->regs.count = ns->regs.num = 0; in ns_switch_state()
1835 } else if (ns->nxstate & STATE_ADDR_MASK) { in ns_switch_state()
1841 ns->regs.count = 0; in ns_switch_state()
1843 switch (NS_STATE(ns->nxstate)) { in ns_switch_state()
1845 ns->regs.num = ns->geom.pgaddrbytes; in ns_switch_state()
1849 ns->regs.num = ns->geom.secaddrbytes; in ns_switch_state()
1853 ns->regs.num = 1; in ns_switch_state()
1858 ns->regs.num = ns->geom.pgaddrbytes - ns->geom.secaddrbytes; in ns_switch_state()
1869 ns->regs.num = 0; in ns_switch_state()
1870 ns->regs.count = 0; in ns_switch_state()
1876 struct nandsim *ns = nand_get_controller_data(chip); in ns_nand_read_byte() local
1880 if (!ns->lines.ce) { in ns_nand_read_byte()
1884 if (ns->lines.ale || ns->lines.cle) { in ns_nand_read_byte()
1888 if (!(ns->state & STATE_DATAOUT_MASK)) { in ns_nand_read_byte()
1890 ns_get_state_name(ns->state), (uint)outb); in ns_nand_read_byte()
1895 if (NS_STATE(ns->state) == STATE_DATAOUT_STATUS) { in ns_nand_read_byte()
1896 NS_DBG("read_byte: return %#x status\n", ns->regs.status); in ns_nand_read_byte()
1897 return ns->regs.status; in ns_nand_read_byte()
1901 if (ns->regs.count == ns->regs.num) { in ns_nand_read_byte()
1906 switch (NS_STATE(ns->state)) { in ns_nand_read_byte()
1908 if (ns->busw == 8) { in ns_nand_read_byte()
1909 outb = ns->buf.byte[ns->regs.count]; in ns_nand_read_byte()
1910 ns->regs.count += 1; in ns_nand_read_byte()
1912 outb = (u_char)cpu_to_le16(ns->buf.word[ns->regs.count >> 1]); in ns_nand_read_byte()
1913 ns->regs.count += 2; in ns_nand_read_byte()
1917 NS_DBG("read_byte: read ID byte %d, total = %d\n", ns->regs.count, ns->regs.num); in ns_nand_read_byte()
1918 outb = ns->ids[ns->regs.count]; in ns_nand_read_byte()
1919 ns->regs.count += 1; in ns_nand_read_byte()
1925 if (ns->regs.count == ns->regs.num) { in ns_nand_read_byte()
1928 if (NS_STATE(ns->nxstate) == STATE_READY) in ns_nand_read_byte()
1929 ns_switch_state(ns); in ns_nand_read_byte()
1937 struct nandsim *ns = nand_get_controller_data(chip); in ns_nand_write_byte() local
1940 if (!ns->lines.ce) { in ns_nand_write_byte()
1944 if (ns->lines.ale && ns->lines.cle) { in ns_nand_write_byte()
1949 if (ns->lines.cle == 1) { in ns_nand_write_byte()
1956 ns_switch_to_ready_state(ns, NS_STATUS_OK(ns)); in ns_nand_write_byte()
1966 if (NS_STATE(ns->state) == STATE_DATAOUT_STATUS in ns_nand_write_byte()
1967 || NS_STATE(ns->state) == STATE_DATAOUT) { in ns_nand_write_byte()
1968 int row = ns->regs.row; in ns_nand_write_byte()
1970 ns_switch_state(ns); in ns_nand_write_byte()
1972 ns->regs.row = row; in ns_nand_write_byte()
1976 if (NS_STATE(ns->nxstate) != STATE_UNKNOWN && !(ns->nxstate & STATE_CMD_MASK)) { in ns_nand_write_byte()
1978 if (!(ns->regs.command == NAND_CMD_READID && in ns_nand_write_byte()
1979 NS_STATE(ns->state) == STATE_DATAOUT_ID && ns->regs.count == 2)) { in ns_nand_write_byte()
1987 ns_get_state_name(ns->nxstate)); in ns_nand_write_byte()
1989 ns_switch_to_ready_state(ns, NS_STATUS_FAILED(ns)); in ns_nand_write_byte()
1994 ns->regs.command = byte; in ns_nand_write_byte()
1995 ns_switch_state(ns); in ns_nand_write_byte()
1997 } else if (ns->lines.ale == 1) { in ns_nand_write_byte()
2002 if (NS_STATE(ns->nxstate) == STATE_UNKNOWN) { in ns_nand_write_byte()
2006 if (ns_find_operation(ns, 1) < 0) in ns_nand_write_byte()
2009 if ((ns->state & ACTION_MASK) && in ns_nand_write_byte()
2010 ns_do_state_action(ns, ns->state) < 0) { in ns_nand_write_byte()
2011 ns_switch_to_ready_state(ns, in ns_nand_write_byte()
2012 NS_STATUS_FAILED(ns)); in ns_nand_write_byte()
2016 ns->regs.count = 0; in ns_nand_write_byte()
2017 switch (NS_STATE(ns->nxstate)) { in ns_nand_write_byte()
2019 ns->regs.num = ns->geom.pgaddrbytes; in ns_nand_write_byte()
2022 ns->regs.num = ns->geom.secaddrbytes; in ns_nand_write_byte()
2025 ns->regs.num = 1; in ns_nand_write_byte()
2033 if (!(ns->nxstate & STATE_ADDR_MASK)) { in ns_nand_write_byte()
2035 (uint)byte, ns_get_state_name(ns->nxstate)); in ns_nand_write_byte()
2036 ns_switch_to_ready_state(ns, NS_STATUS_FAILED(ns)); in ns_nand_write_byte()
2041 if (ns->regs.count == ns->regs.num) { in ns_nand_write_byte()
2043 ns_switch_to_ready_state(ns, NS_STATUS_FAILED(ns)); in ns_nand_write_byte()
2047 ns_accept_addr_byte(ns, byte); in ns_nand_write_byte()
2049 ns->regs.count += 1; in ns_nand_write_byte()
2052 (uint)byte, ns->regs.count, ns->regs.num); in ns_nand_write_byte()
2054 if (ns->regs.count == ns->regs.num) { in ns_nand_write_byte()
2055 NS_DBG("address (%#x, %#x) is accepted\n", ns->regs.row, ns->regs.column); in ns_nand_write_byte()
2056 ns_switch_state(ns); in ns_nand_write_byte()
2065 if (!(ns->state & STATE_DATAIN_MASK)) { in ns_nand_write_byte()
2067 (uint)byte, ns_get_state_name(ns->state), in ns_nand_write_byte()
2069 ns_switch_to_ready_state(ns, NS_STATUS_FAILED(ns)); in ns_nand_write_byte()
2074 if (ns->regs.count == ns->regs.num) { in ns_nand_write_byte()
2076 ns->regs.num); in ns_nand_write_byte()
2080 if (ns->busw == 8) { in ns_nand_write_byte()
2081 ns->buf.byte[ns->regs.count] = byte; in ns_nand_write_byte()
2082 ns->regs.count += 1; in ns_nand_write_byte()
2084 ns->buf.word[ns->regs.count >> 1] = cpu_to_le16((uint16_t)byte); in ns_nand_write_byte()
2085 ns->regs.count += 2; in ns_nand_write_byte()
2095 struct nandsim *ns = nand_get_controller_data(chip); in ns_nand_write_buf() local
2098 if (!(ns->state & STATE_DATAIN_MASK)) { in ns_nand_write_buf()
2100 ns_get_state_name(ns->state)); in ns_nand_write_buf()
2101 ns_switch_to_ready_state(ns, NS_STATUS_FAILED(ns)); in ns_nand_write_buf()
2106 if (ns->regs.count + len > ns->regs.num) { in ns_nand_write_buf()
2108 ns_switch_to_ready_state(ns, NS_STATUS_FAILED(ns)); in ns_nand_write_buf()
2112 memcpy(ns->buf.byte + ns->regs.count, buf, len); in ns_nand_write_buf()
2113 ns->regs.count += len; in ns_nand_write_buf()
2115 if (ns->regs.count == ns->regs.num) { in ns_nand_write_buf()
2116 NS_DBG("write_buf: %d bytes were written\n", ns->regs.count); in ns_nand_write_buf()
2122 struct nandsim *ns = nand_get_controller_data(chip); in ns_nand_read_buf() local
2125 if (!ns->lines.ce) { in ns_nand_read_buf()
2129 if (ns->lines.ale || ns->lines.cle) { in ns_nand_read_buf()
2133 if (!(ns->state & STATE_DATAOUT_MASK)) { in ns_nand_read_buf()
2135 ns_get_state_name(ns->state)); in ns_nand_read_buf()
2139 if (NS_STATE(ns->state) != STATE_DATAOUT) { in ns_nand_read_buf()
2149 if (ns->regs.count + len > ns->regs.num) { in ns_nand_read_buf()
2151 ns_switch_to_ready_state(ns, NS_STATUS_FAILED(ns)); in ns_nand_read_buf()
2155 memcpy(buf, ns->buf.byte + ns->regs.count, len); in ns_nand_read_buf()
2156 ns->regs.count += len; in ns_nand_read_buf()
2158 if (ns->regs.count == ns->regs.num) { in ns_nand_read_buf()
2159 if (NS_STATE(ns->nxstate) == STATE_READY) in ns_nand_read_buf()
2160 ns_switch_state(ns); in ns_nand_read_buf()
2172 struct nandsim *ns = nand_get_controller_data(chip); in ns_exec_op() local
2177 ns->lines.ce = 1; in ns_exec_op()
2181 ns->lines.cle = 0; in ns_exec_op()
2182 ns->lines.ale = 0; in ns_exec_op()
2186 ns->lines.cle = 1; in ns_exec_op()
2190 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()
2300 ns->geom.idbytes = 8; in ns_init_module()
2302 ns->geom.idbytes = 6; in ns_init_module()
2304 ns->geom.idbytes = 4; in ns_init_module()
2306 ns->geom.idbytes = 2; in ns_init_module()
2307 ns->regs.status = NS_STATUS_OK(ns); in ns_init_module()
2308 ns->nxstate = STATE_UNKNOWN; in ns_init_module()
2309 ns->options |= OPT_PAGE512; /* temporary value */ in ns_init_module()
2310 memcpy(ns->ids, id_bytes, sizeof(ns->ids)); in ns_init_module()
2312 ns->busw = 16; in ns_init_module()
2330 nand_controller_init(&ns->base); in ns_init_module()
2331 ns->base.ops = &ns_controller_ops; in ns_init_module()
2332 chip->controller = &ns->base; in ns_init_module()
2373 ret = ns_parse_badblocks(ns, nsmtd); in ns_init_module()
2378 ret = mtd_device_register(nsmtd, &ns->partitions[0], ns->nbparts); in ns_init_module()
2382 ret = ns_debugfs_create(ns); in ns_init_module()
2391 ns_free(ns); in ns_init_module()
2412 kfree(ns); in ns_init_module()
2425 struct nandsim *ns = nand_get_controller_data(chip); in ns_cleanup_module() local
2428 ns_debugfs_remove(ns); in ns_cleanup_module()
2430 ns_free(ns); in ns_cleanup_module()
2449 kfree(ns); in ns_cleanup_module()