2 * PISMO memory driver - http://www.pismoworld.org/
4 * For ARM Realview and Versatile platforms
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License.
10 #include <linux/init.h>
11 #include <linux/module.h>
12 #include <linux/i2c.h>
13 #include <linux/platform_device.h>
14 #include <linux/spinlock.h>
15 #include <linux/mutex.h>
16 #include <linux/mtd/physmap.h>
17 #include <linux/mtd/plat-ram.h>
18 #include <linux/mtd/pismo.h>
20 #define PISMO_NUM_CS 5
22 struct pismo_cs_block
{
32 struct pismo_cs_block cs
[PISMO_NUM_CS
];
46 struct i2c_client
*client
;
47 void (*vpp
)(void *, int);
49 struct platform_device
*dev
[PISMO_NUM_CS
];
52 /* FIXME: set_vpp could do with a better calling convention */
53 static struct pismo_data
*vpp_pismo
;
54 static DEFINE_MUTEX(pismo_mutex
);
56 static int pismo_setvpp_probe_fix(struct pismo_data
*pismo
)
58 mutex_lock(&pismo_mutex
);
60 mutex_unlock(&pismo_mutex
);
65 mutex_unlock(&pismo_mutex
);
69 static void pismo_setvpp_remove_fix(struct pismo_data
*pismo
)
71 mutex_lock(&pismo_mutex
);
72 if (vpp_pismo
== pismo
)
74 mutex_unlock(&pismo_mutex
);
77 static void pismo_set_vpp(struct map_info
*map
, int on
)
79 struct pismo_data
*pismo
= vpp_pismo
;
81 pismo
->vpp(pismo
->vpp_data
, on
);
86 static unsigned int __devinit
pismo_width_to_bytes(unsigned int width
)
94 static int __devinit
pismo_eeprom_read(struct i2c_client
*client
, void *buf
,
98 struct i2c_msg msg
[] = {
100 .addr
= client
->addr
,
104 .addr
= client
->addr
,
111 ret
= i2c_transfer(client
->adapter
, msg
, ARRAY_SIZE(msg
));
113 return ret
== ARRAY_SIZE(msg
) ? size
: -EIO
;
116 static int __devinit
pismo_add_device(struct pismo_data
*pismo
, int i
,
117 struct pismo_mem
*region
, const char *name
, void *pdata
, size_t psize
)
119 struct platform_device
*dev
;
120 struct resource res
= { };
121 phys_addr_t base
= region
.base
;
128 res
.end
= base
+ region
->size
- 1;
129 res
.flags
= IORESOURCE_MEM
;
131 dev
= platform_device_alloc(name
, i
);
134 dev
->dev
.parent
= &pismo
->client
->dev
;
137 ret
= platform_device_add_resources(dev
, &res
, 1);
141 ret
= platform_device_add_data(dev
, pdata
, psize
);
145 ret
= platform_device_add(dev
);
153 platform_device_put(dev
);
157 static int __devinit
pismo_add_nor(struct pismo_data
*pismo
, int i
,
158 struct pismo_mem
*region
)
160 struct physmap_flash_data data
= {
161 .width
= region
->width
,
165 data
.set_vpp
= pismo_set_vpp
;
167 return pismo_add_device(pismo
, i
, region
, "physmap-flash",
168 &data
, sizeof(data
));
171 static int __devinit
pismo_add_sram(struct pismo_data
*pismo
, int i
,
172 struct pismo_mem
*region
)
174 struct platdata_mtd_ram data
= {
175 .bankwidth
= region
->width
,
178 return pismo_add_device(pismo
, i
, region
, "mtd-ram",
179 &data
, sizeof(data
));
182 static void __devinit
pismo_add_one(struct pismo_data
*pismo
, int i
,
183 const struct pismo_cs_block
*cs
, phys_addr_t base
)
185 struct device
*dev
= &pismo
->client
->dev
;
186 struct pismo_mem region
;
189 region
.type
= cs
->type
;
190 region
.width
= pismo_width_to_bytes(cs
->width
);
191 region
.access
= le16_to_cpu(cs
->access
);
192 region
.size
= le32_to_cpu(cs
->size
);
194 if (region
.width
== 0) {
195 dev_err(dev
, "cs%u: bad width: %02x, ignoring\n", i
, cs
->width
);
200 * FIXME: may need to the platforms memory controller here, but at
201 * the moment we assume that it has already been correctly setup.
202 * The memory controller can also tell us the base address as well.
205 dev_info(dev
, "cs%u: %.32s: type %02x access %u00ps size %uK\n",
206 i
, cs
->device
, region
.type
, region
.access
, region
.size
/ 1024);
208 switch (region
.type
) {
216 pismo_add_nor(pismo
, i
, ®ion
);
220 pismo_add_sram(pismo
, i
, ®ion
);
225 static int __devexit
pismo_remove(struct i2c_client
*client
)
227 struct pismo_data
*pismo
= i2c_get_clientdata(client
);
230 for (i
= 0; i
< ARRAY_SIZE(pismo
->dev
); i
++)
231 platform_device_unregister(pismo
->dev
[i
]);
233 /* FIXME: set_vpp needs saner arguments */
234 pismo_setvpp_remove_fix(pismo
);
241 static int __devinit
pismo_probe(struct i2c_client
*client
,
242 const struct i2c_device_id
*id
)
244 struct i2c_adapter
*adapter
= to_i2c_adapter(client
->dev
.parent
);
245 struct pismo_pdata
*pdata
= client
->dev
.platform_data
;
246 struct pismo_eeprom eeprom
;
247 struct pismo_data
*pismo
;
250 if (!i2c_check_functionality(adapter
, I2C_FUNC_I2C
)) {
251 dev_err(&client
->dev
, "functionality mismatch\n");
255 pismo
= kzalloc(sizeof(*pismo
), GFP_KERNEL
);
259 /* FIXME: set_vpp needs saner arguments */
260 ret
= pismo_setvpp_probe_fix(pismo
);
264 pismo
->client
= client
;
266 pismo
->vpp
= pdata
->set_vpp
;
267 pismo
->vpp_data
= pdata
->vpp_data
;
269 i2c_set_clientdata(client
, pismo
);
271 ret
= pismo_eeprom_read(client
, &eeprom
, 0, sizeof(eeprom
));
273 dev_err(&client
->dev
, "error reading EEPROM: %d\n", ret
);
277 dev_info(&client
->dev
, "%.15s board found\n", eeprom
.board
);
279 for (i
= 0; i
< ARRAY_SIZE(eeprom
.cs
); i
++)
280 if (eeprom
.cs
[i
].type
!= 0xff)
281 pismo_add_one(pismo
, i
, &eeprom
.cs
[i
],
287 static const struct i2c_device_id pismo_id
[] = {
291 MODULE_DEVICE_TABLE(i2c
, pismo_id
);
293 static struct i2c_driver pismo_driver
= {
296 .owner
= THIS_MODULE
,
298 .probe
= pismo_probe
,
299 .remove
= __devexit_p(pismo_remove
),
300 .id_table
= pismo_id
,
303 static int __init
pismo_init(void)
305 BUILD_BUG_ON(sizeof(struct pismo_cs_block
) != 48);
306 BUILD_BUG_ON(sizeof(struct pismo_eeprom
) != 256);
308 return i2c_add_driver(&pismo_driver
);
310 module_init(pismo_init
);
312 static void __exit
pismo_exit(void)
314 i2c_del_driver(&pismo_driver
);
316 module_exit(pismo_exit
);
318 MODULE_AUTHOR("Russell King <linux@arm.linux.org.uk>");
319 MODULE_DESCRIPTION("PISMO memory driver");
320 MODULE_LICENSE("GPL");