1f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux/* 2f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux * PISMO memory driver - http://www.pismoworld.org/ 3f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux * 4f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux * For ARM Realview and Versatile platforms 5f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux * 6f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux * This program is free software; you can redistribute it and/or modify 7f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux * it under the terms of the GNU General Public License as published by 8f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux * the Free Software Foundation; either version 2 of the License. 9f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux */ 10f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux#include <linux/init.h> 11f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux#include <linux/module.h> 12f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux#include <linux/i2c.h> 135a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 14f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux#include <linux/platform_device.h> 15f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux#include <linux/spinlock.h> 16f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux#include <linux/mutex.h> 17f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux#include <linux/mtd/physmap.h> 18f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux#include <linux/mtd/plat-ram.h> 19f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux#include <linux/mtd/pismo.h> 20f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 21f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux#define PISMO_NUM_CS 5 22f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 23f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linuxstruct pismo_cs_block { 24f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux u8 type; 25f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux u8 width; 26f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux __le16 access; 27f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux __le32 size; 28f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux u32 reserved[2]; 29f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux char device[32]; 30f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux} __packed; 31f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 32f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linuxstruct pismo_eeprom { 33f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux struct pismo_cs_block cs[PISMO_NUM_CS]; 34f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux char board[15]; 35f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux u8 sum; 36f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux} __packed; 37f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 38f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linuxstruct pismo_mem { 39f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux phys_addr_t base; 40f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux u32 size; 41f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux u16 access; 42f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux u8 width; 43f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux u8 type; 44f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux}; 45f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 46f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linuxstruct pismo_data { 47f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux struct i2c_client *client; 48f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux void (*vpp)(void *, int); 49f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux void *vpp_data; 50f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux struct platform_device *dev[PISMO_NUM_CS]; 51f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux}; 52f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 53667f390bee987d45351402e42008c52cdfb77d76Marc Zyngierstatic void pismo_set_vpp(struct platform_device *pdev, int on) 54f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux{ 55667f390bee987d45351402e42008c52cdfb77d76Marc Zyngier struct i2c_client *client = to_i2c_client(pdev->dev.parent); 56667f390bee987d45351402e42008c52cdfb77d76Marc Zyngier struct pismo_data *pismo = i2c_get_clientdata(client); 57f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 58f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux pismo->vpp(pismo->vpp_data, on); 59f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux} 60f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 6106f25510692385ed4dadd23f7d3d064d1ab11c2dBill Pembertonstatic unsigned int pismo_width_to_bytes(unsigned int width) 62f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux{ 63f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux width &= 15; 64f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux if (width > 2) 65f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux return 0; 66f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux return 1 << width; 67f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux} 68f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 69d8929942806270801023c90d78885e5347be718fGreg Kroah-Hartmanstatic int pismo_eeprom_read(struct i2c_client *client, void *buf, u8 addr, 70d8929942806270801023c90d78885e5347be718fGreg Kroah-Hartman size_t size) 71f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux{ 72f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux int ret; 73f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux struct i2c_msg msg[] = { 74f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux { 75f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux .addr = client->addr, 76f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux .len = sizeof(addr), 77f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux .buf = &addr, 78f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux }, { 79f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux .addr = client->addr, 80f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux .flags = I2C_M_RD, 81f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux .len = size, 82f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux .buf = buf, 83f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux }, 84f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux }; 85f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 86f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg)); 87f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 88f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux return ret == ARRAY_SIZE(msg) ? size : -EIO; 89f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux} 90f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 9106f25510692385ed4dadd23f7d3d064d1ab11c2dBill Pembertonstatic int pismo_add_device(struct pismo_data *pismo, int i, 92d8929942806270801023c90d78885e5347be718fGreg Kroah-Hartman struct pismo_mem *region, const char *name, 93d8929942806270801023c90d78885e5347be718fGreg Kroah-Hartman void *pdata, size_t psize) 94f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux{ 95f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux struct platform_device *dev; 96f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux struct resource res = { }; 971d40ddd10dab332456e3863fed2a6e71aa6635abRussell King phys_addr_t base = region->base; 98f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux int ret; 99f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 100f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux if (base == ~0) 101f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux return -ENXIO; 102f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 103f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux res.start = base; 104f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux res.end = base + region->size - 1; 105f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux res.flags = IORESOURCE_MEM; 106f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 107f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux dev = platform_device_alloc(name, i); 108f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux if (!dev) 109f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux return -ENOMEM; 110f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux dev->dev.parent = &pismo->client->dev; 111f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 112f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux do { 113f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux ret = platform_device_add_resources(dev, &res, 1); 114f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux if (ret) 115f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux break; 116f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 117f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux ret = platform_device_add_data(dev, pdata, psize); 118f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux if (ret) 119f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux break; 120f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 121f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux ret = platform_device_add(dev); 122f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux if (ret) 123f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux break; 124f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 125f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux pismo->dev[i] = dev; 126f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux return 0; 127f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux } while (0); 128f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 129f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux platform_device_put(dev); 130f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux return ret; 131f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux} 132f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 13306f25510692385ed4dadd23f7d3d064d1ab11c2dBill Pembertonstatic int pismo_add_nor(struct pismo_data *pismo, int i, 134d8929942806270801023c90d78885e5347be718fGreg Kroah-Hartman struct pismo_mem *region) 135f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux{ 136f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux struct physmap_flash_data data = { 137f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux .width = region->width, 138f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux }; 139f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 140f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux if (pismo->vpp) 141f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux data.set_vpp = pismo_set_vpp; 142f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 143f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux return pismo_add_device(pismo, i, region, "physmap-flash", 144f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux &data, sizeof(data)); 145f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux} 146f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 14706f25510692385ed4dadd23f7d3d064d1ab11c2dBill Pembertonstatic int pismo_add_sram(struct pismo_data *pismo, int i, 148d8929942806270801023c90d78885e5347be718fGreg Kroah-Hartman struct pismo_mem *region) 149f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux{ 150f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux struct platdata_mtd_ram data = { 151f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux .bankwidth = region->width, 152f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux }; 153f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 154f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux return pismo_add_device(pismo, i, region, "mtd-ram", 155f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux &data, sizeof(data)); 156f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux} 157f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 15806f25510692385ed4dadd23f7d3d064d1ab11c2dBill Pembertonstatic void pismo_add_one(struct pismo_data *pismo, int i, 159d8929942806270801023c90d78885e5347be718fGreg Kroah-Hartman const struct pismo_cs_block *cs, phys_addr_t base) 160f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux{ 161f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux struct device *dev = &pismo->client->dev; 162f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux struct pismo_mem region; 163f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 164f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux region.base = base; 165f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux region.type = cs->type; 166f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux region.width = pismo_width_to_bytes(cs->width); 167f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux region.access = le16_to_cpu(cs->access); 168f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux region.size = le32_to_cpu(cs->size); 169f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 170f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux if (region.width == 0) { 171f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux dev_err(dev, "cs%u: bad width: %02x, ignoring\n", i, cs->width); 172f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux return; 173f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux } 174f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 175f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux /* 176f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux * FIXME: may need to the platforms memory controller here, but at 177f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux * the moment we assume that it has already been correctly setup. 178f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux * The memory controller can also tell us the base address as well. 179f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux */ 180f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 181f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux dev_info(dev, "cs%u: %.32s: type %02x access %u00ps size %uK\n", 182f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux i, cs->device, region.type, region.access, region.size / 1024); 183f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 184f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux switch (region.type) { 185f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux case 0: 186f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux break; 187f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux case 1: 188f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux /* static DOC */ 189f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux break; 190f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux case 2: 191f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux /* static NOR */ 192f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux pismo_add_nor(pismo, i, ®ion); 193f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux break; 194f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux case 3: 195f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux /* static RAM */ 196f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux pismo_add_sram(pismo, i, ®ion); 197f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux break; 198f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux } 199f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux} 200f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 201810b7e060c14110d8f580daaf77fab3a7d950483Bill Pembertonstatic int pismo_remove(struct i2c_client *client) 202f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux{ 203f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux struct pismo_data *pismo = i2c_get_clientdata(client); 204f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux int i; 205f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 206f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux for (i = 0; i < ARRAY_SIZE(pismo->dev); i++) 207f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux platform_device_unregister(pismo->dev[i]); 208f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 209f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux kfree(pismo); 210f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 211f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux return 0; 212f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux} 213f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 21406f25510692385ed4dadd23f7d3d064d1ab11c2dBill Pembertonstatic int pismo_probe(struct i2c_client *client, 215d8929942806270801023c90d78885e5347be718fGreg Kroah-Hartman const struct i2c_device_id *id) 216f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux{ 217f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux struct i2c_adapter *adapter = to_i2c_adapter(client->dev.parent); 218f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux struct pismo_pdata *pdata = client->dev.platform_data; 219f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux struct pismo_eeprom eeprom; 220f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux struct pismo_data *pismo; 221f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux int ret, i; 222f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 223f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux if (!i2c_check_functionality(adapter, I2C_FUNC_I2C)) { 224f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux dev_err(&client->dev, "functionality mismatch\n"); 225f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux return -EIO; 226f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux } 227f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 228f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux pismo = kzalloc(sizeof(*pismo), GFP_KERNEL); 229f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux if (!pismo) 230f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux return -ENOMEM; 231f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 232f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux pismo->client = client; 233f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux if (pdata) { 234f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux pismo->vpp = pdata->set_vpp; 235f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux pismo->vpp_data = pdata->vpp_data; 236f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux } 237f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux i2c_set_clientdata(client, pismo); 238f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 239f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux ret = pismo_eeprom_read(client, &eeprom, 0, sizeof(eeprom)); 240f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux if (ret < 0) { 241f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux dev_err(&client->dev, "error reading EEPROM: %d\n", ret); 242395b228858778d3c44f7c413693a6acaa8bb62dcWolfram Sang goto exit_free; 243f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux } 244f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 245f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux dev_info(&client->dev, "%.15s board found\n", eeprom.board); 246f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 247f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux for (i = 0; i < ARRAY_SIZE(eeprom.cs); i++) 248f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux if (eeprom.cs[i].type != 0xff) 249f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux pismo_add_one(pismo, i, &eeprom.cs[i], 250f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux pdata->cs_addrs[i]); 251f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 252f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux return 0; 253395b228858778d3c44f7c413693a6acaa8bb62dcWolfram Sang 254395b228858778d3c44f7c413693a6acaa8bb62dcWolfram Sang exit_free: 255395b228858778d3c44f7c413693a6acaa8bb62dcWolfram Sang kfree(pismo); 256395b228858778d3c44f7c413693a6acaa8bb62dcWolfram Sang return ret; 257f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux} 258f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 259f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linuxstatic const struct i2c_device_id pismo_id[] = { 260f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux { "pismo" }, 261f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux { }, 262f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux}; 263f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM LinuxMODULE_DEVICE_TABLE(i2c, pismo_id); 264f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 265f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linuxstatic struct i2c_driver pismo_driver = { 266f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux .driver = { 267f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux .name = "pismo", 268f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux .owner = THIS_MODULE, 269f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux }, 270f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux .probe = pismo_probe, 2715153b88cac39b0a14662f0e15439b826bacfe213Bill Pemberton .remove = pismo_remove, 272f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux .id_table = pismo_id, 273f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux}; 274f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 275f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linuxstatic int __init pismo_init(void) 276f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux{ 277f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux BUILD_BUG_ON(sizeof(struct pismo_cs_block) != 48); 278f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux BUILD_BUG_ON(sizeof(struct pismo_eeprom) != 256); 279f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 280f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux return i2c_add_driver(&pismo_driver); 281f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux} 282f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linuxmodule_init(pismo_init); 283f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 284f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linuxstatic void __exit pismo_exit(void) 285f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux{ 286f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux i2c_del_driver(&pismo_driver); 287f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux} 288f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linuxmodule_exit(pismo_exit); 289f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM Linux 290f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM LinuxMODULE_AUTHOR("Russell King <linux@arm.linux.org.uk>"); 291f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM LinuxMODULE_DESCRIPTION("PISMO memory driver"); 292f6a8c60960bbea378142d1fa1b3d111555ee41c7Russell King - ARM LinuxMODULE_LICENSE("GPL"); 293