drivers/mtd/onenand/samsung.c

   1 /*
   2  * Samsung S3C64XX/S5PC1XX OneNAND driver
   3  *
   4  *  Copyright © 2008-2010 Samsung Electronics
   5  *  Kyungmin Park <kyungmin.park@samsung.com>
   6  *  Marek Szyprowski <m.szyprowski@samsung.com>
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License version 2 as
  10  * published by the Free Software Foundation.
  11  *
  12  * Implementation:
  13  *      S3C64XX and S5PC100: emulate the pseudo BufferRAM
  14  *      S5PC110: use DMA
  15  */
  16
  17 #include <linux/module.h>
  18 #include <linux/platform_device.h>
  19 #include <linux/sched.h>
  20 #include <linux/slab.h>
  21 #include <linux/mtd/mtd.h>
  22 #include <linux/mtd/onenand.h>
  23 #include <linux/mtd/partitions.h>
  24 #include <linux/dma-mapping.h>
  25 #include <linux/interrupt.h>
  26
  27 #include <asm/mach/flash.h>
  28 #include <plat/regs-onenand.h>
  29
  30 #include <linux/io.h>
  31
  32 enum soc_type {
  33         TYPE_S3C6400,
  34         TYPE_S3C6410,
  35         TYPE_S5PC100,
  36         TYPE_S5PC110,
  37 };
  38
  39 #define ONENAND_ERASE_STATUS            0x00
  40 #define ONENAND_MULTI_ERASE_SET         0x01
  41 #define ONENAND_ERASE_START             0x03
  42 #define ONENAND_UNLOCK_START            0x08
  43 #define ONENAND_UNLOCK_END              0x09
  44 #define ONENAND_LOCK_START              0x0A
  45 #define ONENAND_LOCK_END                0x0B
  46 #define ONENAND_LOCK_TIGHT_START        0x0C
  47 #define ONENAND_LOCK_TIGHT_END          0x0D
  48 #define ONENAND_UNLOCK_ALL              0x0E
  49 #define ONENAND_OTP_ACCESS              0x12
  50 #define ONENAND_SPARE_ACCESS_ONLY       0x13
  51 #define ONENAND_MAIN_ACCESS_ONLY        0x14
  52 #define ONENAND_ERASE_VERIFY            0x15
  53 #define ONENAND_MAIN_SPARE_ACCESS       0x16
  54 #define ONENAND_PIPELINE_READ           0x4000
  55
  56 #define MAP_00                          (0x0)
  57 #define MAP_01                          (0x1)
  58 #define MAP_10                          (0x2)
  59 #define MAP_11                          (0x3)
  60
  61 #define S3C64XX_CMD_MAP_SHIFT           24
  62 #define S5PC100_CMD_MAP_SHIFT           26
  63
  64 #define S3C6400_FBA_SHIFT               10
  65 #define S3C6400_FPA_SHIFT               4
  66 #define S3C6400_FSA_SHIFT               2
  67
  68 #define S3C6410_FBA_SHIFT               12
  69 #define S3C6410_FPA_SHIFT               6
  70 #define S3C6410_FSA_SHIFT               4
  71
  72 #define S5PC100_FBA_SHIFT               13
  73 #define S5PC100_FPA_SHIFT               7
  74 #define S5PC100_FSA_SHIFT               5
  75
  76 /* S5PC110 specific definitions */
  77 #define S5PC110_DMA_SRC_ADDR            0x400
  78 #define S5PC110_DMA_SRC_CFG             0x404
  79 #define S5PC110_DMA_DST_ADDR            0x408
  80 #define S5PC110_DMA_DST_CFG             0x40C
  81 #define S5PC110_DMA_TRANS_SIZE          0x414
  82 #define S5PC110_DMA_TRANS_CMD           0x418
  83 #define S5PC110_DMA_TRANS_STATUS        0x41C
  84 #define S5PC110_DMA_TRANS_DIR           0x420
  85 #define S5PC110_INTC_DMA_CLR            0x1004
  86 #define S5PC110_INTC_ONENAND_CLR        0x1008
  87 #define S5PC110_INTC_DMA_MASK           0x1024
  88 #define S5PC110_INTC_ONENAND_MASK       0x1028
  89 #define S5PC110_INTC_DMA_PEND           0x1044
  90 #define S5PC110_INTC_ONENAND_PEND       0x1048
  91 #define S5PC110_INTC_DMA_STATUS         0x1064
  92 #define S5PC110_INTC_ONENAND_STATUS     0x1068
  93
  94 #define S5PC110_INTC_DMA_TD             (1 << 24)
  95 #define S5PC110_INTC_DMA_TE             (1 << 16)
  96
  97 #define S5PC110_DMA_CFG_SINGLE          (0x0 << 16)
  98 #define S5PC110_DMA_CFG_4BURST          (0x2 << 16)
  99 #define S5PC110_DMA_CFG_8BURST          (0x3 << 16)
 100 #define S5PC110_DMA_CFG_16BURST         (0x4 << 16)
 101
 102 #define S5PC110_DMA_CFG_INC             (0x0 << 8)
 103 #define S5PC110_DMA_CFG_CNT             (0x1 << 8)
 104
 105 #define S5PC110_DMA_CFG_8BIT            (0x0 << 0)
 106 #define S5PC110_DMA_CFG_16BIT           (0x1 << 0)
 107 #define S5PC110_DMA_CFG_32BIT           (0x2 << 0)
 108
 109 #define S5PC110_DMA_SRC_CFG_READ        (S5PC110_DMA_CFG_16BURST | \
 110                                         S5PC110_DMA_CFG_INC | \
 111                                         S5PC110_DMA_CFG_16BIT)
 112 #define S5PC110_DMA_DST_CFG_READ        (S5PC110_DMA_CFG_16BURST | \
 113                                         S5PC110_DMA_CFG_INC | \
 114                                         S5PC110_DMA_CFG_32BIT)
 115 #define S5PC110_DMA_SRC_CFG_WRITE       (S5PC110_DMA_CFG_16BURST | \
 116                                         S5PC110_DMA_CFG_INC | \
 117                                         S5PC110_DMA_CFG_32BIT)
 118 #define S5PC110_DMA_DST_CFG_WRITE       (S5PC110_DMA_CFG_16BURST | \
 119                                         S5PC110_DMA_CFG_INC | \
 120                                         S5PC110_DMA_CFG_16BIT)
 121
 122 #define S5PC110_DMA_TRANS_CMD_TDC       (0x1 << 18)
 123 #define S5PC110_DMA_TRANS_CMD_TEC       (0x1 << 16)
 124 #define S5PC110_DMA_TRANS_CMD_TR        (0x1 << 0)
 125
 126 #define S5PC110_DMA_TRANS_STATUS_TD     (0x1 << 18)
 127 #define S5PC110_DMA_TRANS_STATUS_TB     (0x1 << 17)
 128 #define S5PC110_DMA_TRANS_STATUS_TE     (0x1 << 16)
 129
 130 #define S5PC110_DMA_DIR_READ            0x0
 131 #define S5PC110_DMA_DIR_WRITE           0x1
 132
 133 struct s3c_onenand {
 134         struct mtd_info *mtd;
 135         struct platform_device  *pdev;
 136         enum soc_type   type;
 137         void __iomem    *base;
 138         struct resource *base_res;
 139         void __iomem    *ahb_addr;
 140         struct resource *ahb_res;
 141         int             bootram_command;
 142         void __iomem    *page_buf;
 143         void __iomem    *oob_buf;
 144         unsigned int    (*mem_addr)(int fba, int fpa, int fsa);
 145         unsigned int    (*cmd_map)(unsigned int type, unsigned int val);
 146         void __iomem    *dma_addr;
 147         struct resource *dma_res;
 148         unsigned long   phys_base;
 149         struct completion       complete;
 150 };
 151
 152 #define CMD_MAP_00(dev, addr)           (dev->cmd_map(MAP_00, ((addr) << 1)))
 153 #define CMD_MAP_01(dev, mem_addr)       (dev->cmd_map(MAP_01, (mem_addr)))
 154 #define CMD_MAP_10(dev, mem_addr)       (dev->cmd_map(MAP_10, (mem_addr)))
 155 #define CMD_MAP_11(dev, addr)           (dev->cmd_map(MAP_11, ((addr) << 2)))
 156
 157 static struct s3c_onenand *onenand;
 158
 159 static inline int s3c_read_reg(int offset)
 160 {
 161         return readl(onenand->base + offset);
 162 }
 163
 164 static inline void s3c_write_reg(int value, int offset)
 165 {
 166         writel(value, onenand->base + offset);
 167 }
 168
 169 static inline int s3c_read_cmd(unsigned int cmd)
 170 {
 171         return readl(onenand->ahb_addr + cmd);
 172 }
 173
 174 static inline void s3c_write_cmd(int value, unsigned int cmd)
 175 {
 176         writel(value, onenand->ahb_addr + cmd);
 177 }
 178
 179 #ifdef SAMSUNG_DEBUG
 180 static void s3c_dump_reg(void)
 181 {
 182         int i;
 183
 184         for (i = 0; i < 0x400; i += 0x40) {
 185                 printk(KERN_INFO "0x%08X: 0x%08x 0x%08x 0x%08x 0x%08x\n",
 186                         (unsigned int) onenand->base + i,
 187                         s3c_read_reg(i), s3c_read_reg(i + 0x10),
 188                         s3c_read_reg(i + 0x20), s3c_read_reg(i + 0x30));
 189         }
 190 }
 191 #endif
 192
 193 static unsigned int s3c64xx_cmd_map(unsigned type, unsigned val)
 194 {
 195         return (type << S3C64XX_CMD_MAP_SHIFT) | val;
 196 }
 197
 198 static unsigned int s5pc1xx_cmd_map(unsigned type, unsigned val)
 199 {
 200         return (type << S5PC100_CMD_MAP_SHIFT) | val;
 201 }
 202
 203 static unsigned int s3c6400_mem_addr(int fba, int fpa, int fsa)
 204 {
 205         return (fba << S3C6400_FBA_SHIFT) | (fpa << S3C6400_FPA_SHIFT) |
 206                 (fsa << S3C6400_FSA_SHIFT);
 207 }
 208
 209 static unsigned int s3c6410_mem_addr(int fba, int fpa, int fsa)
 210 {
 211         return (fba << S3C6410_FBA_SHIFT) | (fpa << S3C6410_FPA_SHIFT) |
 212                 (fsa << S3C6410_FSA_SHIFT);
 213 }
 214
 215 static unsigned int s5pc100_mem_addr(int fba, int fpa, int fsa)
 216 {
 217         return (fba << S5PC100_FBA_SHIFT) | (fpa << S5PC100_FPA_SHIFT) |
 218                 (fsa << S5PC100_FSA_SHIFT);
 219 }
 220
 221 static void s3c_onenand_reset(void)
 222 {
 223         unsigned long timeout = 0x10000;
 224         int stat;
 225
 226         s3c_write_reg(ONENAND_MEM_RESET_COLD, MEM_RESET_OFFSET);
 227         while (1 && timeout--) {
 228                 stat = s3c_read_reg(INT_ERR_STAT_OFFSET);
 229                 if (stat & RST_CMP)
 230                         break;
 231         }
 232         stat = s3c_read_reg(INT_ERR_STAT_OFFSET);
 233         s3c_write_reg(stat, INT_ERR_ACK_OFFSET);
 234
 235         /* Clear interrupt */
 236         s3c_write_reg(0x0, INT_ERR_ACK_OFFSET);
 237         /* Clear the ECC status */
 238         s3c_write_reg(0x0, ECC_ERR_STAT_OFFSET);
 239 }
 240
 241 static unsigned short s3c_onenand_readw(void __iomem *addr)
 242 {
 243         struct onenand_chip *this = onenand->mtd->priv;
 244         struct device *dev = &onenand->pdev->dev;
 245         int reg = addr - this->base;
 246         int word_addr = reg >> 1;
 247         int value;
 248
 249         /* It's used for probing time */
 250         switch (reg) {
 251         case ONENAND_REG_MANUFACTURER_ID:
 252                 return s3c_read_reg(MANUFACT_ID_OFFSET);
 253         case ONENAND_REG_DEVICE_ID:
 254                 return s3c_read_reg(DEVICE_ID_OFFSET);
 255         case ONENAND_REG_VERSION_ID:
 256                 return s3c_read_reg(FLASH_VER_ID_OFFSET);
 257         case ONENAND_REG_DATA_BUFFER_SIZE:
 258                 return s3c_read_reg(DATA_BUF_SIZE_OFFSET);
 259         case ONENAND_REG_TECHNOLOGY:
 260                 return s3c_read_reg(TECH_OFFSET);
 261         case ONENAND_REG_SYS_CFG1:
 262                 return s3c_read_reg(MEM_CFG_OFFSET);
 263
 264         /* Used at unlock all status */
 265         case ONENAND_REG_CTRL_STATUS:
 266                 return 0;
 267
 268         case ONENAND_REG_WP_STATUS:
 269                 return ONENAND_WP_US;
 270
 271         default:
 272                 break;
 273         }
 274
 275         /* BootRAM access control */
 276         if ((unsigned int) addr < ONENAND_DATARAM && onenand->bootram_command) {
 277                 if (word_addr == 0)
 278                         return s3c_read_reg(MANUFACT_ID_OFFSET);
 279                 if (word_addr == 1)
 280                         return s3c_read_reg(DEVICE_ID_OFFSET);
 281                 if (word_addr == 2)
 282                         return s3c_read_reg(FLASH_VER_ID_OFFSET);
 283         }
 284
 285         value = s3c_read_cmd(CMD_MAP_11(onenand, word_addr)) & 0xffff;
 286         dev_info(dev, "%s: Illegal access at reg 0x%x, value 0x%x\n", __func__,
 287                  word_addr, value);
 288         return value;
 289 }
 290
 291 static void s3c_onenand_writew(unsigned short value, void __iomem *addr)
 292 {
 293         struct onenand_chip *this = onenand->mtd->priv;
 294         struct device *dev = &onenand->pdev->dev;
 295         unsigned int reg = addr - this->base;
 296         unsigned int word_addr = reg >> 1;
 297
 298         /* It's used for probing time */
 299         switch (reg) {
 300         case ONENAND_REG_SYS_CFG1:
 301                 s3c_write_reg(value, MEM_CFG_OFFSET);
 302                 return;
 303
 304         case ONENAND_REG_START_ADDRESS1:
 305         case ONENAND_REG_START_ADDRESS2:
 306                 return;
 307
 308         /* Lock/lock-tight/unlock/unlock_all */
 309         case ONENAND_REG_START_BLOCK_ADDRESS:
 310                 return;
 311
 312         default:
 313                 break;
 314         }
 315
 316         /* BootRAM access control */
 317         if ((unsigned int)addr < ONENAND_DATARAM) {
 318                 if (value == ONENAND_CMD_READID) {
 319                         onenand->bootram_command = 1;
 320                         return;
 321                 }
 322                 if (value == ONENAND_CMD_RESET) {
 323                         s3c_write_reg(ONENAND_MEM_RESET_COLD, MEM_RESET_OFFSET);
 324                         onenand->bootram_command = 0;
 325                         return;
 326                 }
 327         }
 328
 329         dev_info(dev, "%s: Illegal access at reg 0x%x, value 0x%x\n", __func__,
 330                  word_addr, value);
 331
 332         s3c_write_cmd(value, CMD_MAP_11(onenand, word_addr));
 333 }
 334
 335 static int s3c_onenand_wait(struct mtd_info *mtd, int state)
 336 {
 337         struct device *dev = &onenand->pdev->dev;
 338         unsigned int flags = INT_ACT;
 339         unsigned int stat, ecc;
 340         unsigned long timeout;
 341
 342         switch (state) {
 343         case FL_READING:
 344                 flags |= BLK_RW_CMP | LOAD_CMP;
 345                 break;
 346         case FL_WRITING:
 347                 flags |= BLK_RW_CMP | PGM_CMP;
 348                 break;
 349         case FL_ERASING:
 350                 flags |= BLK_RW_CMP | ERS_CMP;
 351                 break;
 352         case FL_LOCKING:
 353                 flags |= BLK_RW_CMP;
 354                 break;
 355         default:
 356                 break;
 357         }
 358
 359         /* The 20 msec is enough */
 360         timeout = jiffies + msecs_to_jiffies(20);
 361         while (time_before(jiffies, timeout)) {
 362                 stat = s3c_read_reg(INT_ERR_STAT_OFFSET);
 363                 if (stat & flags)
 364                         break;
 365
 366                 if (state != FL_READING)
 367                         cond_resched();
 368         }
 369         /* To get correct interrupt status in timeout case */
 370         stat = s3c_read_reg(INT_ERR_STAT_OFFSET);
 371         s3c_write_reg(stat, INT_ERR_ACK_OFFSET);
 372
 373         /*
 374          * In the Spec. it checks the controller status first
 375          * However if you get the correct information in case of
 376          * power off recovery (POR) test, it should read ECC status first
 377          */
 378         if (stat & LOAD_CMP) {
 379                 ecc = s3c_read_reg(ECC_ERR_STAT_OFFSET);
 380                 if (ecc & ONENAND_ECC_4BIT_UNCORRECTABLE) {
 381                         dev_info(dev, "%s: ECC error = 0x%04x\n", __func__,
 382                                  ecc);
 383                         mtd->ecc_stats.failed++;
 384                         return -EBADMSG;
 385                 }
 386         }
 387
 388         if (stat & (LOCKED_BLK | ERS_FAIL | PGM_FAIL | LD_FAIL_ECC_ERR)) {
 389                 dev_info(dev, "%s: controller error = 0x%04x\n", __func__,
 390                          stat);
 391                 if (stat & LOCKED_BLK)
 392                         dev_info(dev, "%s: it's locked error = 0x%04x\n",
 393                                  __func__, stat);
 394
 395                 return -EIO;
 396         }
 397
 398         return 0;
 399 }
 400
 401 static int s3c_onenand_command(struct mtd_info *mtd, int cmd, loff_t addr,
 402                                size_t len)
 403 {
 404         struct onenand_chip *this = mtd->priv;
 405         unsigned int *m, *s;
 406         int fba, fpa, fsa = 0;
 407         unsigned int mem_addr, cmd_map_01, cmd_map_10;
 408         int i, mcount, scount;
 409         int index;
 410
 411         fba = (int) (addr >> this->erase_shift);
 412         fpa = (int) (addr >> this->page_shift);
 413         fpa &= this->page_mask;
 414
 415         mem_addr = onenand->mem_addr(fba, fpa, fsa);
 416         cmd_map_01 = CMD_MAP_01(onenand, mem_addr);
 417         cmd_map_10 = CMD_MAP_10(onenand, mem_addr);
 418
 419         switch (cmd) {
 420         case ONENAND_CMD_READ:
 421         case ONENAND_CMD_READOOB:
 422         case ONENAND_CMD_BUFFERRAM:
 423                 ONENAND_SET_NEXT_BUFFERRAM(this);
 424         default:
 425                 break;
 426         }
 427
 428         index = ONENAND_CURRENT_BUFFERRAM(this);
 429
 430         /*
 431          * Emulate Two BufferRAMs and access with 4 bytes pointer
 432          */
 433         m = (unsigned int *) onenand->page_buf;
 434         s = (unsigned int *) onenand->oob_buf;
 435
 436         if (index) {
 437                 m += (this->writesize >> 2);
 438                 s += (mtd->oobsize >> 2);
 439         }
 440
 441         mcount = mtd->writesize >> 2;
 442         scount = mtd->oobsize >> 2;
 443
 444         switch (cmd) {
 445         case ONENAND_CMD_READ:
 446                 /* Main */
 447                 for (i = 0; i < mcount; i++)
 448                         *m++ = s3c_read_cmd(cmd_map_01);
 449                 return 0;
 450
 451         case ONENAND_CMD_READOOB:
 452                 s3c_write_reg(TSRF, TRANS_SPARE_OFFSET);
 453                 /* Main */
 454                 for (i = 0; i < mcount; i++)
 455                         *m++ = s3c_read_cmd(cmd_map_01);
 456
 457                 /* Spare */
 458                 for (i = 0; i < scount; i++)
 459                         *s++ = s3c_read_cmd(cmd_map_01);
 460
 461                 s3c_write_reg(0, TRANS_SPARE_OFFSET);
 462                 return 0;
 463
 464         case ONENAND_CMD_PROG:
 465                 /* Main */
 466                 for (i = 0; i < mcount; i++)
 467                         s3c_write_cmd(*m++, cmd_map_01);
 468                 return 0;
 469
 470         case ONENAND_CMD_PROGOOB:
 471                 s3c_write_reg(TSRF, TRANS_SPARE_OFFSET);
 472
 473                 /* Main - dummy write */
 474                 for (i = 0; i < mcount; i++)
 475                         s3c_write_cmd(0xffffffff, cmd_map_01);
 476
 477                 /* Spare */
 478                 for (i = 0; i < scount; i++)
 479                         s3c_write_cmd(*s++, cmd_map_01);
 480
 481                 s3c_write_reg(0, TRANS_SPARE_OFFSET);
 482                 return 0;
 483
 484         case ONENAND_CMD_UNLOCK_ALL:
 485                 s3c_write_cmd(ONENAND_UNLOCK_ALL, cmd_map_10);
 486                 return 0;
 487
 488         case ONENAND_CMD_ERASE:
 489                 s3c_write_cmd(ONENAND_ERASE_START, cmd_map_10);
 490                 return 0;
 491
 492         default:
 493                 break;
 494         }
 495
 496         return 0;
 497 }
 498
 499 static unsigned char *s3c_get_bufferram(struct mtd_info *mtd, int area)
 500 {
 501         struct onenand_chip *this = mtd->priv;
 502         int index = ONENAND_CURRENT_BUFFERRAM(this);
 503         unsigned char *p;
 504
 505         if (area == ONENAND_DATARAM) {
 506                 p = (unsigned char *) onenand->page_buf;
 507                 if (index == 1)
 508                         p += this->writesize;
 509         } else {
 510                 p = (unsigned char *) onenand->oob_buf;
 511                 if (index == 1)
 512                         p += mtd->oobsize;
 513         }
 514
 515         return p;
 516 }
 517
 518 static int onenand_read_bufferram(struct mtd_info *mtd, int area,
 519                                   unsigned char *buffer, int offset,
 520                                   size_t count)
 521 {
 522         unsigned char *p;
 523
 524         p = s3c_get_bufferram(mtd, area);
 525         memcpy(buffer, p + offset, count);
 526         return 0;
 527 }
 528
 529 static int onenand_write_bufferram(struct mtd_info *mtd, int area,
 530                                    const unsigned char *buffer, int offset,
 531                                    size_t count)
 532 {
 533         unsigned char *p;
 534
 535         p = s3c_get_bufferram(mtd, area);
 536         memcpy(p + offset, buffer, count);
 537         return 0;
 538 }
 539
 540 static int (*s5pc110_dma_ops)(void *dst, void *src, size_t count, int direction);
 541
 542 static int s5pc110_dma_poll(void *dst, void *src, size_t count, int direction)
 543 {
 544         void __iomem *base = onenand->dma_addr;
 545         int status;
 546         unsigned long timeout;
 547
 548         writel(src, base + S5PC110_DMA_SRC_ADDR);
 549         writel(dst, base + S5PC110_DMA_DST_ADDR);
 550
 551         if (direction == S5PC110_DMA_DIR_READ) {
 552                 writel(S5PC110_DMA_SRC_CFG_READ, base + S5PC110_DMA_SRC_CFG);
 553                 writel(S5PC110_DMA_DST_CFG_READ, base + S5PC110_DMA_DST_CFG);
 554         } else {
 555                 writel(S5PC110_DMA_SRC_CFG_WRITE, base + S5PC110_DMA_SRC_CFG);
 556                 writel(S5PC110_DMA_DST_CFG_WRITE, base + S5PC110_DMA_DST_CFG);
 557         }
 558
 559         writel(count, base + S5PC110_DMA_TRANS_SIZE);
 560         writel(direction, base + S5PC110_DMA_TRANS_DIR);
 561
 562         writel(S5PC110_DMA_TRANS_CMD_TR, base + S5PC110_DMA_TRANS_CMD);
 563
 564         /*
 565          * There's no exact timeout values at Spec.
 566          * In real case it takes under 1 msec.
 567          * So 20 msecs are enough.
 568          */
 569         timeout = jiffies + msecs_to_jiffies(20);
 570
 571         do {
 572                 status = readl(base + S5PC110_DMA_TRANS_STATUS);
 573                 if (status & S5PC110_DMA_TRANS_STATUS_TE) {
 574                         writel(S5PC110_DMA_TRANS_CMD_TEC,
 575                                         base + S5PC110_DMA_TRANS_CMD);
 576                         return -EIO;
 577                 }
 578         } while (!(status & S5PC110_DMA_TRANS_STATUS_TD) &&
 579                 time_before(jiffies, timeout));
 580
 581         writel(S5PC110_DMA_TRANS_CMD_TDC, base + S5PC110_DMA_TRANS_CMD);
 582
 583         return 0;
 584 }
 585
 586 static irqreturn_t s5pc110_onenand_irq(int irq, void *data)
 587 {
 588         void __iomem *base = onenand->dma_addr;
 589         int status, cmd = 0;
 590
 591         status = readl(base + S5PC110_INTC_DMA_STATUS);
 592
 593         if (likely(status & S5PC110_INTC_DMA_TD))
 594                 cmd = S5PC110_DMA_TRANS_CMD_TDC;
 595
 596         if (unlikely(status & S5PC110_INTC_DMA_TE))
 597                 cmd = S5PC110_DMA_TRANS_CMD_TEC;
 598
 599         writel(cmd, base + S5PC110_DMA_TRANS_CMD);
 600         writel(status, base + S5PC110_INTC_DMA_CLR);
 601
 602         if (!onenand->complete.done)
 603                 complete(&onenand->complete);
 604
 605         return IRQ_HANDLED;
 606 }
 607
 608 static int s5pc110_dma_irq(void *dst, void *src, size_t count, int direction)
 609 {
 610         void __iomem *base = onenand->dma_addr;
 611         int status;
 612
 613         status = readl(base + S5PC110_INTC_DMA_MASK);
 614         if (status) {
 615                 status &= ~(S5PC110_INTC_DMA_TD | S5PC110_INTC_DMA_TE);
 616                 writel(status, base + S5PC110_INTC_DMA_MASK);
 617         }
 618
 619         writel(src, base + S5PC110_DMA_SRC_ADDR);
 620         writel(dst, base + S5PC110_DMA_DST_ADDR);
 621
 622         if (direction == S5PC110_DMA_DIR_READ) {
 623                 writel(S5PC110_DMA_SRC_CFG_READ, base + S5PC110_DMA_SRC_CFG);
 624                 writel(S5PC110_DMA_DST_CFG_READ, base + S5PC110_DMA_DST_CFG);
 625         } else {
 626                 writel(S5PC110_DMA_SRC_CFG_WRITE, base + S5PC110_DMA_SRC_CFG);
 627                 writel(S5PC110_DMA_DST_CFG_WRITE, base + S5PC110_DMA_DST_CFG);
 628         }
 629
 630         writel(count, base + S5PC110_DMA_TRANS_SIZE);
 631         writel(direction, base + S5PC110_DMA_TRANS_DIR);
 632
 633         writel(S5PC110_DMA_TRANS_CMD_TR, base + S5PC110_DMA_TRANS_CMD);
 634
 635         wait_for_completion_timeout(&onenand->complete, msecs_to_jiffies(20));
 636
 637         return 0;
 638 }
 639
 640 static int s5pc110_read_bufferram(struct mtd_info *mtd, int area,
 641                 unsigned char *buffer, int offset, size_t count)
 642 {
 643         struct onenand_chip *this = mtd->priv;
 644         void __iomem *p;
 645         void *buf = (void *) buffer;
 646         dma_addr_t dma_src, dma_dst;
 647         int err, ofs, page_dma = 0;
 648         struct device *dev = &onenand->pdev->dev;
 649
 650         p = this->base + area;
 651         if (ONENAND_CURRENT_BUFFERRAM(this)) {
 652                 if (area == ONENAND_DATARAM)
 653                         p += this->writesize;
 654                 else
 655                         p += mtd->oobsize;
 656         }
 657
 658         if (offset & 3 || (size_t) buf & 3 ||
 659                 !onenand->dma_addr || count != mtd->writesize)
 660                 goto normal;
 661
 662         /* Handle vmalloc address */
 663         if (buf >= high_memory) {
 664                 struct page *page;
 665
 666                 if (((size_t) buf & PAGE_MASK) !=
 667                     ((size_t) (buf + count - 1) & PAGE_MASK))
 668                         goto normal;
 669                 page = vmalloc_to_page(buf);
 670                 if (!page)
 671                         goto normal;
 672
 673                 /* Page offset */
 674                 ofs = ((size_t) buf & ~PAGE_MASK);
 675                 page_dma = 1;
 676
 677                 /* DMA routine */
 678                 dma_src = onenand->phys_base + (p - this->base);
 679                 dma_dst = dma_map_page(dev, page, ofs, count, DMA_FROM_DEVICE);
 680         } else {
 681                 /* DMA routine */
 682                 dma_src = onenand->phys_base + (p - this->base);
 683                 dma_dst = dma_map_single(dev, buf, count, DMA_FROM_DEVICE);
 684         }
 685         if (dma_mapping_error(dev, dma_dst)) {
 686                 dev_err(dev, "Couldn't map a %d byte buffer for DMA\n", count);
 687                 goto normal;
 688         }
 689         err = s5pc110_dma_ops((void *) dma_dst, (void *) dma_src,
 690                         count, S5PC110_DMA_DIR_READ);
 691
 692         if (page_dma)
 693                 dma_unmap_page(dev, dma_dst, count, DMA_FROM_DEVICE);
 694         else
 695                 dma_unmap_single(dev, dma_dst, count, DMA_FROM_DEVICE);
 696
 697         if (!err)
 698                 return 0;
 699
 700 normal:
 701         if (count != mtd->writesize) {
 702                 /* Copy the bufferram to memory to prevent unaligned access */
 703                 memcpy(this->page_buf, p, mtd->writesize);
 704                 p = this->page_buf + offset;
 705         }
 706
 707         memcpy(buffer, p, count);
 708
 709         return 0;
 710 }
 711
 712 static int s5pc110_chip_probe(struct mtd_info *mtd)
 713 {
 714         /* Now just return 0 */
 715         return 0;
 716 }
 717
 718 static int s3c_onenand_bbt_wait(struct mtd_info *mtd, int state)
 719 {
 720         unsigned int flags = INT_ACT | LOAD_CMP;
 721         unsigned int stat;
 722         unsigned long timeout;
 723
 724         /* The 20 msec is enough */
 725         timeout = jiffies + msecs_to_jiffies(20);
 726         while (time_before(jiffies, timeout)) {
 727                 stat = s3c_read_reg(INT_ERR_STAT_OFFSET);
 728                 if (stat & flags)
 729                         break;
 730         }
 731         /* To get correct interrupt status in timeout case */
 732         stat = s3c_read_reg(INT_ERR_STAT_OFFSET);
 733         s3c_write_reg(stat, INT_ERR_ACK_OFFSET);
 734
 735         if (stat & LD_FAIL_ECC_ERR) {
 736                 s3c_onenand_reset();
 737                 return ONENAND_BBT_READ_ERROR;
 738         }
 739
 740         if (stat & LOAD_CMP) {
 741                 int ecc = s3c_read_reg(ECC_ERR_STAT_OFFSET);
 742                 if (ecc & ONENAND_ECC_4BIT_UNCORRECTABLE) {
 743                         s3c_onenand_reset();
 744                         return ONENAND_BBT_READ_ERROR;
 745                 }
 746         }
 747
 748         return 0;
 749 }
 750
 751 static void s3c_onenand_check_lock_status(struct mtd_info *mtd)
 752 {
 753         struct onenand_chip *this = mtd->priv;
 754         struct device *dev = &onenand->pdev->dev;
 755         unsigned int block, end;
 756         int tmp;
 757
 758         end = this->chipsize >> this->erase_shift;
 759
 760         for (block = 0; block < end; block++) {
 761                 unsigned int mem_addr = onenand->mem_addr(block, 0, 0);
 762                 tmp = s3c_read_cmd(CMD_MAP_01(onenand, mem_addr));
 763
 764                 if (s3c_read_reg(INT_ERR_STAT_OFFSET) & LOCKED_BLK) {
 765                         dev_err(dev, "block %d is write-protected!\n", block);
 766                         s3c_write_reg(LOCKED_BLK, INT_ERR_ACK_OFFSET);
 767                 }
 768         }
 769 }
 770
 771 static void s3c_onenand_do_lock_cmd(struct mtd_info *mtd, loff_t ofs,
 772                                     size_t len, int cmd)
 773 {
 774         struct onenand_chip *this = mtd->priv;
 775         int start, end, start_mem_addr, end_mem_addr;
 776
 777         start = ofs >> this->erase_shift;
 778         start_mem_addr = onenand->mem_addr(start, 0, 0);
 779         end = start + (len >> this->erase_shift) - 1;
 780         end_mem_addr = onenand->mem_addr(end, 0, 0);
 781
 782         if (cmd == ONENAND_CMD_LOCK) {
 783                 s3c_write_cmd(ONENAND_LOCK_START, CMD_MAP_10(onenand,
 784                                                              start_mem_addr));
 785                 s3c_write_cmd(ONENAND_LOCK_END, CMD_MAP_10(onenand,
 786                                                            end_mem_addr));
 787         } else {
 788                 s3c_write_cmd(ONENAND_UNLOCK_START, CMD_MAP_10(onenand,
 789                                                                start_mem_addr));
 790                 s3c_write_cmd(ONENAND_UNLOCK_END, CMD_MAP_10(onenand,
 791                                                              end_mem_addr));
 792         }
 793
 794         this->wait(mtd, FL_LOCKING);
 795 }
 796
 797 static void s3c_unlock_all(struct mtd_info *mtd)
 798 {
 799         struct onenand_chip *this = mtd->priv;
 800         loff_t ofs = 0;
 801         size_t len = this->chipsize;
 802
 803         if (this->options & ONENAND_HAS_UNLOCK_ALL) {
 804                 /* Write unlock command */
 805                 this->command(mtd, ONENAND_CMD_UNLOCK_ALL, 0, 0);
 806
 807                 /* No need to check return value */
 808                 this->wait(mtd, FL_LOCKING);
 809
 810                 /* Workaround for all block unlock in DDP */
 811                 if (!ONENAND_IS_DDP(this)) {
 812                         s3c_onenand_check_lock_status(mtd);
 813                         return;
 814                 }
 815
 816                 /* All blocks on another chip */
 817                 ofs = this->chipsize >> 1;
 818                 len = this->chipsize >> 1;
 819         }
 820
 821         s3c_onenand_do_lock_cmd(mtd, ofs, len, ONENAND_CMD_UNLOCK);
 822
 823         s3c_onenand_check_lock_status(mtd);
 824 }
 825
 826 static void s3c_onenand_setup(struct mtd_info *mtd)
 827 {
 828         struct onenand_chip *this = mtd->priv;
 829
 830         onenand->mtd = mtd;
 831
 832         if (onenand->type == TYPE_S3C6400) {
 833                 onenand->mem_addr = s3c6400_mem_addr;
 834                 onenand->cmd_map = s3c64xx_cmd_map;
 835         } else if (onenand->type == TYPE_S3C6410) {
 836                 onenand->mem_addr = s3c6410_mem_addr;
 837                 onenand->cmd_map = s3c64xx_cmd_map;
 838         } else if (onenand->type == TYPE_S5PC100) {
 839                 onenand->mem_addr = s5pc100_mem_addr;
 840                 onenand->cmd_map = s5pc1xx_cmd_map;
 841         } else if (onenand->type == TYPE_S5PC110) {
 842                 /* Use generic onenand functions */
 843                 this->read_bufferram = s5pc110_read_bufferram;
 844                 this->chip_probe = s5pc110_chip_probe;
 845                 return;
 846         } else {
 847                 BUG();
 848         }
 849
 850         this->read_word = s3c_onenand_readw;
 851         this->write_word = s3c_onenand_writew;
 852
 853         this->wait = s3c_onenand_wait;
 854         this->bbt_wait = s3c_onenand_bbt_wait;
 855         this->unlock_all = s3c_unlock_all;
 856         this->command = s3c_onenand_command;
 857
 858         this->read_bufferram = onenand_read_bufferram;
 859         this->write_bufferram = onenand_write_bufferram;
 860 }
 861
 862 static int s3c_onenand_probe(struct platform_device *pdev)
 863 {
 864         struct onenand_platform_data *pdata;
 865         struct onenand_chip *this;
 866         struct mtd_info *mtd;
 867         struct resource *r;
 868         int size, err;
 869
 870         pdata = pdev->dev.platform_data;
 871         /* No need to check pdata. the platform data is optional */
 872
 873         size = sizeof(struct mtd_info) + sizeof(struct onenand_chip);
 874         mtd = kzalloc(size, GFP_KERNEL);
 875         if (!mtd) {
 876                 dev_err(&pdev->dev, "failed to allocate memory\n");
 877                 return -ENOMEM;
 878         }
 879
 880         onenand = kzalloc(sizeof(struct s3c_onenand), GFP_KERNEL);
 881         if (!onenand) {
 882                 err = -ENOMEM;
 883                 goto onenand_fail;
 884         }
 885
 886         this = (struct onenand_chip *) &mtd[1];
 887         mtd->priv = this;
 888         mtd->dev.parent = &pdev->dev;
 889         mtd->owner = THIS_MODULE;
 890         onenand->pdev = pdev;
 891         onenand->type = platform_get_device_id(pdev)->driver_data;
 892
 893         s3c_onenand_setup(mtd);
 894
 895         r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 896         if (!r) {
 897                 dev_err(&pdev->dev, "no memory resource defined\n");
 898                 return -ENOENT;
 899                 goto ahb_resource_failed;
 900         }
 901
 902         onenand->base_res = request_mem_region(r->start, resource_size(r),
 903                                                pdev->name);
 904         if (!onenand->base_res) {
 905                 dev_err(&pdev->dev, "failed to request memory resource\n");
 906                 err = -EBUSY;
 907                 goto resource_failed;
 908         }
 909
 910         onenand->base = ioremap(r->start, resource_size(r));
 911         if (!onenand->base) {
 912                 dev_err(&pdev->dev, "failed to map memory resource\n");
 913                 err = -EFAULT;
 914                 goto ioremap_failed;
 915         }
 916         /* Set onenand_chip also */
 917         this->base = onenand->base;
 918
 919         /* Use runtime badblock check */
 920         this->options |= ONENAND_SKIP_UNLOCK_CHECK;
 921
 922         if (onenand->type != TYPE_S5PC110) {
 923                 r = platform_get_resource(pdev, IORESOURCE_MEM, 1);
 924                 if (!r) {
 925                         dev_err(&pdev->dev, "no buffer memory resource defined\n");
 926                         return -ENOENT;
 927                         goto ahb_resource_failed;
 928                 }
 929
 930                 onenand->ahb_res = request_mem_region(r->start, resource_size(r),
 931                                                       pdev->name);
 932                 if (!onenand->ahb_res) {
 933                         dev_err(&pdev->dev, "failed to request buffer memory resource\n");
 934                         err = -EBUSY;
 935                         goto ahb_resource_failed;
 936                 }
 937
 938                 onenand->ahb_addr = ioremap(r->start, resource_size(r));
 939                 if (!onenand->ahb_addr) {
 940                         dev_err(&pdev->dev, "failed to map buffer memory resource\n");
 941                         err = -EINVAL;
 942                         goto ahb_ioremap_failed;
 943                 }
 944
 945                 /* Allocate 4KiB BufferRAM */
 946                 onenand->page_buf = kzalloc(SZ_4K, GFP_KERNEL);
 947                 if (!onenand->page_buf) {
 948                         err = -ENOMEM;
 949                         goto page_buf_fail;
 950                 }
 951
 952                 /* Allocate 128 SpareRAM */
 953                 onenand->oob_buf = kzalloc(128, GFP_KERNEL);
 954                 if (!onenand->oob_buf) {
 955                         err = -ENOMEM;
 956                         goto oob_buf_fail;
 957                 }
 958
 959                 /* S3C doesn't handle subpage write */
 960                 mtd->subpage_sft = 0;
 961                 this->subpagesize = mtd->writesize;
 962
 963         } else { /* S5PC110 */
 964                 r = platform_get_resource(pdev, IORESOURCE_MEM, 1);
 965                 if (!r) {
 966                         dev_err(&pdev->dev, "no dma memory resource defined\n");
 967                         return -ENOENT;
 968                         goto dma_resource_failed;
 969                 }
 970
 971                 onenand->dma_res = request_mem_region(r->start, resource_size(r),
 972                                                       pdev->name);
 973                 if (!onenand->dma_res) {
 974                         dev_err(&pdev->dev, "failed to request dma memory resource\n");
 975                         err = -EBUSY;
 976                         goto dma_resource_failed;
 977                 }
 978
 979                 onenand->dma_addr = ioremap(r->start, resource_size(r));
 980                 if (!onenand->dma_addr) {
 981                         dev_err(&pdev->dev, "failed to map dma memory resource\n");
 982                         err = -EINVAL;
 983                         goto dma_ioremap_failed;
 984                 }
 985
 986                 onenand->phys_base = onenand->base_res->start;
 987
 988                 s5pc110_dma_ops = s5pc110_dma_poll;
 989                 /* Interrupt support */
 990                 r = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
 991                 if (r) {
 992                         init_completion(&onenand->complete);
 993                         s5pc110_dma_ops = s5pc110_dma_irq;
 994                         err = request_irq(r->start, s5pc110_onenand_irq,
 995                                         IRQF_SHARED, "onenand", &onenand);
 996                         if (err) {
 997                                 dev_err(&pdev->dev, "failed to get irq\n");
 998                                 goto scan_failed;
 999                         }
1000                 }
1001         }
1002
1003         if (onenand_scan(mtd, 1)) {
1004                 err = -EFAULT;
1005                 goto scan_failed;
1006         }
1007
1008         if (onenand->type != TYPE_S5PC110) {
1009                 /* S3C doesn't handle subpage write */
1010                 mtd->subpage_sft = 0;
1011                 this->subpagesize = mtd->writesize;
1012         }
1013
1014         if (s3c_read_reg(MEM_CFG_OFFSET) & ONENAND_SYS_CFG1_SYNC_READ)
1015                 dev_info(&onenand->pdev->dev, "OneNAND Sync. Burst Read enabled\n");
1016
1017         err = mtd_device_parse_register(mtd, NULL, 0,
1018                                         pdata ? pdata->parts : NULL,
1019                                         pdata ? pdata->nr_parts : 0);
1020
1021         platform_set_drvdata(pdev, mtd);
1022
1023         return 0;
1024
1025 scan_failed:
1026         if (onenand->dma_addr)
1027                 iounmap(onenand->dma_addr);
1028 dma_ioremap_failed:
1029         if (onenand->dma_res)
1030                 release_mem_region(onenand->dma_res->start,
1031                                    resource_size(onenand->dma_res));
1032         kfree(onenand->oob_buf);
1033 oob_buf_fail:
1034         kfree(onenand->page_buf);
1035 page_buf_fail:
1036         if (onenand->ahb_addr)
1037                 iounmap(onenand->ahb_addr);
1038 ahb_ioremap_failed:
1039         if (onenand->ahb_res)
1040                 release_mem_region(onenand->ahb_res->start,
1041                                    resource_size(onenand->ahb_res));
1042 dma_resource_failed:
1043 ahb_resource_failed:
1044         iounmap(onenand->base);
1045 ioremap_failed:
1046         if (onenand->base_res)
1047                 release_mem_region(onenand->base_res->start,
1048                                    resource_size(onenand->base_res));
1049 resource_failed:
1050         kfree(onenand);
1051 onenand_fail:
1052         kfree(mtd);
1053         return err;
1054 }
1055
1056 static int __devexit s3c_onenand_remove(struct platform_device *pdev)
1057 {
1058         struct mtd_info *mtd = platform_get_drvdata(pdev);
1059
1060         onenand_release(mtd);
1061         if (onenand->ahb_addr)
1062                 iounmap(onenand->ahb_addr);
1063         if (onenand->ahb_res)
1064                 release_mem_region(onenand->ahb_res->start,
1065                                    resource_size(onenand->ahb_res));
1066         if (onenand->dma_addr)
1067                 iounmap(onenand->dma_addr);
1068         if (onenand->dma_res)
1069                 release_mem_region(onenand->dma_res->start,
1070                                    resource_size(onenand->dma_res));
1071
1072         iounmap(onenand->base);
1073         release_mem_region(onenand->base_res->start,
1074                            resource_size(onenand->base_res));
1075
1076         platform_set_drvdata(pdev, NULL);
1077         kfree(onenand->oob_buf);
1078         kfree(onenand->page_buf);
1079         kfree(onenand);
1080         kfree(mtd);
1081         return 0;
1082 }
1083
1084 static int s3c_pm_ops_suspend(struct device *dev)
1085 {
1086         struct platform_device *pdev = to_platform_device(dev);
1087         struct mtd_info *mtd = platform_get_drvdata(pdev);
1088         struct onenand_chip *this = mtd->priv;
1089
1090         this->wait(mtd, FL_PM_SUSPENDED);
1091         return 0;
1092 }
1093
1094 static  int s3c_pm_ops_resume(struct device *dev)
1095 {
1096         struct platform_device *pdev = to_platform_device(dev);
1097         struct mtd_info *mtd = platform_get_drvdata(pdev);
1098         struct onenand_chip *this = mtd->priv;
1099
1100         this->unlock_all(mtd);
1101         return 0;
1102 }
1103
1104 static const struct dev_pm_ops s3c_pm_ops = {
1105         .suspend        = s3c_pm_ops_suspend,
1106         .resume         = s3c_pm_ops_resume,
1107 };
1108
1109 static struct platform_device_id s3c_onenand_driver_ids[] = {
1110         {
1111                 .name           = "s3c6400-onenand",
1112                 .driver_data    = TYPE_S3C6400,
1113         }, {
1114                 .name           = "s3c6410-onenand",
1115                 .driver_data    = TYPE_S3C6410,
1116         }, {
1117                 .name           = "s5pc100-onenand",
1118                 .driver_data    = TYPE_S5PC100,
1119         }, {
1120                 .name           = "s5pc110-onenand",
1121                 .driver_data    = TYPE_S5PC110,
1122         }, { },
1123 };
1124 MODULE_DEVICE_TABLE(platform, s3c_onenand_driver_ids);
1125
1126 static struct platform_driver s3c_onenand_driver = {
1127         .driver         = {
1128                 .name   = "samsung-onenand",
1129                 .pm     = &s3c_pm_ops,
1130         },
1131         .id_table       = s3c_onenand_driver_ids,
1132         .probe          = s3c_onenand_probe,
1133         .remove         = __devexit_p(s3c_onenand_remove),
1134 };
1135
1136 static int __init s3c_onenand_init(void)
1137 {
1138         return platform_driver_register(&s3c_onenand_driver);
1139 }
1140
1141 static void __exit s3c_onenand_exit(void)
1142 {
1143         platform_driver_unregister(&s3c_onenand_driver);
1144 }
1145
1146 module_init(s3c_onenand_init);
1147 module_exit(s3c_onenand_exit);
1148
1149 MODULE_LICENSE("GPL");
1150 MODULE_AUTHOR("Kyungmin Park <kyungmin.park@samsung.com>");
1151 MODULE_DESCRIPTION("Samsung OneNAND controller support");