blkcg: fix blkg_alloc() failure path
[linux-2.6.git] / drivers / mtd / nand / cmx270_nand.c
blob1024bfc05c8696485861e35b630522c44810d674
1 /*
2 * linux/drivers/mtd/nand/cmx270-nand.c
4 * Copyright (C) 2006 Compulab, Ltd.
5 * Mike Rapoport <mike@compulab.co.il>
7 * Derived from drivers/mtd/nand/h1910.c
8 * Copyright (C) 2002 Marius Gröger (mag@sysgo.de)
9 * Copyright (c) 2001 Thomas Gleixner (gleixner@autronix.de)
12 * This program is free software; you can redistribute it and/or modify
13 * it under the terms of the GNU General Public License version 2 as
14 * published by the Free Software Foundation.
16 * Overview:
17 * This is a device driver for the NAND flash device found on the
18 * CM-X270 board.
21 #include <linux/mtd/nand.h>
22 #include <linux/mtd/partitions.h>
23 #include <linux/slab.h>
24 #include <linux/gpio.h>
25 #include <linux/module.h>
27 #include <asm/io.h>
28 #include <asm/irq.h>
29 #include <asm/mach-types.h>
31 #include <mach/pxa2xx-regs.h>
33 #define GPIO_NAND_CS (11)
34 #define GPIO_NAND_RB (89)
36 /* MTD structure for CM-X270 board */
37 static struct mtd_info *cmx270_nand_mtd;
39 /* remaped IO address of the device */
40 static void __iomem *cmx270_nand_io;
43 * Define static partitions for flash device
45 static struct mtd_partition partition_info[] = {
46 [0] = {
47 .name = "cmx270-0",
48 .offset = 0,
49 .size = MTDPART_SIZ_FULL
52 #define NUM_PARTITIONS (ARRAY_SIZE(partition_info))
54 static u_char cmx270_read_byte(struct mtd_info *mtd)
56 struct nand_chip *this = mtd->priv;
58 return (readl(this->IO_ADDR_R) >> 16);
61 static void cmx270_write_buf(struct mtd_info *mtd, const u_char *buf, int len)
63 int i;
64 struct nand_chip *this = mtd->priv;
66 for (i=0; i<len; i++)
67 writel((*buf++ << 16), this->IO_ADDR_W);
70 static void cmx270_read_buf(struct mtd_info *mtd, u_char *buf, int len)
72 int i;
73 struct nand_chip *this = mtd->priv;
75 for (i=0; i<len; i++)
76 *buf++ = readl(this->IO_ADDR_R) >> 16;
79 static int cmx270_verify_buf(struct mtd_info *mtd, const u_char *buf, int len)
81 int i;
82 struct nand_chip *this = mtd->priv;
84 for (i=0; i<len; i++)
85 if (buf[i] != (u_char)(readl(this->IO_ADDR_R) >> 16))
86 return -EFAULT;
88 return 0;
91 static inline void nand_cs_on(void)
93 gpio_set_value(GPIO_NAND_CS, 0);
96 static void nand_cs_off(void)
98 dsb();
100 gpio_set_value(GPIO_NAND_CS, 1);
104 * hardware specific access to control-lines
106 static void cmx270_hwcontrol(struct mtd_info *mtd, int dat,
107 unsigned int ctrl)
109 struct nand_chip* this = mtd->priv;
110 unsigned int nandaddr = (unsigned int)this->IO_ADDR_W;
112 dsb();
114 if (ctrl & NAND_CTRL_CHANGE) {
115 if ( ctrl & NAND_ALE )
116 nandaddr |= (1 << 3);
117 else
118 nandaddr &= ~(1 << 3);
119 if ( ctrl & NAND_CLE )
120 nandaddr |= (1 << 2);
121 else
122 nandaddr &= ~(1 << 2);
123 if ( ctrl & NAND_NCE )
124 nand_cs_on();
125 else
126 nand_cs_off();
129 dsb();
130 this->IO_ADDR_W = (void __iomem*)nandaddr;
131 if (dat != NAND_CMD_NONE)
132 writel((dat << 16), this->IO_ADDR_W);
134 dsb();
138 * read device ready pin
140 static int cmx270_device_ready(struct mtd_info *mtd)
142 dsb();
144 return (gpio_get_value(GPIO_NAND_RB));
148 * Main initialization routine
150 static int __init cmx270_init(void)
152 struct nand_chip *this;
153 int ret;
155 if (!(machine_is_armcore() && cpu_is_pxa27x()))
156 return -ENODEV;
158 ret = gpio_request(GPIO_NAND_CS, "NAND CS");
159 if (ret) {
160 pr_warning("CM-X270: failed to request NAND CS gpio\n");
161 return ret;
164 gpio_direction_output(GPIO_NAND_CS, 1);
166 ret = gpio_request(GPIO_NAND_RB, "NAND R/B");
167 if (ret) {
168 pr_warning("CM-X270: failed to request NAND R/B gpio\n");
169 goto err_gpio_request;
172 gpio_direction_input(GPIO_NAND_RB);
174 /* Allocate memory for MTD device structure and private data */
175 cmx270_nand_mtd = kzalloc(sizeof(struct mtd_info) +
176 sizeof(struct nand_chip),
177 GFP_KERNEL);
178 if (!cmx270_nand_mtd) {
179 pr_debug("Unable to allocate CM-X270 NAND MTD device structure.\n");
180 ret = -ENOMEM;
181 goto err_kzalloc;
184 cmx270_nand_io = ioremap(PXA_CS1_PHYS, 12);
185 if (!cmx270_nand_io) {
186 pr_debug("Unable to ioremap NAND device\n");
187 ret = -EINVAL;
188 goto err_ioremap;
191 /* Get pointer to private data */
192 this = (struct nand_chip *)(&cmx270_nand_mtd[1]);
194 /* Link the private data with the MTD structure */
195 cmx270_nand_mtd->owner = THIS_MODULE;
196 cmx270_nand_mtd->priv = this;
198 /* insert callbacks */
199 this->IO_ADDR_R = cmx270_nand_io;
200 this->IO_ADDR_W = cmx270_nand_io;
201 this->cmd_ctrl = cmx270_hwcontrol;
202 this->dev_ready = cmx270_device_ready;
204 /* 15 us command delay time */
205 this->chip_delay = 20;
206 this->ecc.mode = NAND_ECC_SOFT;
208 /* read/write functions */
209 this->read_byte = cmx270_read_byte;
210 this->read_buf = cmx270_read_buf;
211 this->write_buf = cmx270_write_buf;
212 this->verify_buf = cmx270_verify_buf;
214 /* Scan to find existence of the device */
215 if (nand_scan (cmx270_nand_mtd, 1)) {
216 pr_notice("No NAND device\n");
217 ret = -ENXIO;
218 goto err_scan;
221 /* Register the partitions */
222 ret = mtd_device_parse_register(cmx270_nand_mtd, NULL, NULL,
223 partition_info, NUM_PARTITIONS);
224 if (ret)
225 goto err_scan;
227 /* Return happy */
228 return 0;
230 err_scan:
231 iounmap(cmx270_nand_io);
232 err_ioremap:
233 kfree(cmx270_nand_mtd);
234 err_kzalloc:
235 gpio_free(GPIO_NAND_RB);
236 err_gpio_request:
237 gpio_free(GPIO_NAND_CS);
239 return ret;
242 module_init(cmx270_init);
245 * Clean up routine
247 static void __exit cmx270_cleanup(void)
249 /* Release resources, unregister device */
250 nand_release(cmx270_nand_mtd);
252 gpio_free(GPIO_NAND_RB);
253 gpio_free(GPIO_NAND_CS);
255 iounmap(cmx270_nand_io);
257 /* Free the MTD device structure */
258 kfree (cmx270_nand_mtd);
260 module_exit(cmx270_cleanup);
262 MODULE_LICENSE("GPL");
263 MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>");
264 MODULE_DESCRIPTION("NAND flash driver for Compulab CM-X270 Module");