eeprom: at25: Add dt probe support
The parsing code has been taken directly from Linux 3.15-rc5. Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
This commit is contained in:
parent
dc611863be
commit
b3198966fd
|
@ -238,27 +238,94 @@ static struct file_operations at25_fops = {
|
|||
.lseek = dev_lseek_default,
|
||||
};
|
||||
|
||||
static int at25_np_to_chip(struct device_d *dev,
|
||||
struct device_node *np,
|
||||
struct spi_eeprom *chip)
|
||||
{
|
||||
u32 val;
|
||||
|
||||
if (!IS_ENABLED(CONFIG_OFDEVICE))
|
||||
return -ENODEV;
|
||||
|
||||
memset(chip, 0, sizeof(*chip));
|
||||
strncpy(chip->name, np->name, sizeof(chip->name));
|
||||
|
||||
if (of_property_read_u32(np, "size", &val) == 0 ||
|
||||
of_property_read_u32(np, "at25,byte-len", &val) == 0) {
|
||||
chip->size = val;
|
||||
} else {
|
||||
dev_err(dev, "Error: missing \"size\" property\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
if (of_property_read_u32(np, "pagesize", &val) == 0 ||
|
||||
of_property_read_u32(np, "at25,page-size", &val) == 0) {
|
||||
chip->page_size = (u16)val;
|
||||
} else {
|
||||
dev_err(dev, "Error: missing \"pagesize\" property\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
if (of_property_read_u32(np, "at25,addr-mode", &val) == 0) {
|
||||
chip->flags = (u16)val;
|
||||
} else {
|
||||
if (of_property_read_u32(np, "address-width", &val)) {
|
||||
dev_err(dev,
|
||||
"Error: missing \"address-width\" property\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
switch (val) {
|
||||
case 8:
|
||||
chip->flags |= EE_ADDR1;
|
||||
break;
|
||||
case 16:
|
||||
chip->flags |= EE_ADDR2;
|
||||
break;
|
||||
case 24:
|
||||
chip->flags |= EE_ADDR3;
|
||||
break;
|
||||
default:
|
||||
dev_err(dev,
|
||||
"Error: bad \"address-width\" property: %u\n",
|
||||
val);
|
||||
return -ENODEV;
|
||||
}
|
||||
if (of_find_property(np, "read-only", NULL))
|
||||
chip->flags |= EE_READONLY;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int at25_probe(struct device_d *dev)
|
||||
{
|
||||
int err, sr;
|
||||
int addrlen;
|
||||
struct at25_data *at25 = NULL;
|
||||
const struct spi_eeprom *chip;
|
||||
struct spi_eeprom *chip;
|
||||
|
||||
at25 = xzalloc(sizeof(*at25));
|
||||
|
||||
/* Chip description */
|
||||
chip = dev->platform_data;
|
||||
if (!chip) {
|
||||
dev_dbg(dev, "no chip description\n");
|
||||
err = -ENODEV;
|
||||
goto fail;
|
||||
if (dev->device_node) {
|
||||
err = at25_np_to_chip(dev, dev->device_node, &at25->chip);
|
||||
if (err)
|
||||
goto fail;
|
||||
} else {
|
||||
chip = dev->platform_data;
|
||||
if (!chip) {
|
||||
dev_dbg(dev, "no chip description\n");
|
||||
err = -ENODEV;
|
||||
goto fail;
|
||||
}
|
||||
at25->chip = *chip;
|
||||
}
|
||||
|
||||
/* For now we only support 8/16/24 bit addressing */
|
||||
if (chip->flags & EE_ADDR1) {
|
||||
if (at25->chip.flags & EE_ADDR1) {
|
||||
addrlen = 1;
|
||||
} else if (chip->flags & EE_ADDR2) {
|
||||
} else if (at25->chip.flags & EE_ADDR2) {
|
||||
addrlen = 2;
|
||||
} else if (chip->flags & EE_ADDR3) {
|
||||
} else if (at25->chip.flags & EE_ADDR3) {
|
||||
addrlen = 3;
|
||||
} else {
|
||||
dev_dbg(dev, "unsupported address type\n");
|
||||
|
@ -266,14 +333,12 @@ static int at25_probe(struct device_d *dev)
|
|||
goto fail;
|
||||
}
|
||||
|
||||
at25 = xzalloc(sizeof(*at25));
|
||||
at25->chip = *chip;
|
||||
at25->addrlen = addrlen;
|
||||
at25->spi = dev->type_data;
|
||||
at25->spi->mode = SPI_MODE_0;
|
||||
at25->spi->bits_per_word = 8;
|
||||
at25->cdev.ops = &at25_fops;
|
||||
at25->cdev.size = chip->size;
|
||||
at25->cdev.size = at25->chip.size;
|
||||
at25->cdev.dev = dev;
|
||||
at25->cdev.name = at25->chip.name[0] ? at25->chip.name : DRIVERNAME;
|
||||
at25->cdev.priv = at25;
|
||||
|
@ -299,8 +364,17 @@ fail:
|
|||
return err;
|
||||
}
|
||||
|
||||
static __maybe_unused struct of_device_id at25_dt_ids[] = {
|
||||
{
|
||||
.compatible = "atmel,at25",
|
||||
}, {
|
||||
/* sentinel */
|
||||
}
|
||||
};
|
||||
|
||||
static struct driver_d at25_driver = {
|
||||
.name = DRIVERNAME,
|
||||
.of_compatible = DRV_OF_COMPAT(at25_dt_ids),
|
||||
.probe = at25_probe,
|
||||
};
|
||||
device_spi_driver(at25_driver);
|
||||
|
|
Loading…
Reference in New Issue