mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-08-21 01:18:52 +09:00
![Robert Beckett](/assets/img/avatar_default.png)
Set the correct offset length and chip address offset mask for each device to allow correct access to total capacity of the devices. Signed-off-by: Robert Beckett <bob.beckett@collabora.com>
371 lines
8.4 KiB
C
371 lines
8.4 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright (c) 2014 Google, Inc
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <eeprom.h>
|
|
#include <linux/err.h>
|
|
#include <linux/kernel.h>
|
|
#include <dm.h>
|
|
#include <dm/device-internal.h>
|
|
#include <i2c.h>
|
|
#include <i2c_eeprom.h>
|
|
|
|
struct i2c_eeprom_drv_data {
|
|
u32 size; /* size in bytes */
|
|
u32 pagewidth; /* pagesize = 2^pagewidth */
|
|
u32 addr_offset_mask; /* bits in addr used for offset overflow */
|
|
u32 offset_len; /* size in bytes of offset */
|
|
};
|
|
|
|
int i2c_eeprom_read(struct udevice *dev, int offset, uint8_t *buf, int size)
|
|
{
|
|
const struct i2c_eeprom_ops *ops = device_get_ops(dev);
|
|
|
|
if (!ops->read)
|
|
return -ENOSYS;
|
|
|
|
return ops->read(dev, offset, buf, size);
|
|
}
|
|
|
|
int i2c_eeprom_write(struct udevice *dev, int offset, uint8_t *buf, int size)
|
|
{
|
|
const struct i2c_eeprom_ops *ops = device_get_ops(dev);
|
|
|
|
if (!ops->write)
|
|
return -ENOSYS;
|
|
|
|
return ops->write(dev, offset, buf, size);
|
|
}
|
|
|
|
int i2c_eeprom_size(struct udevice *dev)
|
|
{
|
|
const struct i2c_eeprom_ops *ops = device_get_ops(dev);
|
|
|
|
if (!ops->size)
|
|
return -ENOSYS;
|
|
|
|
return ops->size(dev);
|
|
}
|
|
|
|
static int i2c_eeprom_std_read(struct udevice *dev, int offset, uint8_t *buf,
|
|
int size)
|
|
{
|
|
return dm_i2c_read(dev, offset, buf, size);
|
|
}
|
|
|
|
static int i2c_eeprom_std_write(struct udevice *dev, int offset,
|
|
const uint8_t *buf, int size)
|
|
{
|
|
struct i2c_eeprom *priv = dev_get_priv(dev);
|
|
int ret;
|
|
|
|
while (size > 0) {
|
|
int write_size = min_t(int, size, priv->pagesize);
|
|
|
|
ret = dm_i2c_write(dev, offset, buf, write_size);
|
|
if (ret)
|
|
return ret;
|
|
|
|
offset += write_size;
|
|
buf += write_size;
|
|
size -= write_size;
|
|
|
|
udelay(10000);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int i2c_eeprom_std_size(struct udevice *dev)
|
|
{
|
|
struct i2c_eeprom *priv = dev_get_priv(dev);
|
|
|
|
return priv->size;
|
|
}
|
|
|
|
static const struct i2c_eeprom_ops i2c_eeprom_std_ops = {
|
|
.read = i2c_eeprom_std_read,
|
|
.write = i2c_eeprom_std_write,
|
|
.size = i2c_eeprom_std_size,
|
|
};
|
|
|
|
static int i2c_eeprom_std_ofdata_to_platdata(struct udevice *dev)
|
|
{
|
|
struct i2c_eeprom *priv = dev_get_priv(dev);
|
|
struct i2c_eeprom_drv_data *data =
|
|
(struct i2c_eeprom_drv_data *)dev_get_driver_data(dev);
|
|
u32 pagesize;
|
|
u32 size;
|
|
|
|
if (dev_read_u32(dev, "pagesize", &pagesize) == 0) {
|
|
priv->pagesize = pagesize;
|
|
} else {
|
|
/* 6 bit -> page size of up to 2^63 (should be sufficient) */
|
|
priv->pagewidth = data->pagewidth;
|
|
priv->pagesize = (1 << priv->pagewidth);
|
|
}
|
|
|
|
if (dev_read_u32(dev, "size", &size) == 0)
|
|
priv->size = size;
|
|
else
|
|
priv->size = data->size;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int i2c_eeprom_std_bind(struct udevice *dev)
|
|
{
|
|
ofnode partitions = ofnode_find_subnode(dev_ofnode(dev), "partitions");
|
|
ofnode partition;
|
|
const char *name;
|
|
|
|
if (!ofnode_valid(partitions))
|
|
return 0;
|
|
if (!ofnode_device_is_compatible(partitions, "fixed-partitions"))
|
|
return -ENOTSUPP;
|
|
|
|
ofnode_for_each_subnode(partition, partitions) {
|
|
name = ofnode_get_name(partition);
|
|
if (!name)
|
|
continue;
|
|
|
|
device_bind_ofnode(dev, DM_GET_DRIVER(i2c_eeprom_partition),
|
|
name, NULL, partition, NULL);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int i2c_eeprom_std_probe(struct udevice *dev)
|
|
{
|
|
u8 test_byte;
|
|
int ret;
|
|
struct i2c_eeprom_drv_data *data =
|
|
(struct i2c_eeprom_drv_data *)dev_get_driver_data(dev);
|
|
|
|
i2c_set_chip_offset_len(dev, data->offset_len);
|
|
i2c_set_chip_addr_offset_mask(dev, data->addr_offset_mask);
|
|
|
|
/* Verify that the chip is functional */
|
|
ret = i2c_eeprom_read(dev, 0, &test_byte, 1);
|
|
if (ret)
|
|
return -ENODEV;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct i2c_eeprom_drv_data eeprom_data = {
|
|
.size = 0,
|
|
.pagewidth = 0,
|
|
.addr_offset_mask = 0,
|
|
.offset_len = 1,
|
|
};
|
|
|
|
static const struct i2c_eeprom_drv_data mc24aa02e48_data = {
|
|
.size = 256,
|
|
.pagewidth = 3,
|
|
.addr_offset_mask = 0,
|
|
.offset_len = 1,
|
|
};
|
|
|
|
static const struct i2c_eeprom_drv_data atmel24c01a_data = {
|
|
.size = 128,
|
|
.pagewidth = 3,
|
|
.addr_offset_mask = 0,
|
|
.offset_len = 1,
|
|
};
|
|
|
|
static const struct i2c_eeprom_drv_data atmel24c02_data = {
|
|
.size = 256,
|
|
.pagewidth = 3,
|
|
.addr_offset_mask = 0,
|
|
.offset_len = 1,
|
|
};
|
|
|
|
static const struct i2c_eeprom_drv_data atmel24c04_data = {
|
|
.size = 512,
|
|
.pagewidth = 4,
|
|
.addr_offset_mask = 0x1,
|
|
.offset_len = 1,
|
|
};
|
|
|
|
static const struct i2c_eeprom_drv_data atmel24c08_data = {
|
|
.size = 1024,
|
|
.pagewidth = 4,
|
|
.addr_offset_mask = 0x3,
|
|
.offset_len = 1,
|
|
};
|
|
|
|
static const struct i2c_eeprom_drv_data atmel24c08a_data = {
|
|
.size = 1024,
|
|
.pagewidth = 4,
|
|
.addr_offset_mask = 0x3,
|
|
.offset_len = 1,
|
|
};
|
|
|
|
static const struct i2c_eeprom_drv_data atmel24c16a_data = {
|
|
.size = 2048,
|
|
.pagewidth = 4,
|
|
.addr_offset_mask = 0x7,
|
|
.offset_len = 1,
|
|
};
|
|
|
|
static const struct i2c_eeprom_drv_data atmel24mac402_data = {
|
|
.size = 256,
|
|
.pagewidth = 4,
|
|
.addr_offset_mask = 0,
|
|
.offset_len = 1,
|
|
};
|
|
|
|
static const struct i2c_eeprom_drv_data atmel24c32_data = {
|
|
.size = 4096,
|
|
.pagewidth = 5,
|
|
.addr_offset_mask = 0,
|
|
.offset_len = 2,
|
|
};
|
|
|
|
static const struct i2c_eeprom_drv_data atmel24c64_data = {
|
|
.size = 8192,
|
|
.pagewidth = 5,
|
|
.addr_offset_mask = 0,
|
|
.offset_len = 2,
|
|
};
|
|
|
|
static const struct i2c_eeprom_drv_data atmel24c128_data = {
|
|
.size = 16384,
|
|
.pagewidth = 6,
|
|
.addr_offset_mask = 0,
|
|
.offset_len = 2,
|
|
};
|
|
|
|
static const struct i2c_eeprom_drv_data atmel24c256_data = {
|
|
.size = 32768,
|
|
.pagewidth = 6,
|
|
.addr_offset_mask = 0,
|
|
.offset_len = 2,
|
|
};
|
|
|
|
static const struct i2c_eeprom_drv_data atmel24c512_data = {
|
|
.size = 65536,
|
|
.pagewidth = 6,
|
|
.addr_offset_mask = 0,
|
|
.offset_len = 2,
|
|
};
|
|
|
|
static const struct udevice_id i2c_eeprom_std_ids[] = {
|
|
{ .compatible = "i2c-eeprom", (ulong)&eeprom_data },
|
|
{ .compatible = "microchip,24aa02e48", (ulong)&mc24aa02e48_data },
|
|
{ .compatible = "atmel,24c01a", (ulong)&atmel24c01a_data },
|
|
{ .compatible = "atmel,24c02", (ulong)&atmel24c02_data },
|
|
{ .compatible = "atmel,24c04", (ulong)&atmel24c04_data },
|
|
{ .compatible = "atmel,24c08", (ulong)&atmel24c08_data },
|
|
{ .compatible = "atmel,24c08a", (ulong)&atmel24c08a_data },
|
|
{ .compatible = "atmel,24c16a", (ulong)&atmel24c16a_data },
|
|
{ .compatible = "atmel,24mac402", (ulong)&atmel24mac402_data },
|
|
{ .compatible = "atmel,24c32", (ulong)&atmel24c32_data },
|
|
{ .compatible = "atmel,24c64", (ulong)&atmel24c64_data },
|
|
{ .compatible = "atmel,24c128", (ulong)&atmel24c128_data },
|
|
{ .compatible = "atmel,24c256", (ulong)&atmel24c256_data },
|
|
{ .compatible = "atmel,24c512", (ulong)&atmel24c512_data },
|
|
{ }
|
|
};
|
|
|
|
U_BOOT_DRIVER(i2c_eeprom_std) = {
|
|
.name = "i2c_eeprom",
|
|
.id = UCLASS_I2C_EEPROM,
|
|
.of_match = i2c_eeprom_std_ids,
|
|
.bind = i2c_eeprom_std_bind,
|
|
.probe = i2c_eeprom_std_probe,
|
|
.ofdata_to_platdata = i2c_eeprom_std_ofdata_to_platdata,
|
|
.priv_auto_alloc_size = sizeof(struct i2c_eeprom),
|
|
.ops = &i2c_eeprom_std_ops,
|
|
};
|
|
|
|
struct i2c_eeprom_partition {
|
|
u32 offset;
|
|
u32 size;
|
|
};
|
|
|
|
static int i2c_eeprom_partition_probe(struct udevice *dev)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static int i2c_eeprom_partition_ofdata_to_platdata(struct udevice *dev)
|
|
{
|
|
struct i2c_eeprom_partition *priv = dev_get_priv(dev);
|
|
u32 offset, size;
|
|
int ret;
|
|
|
|
ret = dev_read_u32(dev, "offset", &offset);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = dev_read_u32(dev, "size", &size);
|
|
if (ret)
|
|
return ret;
|
|
|
|
priv->offset = offset;
|
|
priv->size = size;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int i2c_eeprom_partition_read(struct udevice *dev, int offset,
|
|
u8 *buf, int size)
|
|
{
|
|
struct i2c_eeprom_partition *priv = dev_get_priv(dev);
|
|
struct udevice *parent = dev_get_parent(dev);
|
|
|
|
if (!parent)
|
|
return -ENODEV;
|
|
if (offset + size > priv->size)
|
|
return -EINVAL;
|
|
|
|
return i2c_eeprom_read(parent, offset + priv->offset, buf, size);
|
|
}
|
|
|
|
static int i2c_eeprom_partition_write(struct udevice *dev, int offset,
|
|
const u8 *buf, int size)
|
|
{
|
|
struct i2c_eeprom_partition *priv = dev_get_priv(dev);
|
|
struct udevice *parent = dev_get_parent(dev);
|
|
|
|
if (!parent)
|
|
return -ENODEV;
|
|
if (offset + size > priv->size)
|
|
return -EINVAL;
|
|
|
|
return i2c_eeprom_write(parent, offset + priv->offset, (uint8_t *)buf,
|
|
size);
|
|
}
|
|
|
|
static int i2c_eeprom_partition_size(struct udevice *dev)
|
|
{
|
|
struct i2c_eeprom_partition *priv = dev_get_priv(dev);
|
|
|
|
return priv->size;
|
|
}
|
|
|
|
static const struct i2c_eeprom_ops i2c_eeprom_partition_ops = {
|
|
.read = i2c_eeprom_partition_read,
|
|
.write = i2c_eeprom_partition_write,
|
|
.size = i2c_eeprom_partition_size,
|
|
};
|
|
|
|
U_BOOT_DRIVER(i2c_eeprom_partition) = {
|
|
.name = "i2c_eeprom_partition",
|
|
.id = UCLASS_I2C_EEPROM,
|
|
.probe = i2c_eeprom_partition_probe,
|
|
.ofdata_to_platdata = i2c_eeprom_partition_ofdata_to_platdata,
|
|
.priv_auto_alloc_size = sizeof(struct i2c_eeprom_partition),
|
|
.ops = &i2c_eeprom_partition_ops,
|
|
};
|
|
|
|
UCLASS_DRIVER(i2c_eeprom) = {
|
|
.id = UCLASS_I2C_EEPROM,
|
|
.name = "i2c_eeprom",
|
|
};
|