@@ -322,6 +322,15 @@ config MTD_PARTITIONED_MASTER
the parent of the partition device be the master device, rather than
what lies behind the master.
+config MTD_DEVDATA
+ tristate "Read device data from MTD device"
+ default y
+ depends on DEVDATA
+ help
+ This provides support for reading device data from MTD devices.
+ This is can be used by drivers to read device specific data such as
+ MAC address or calibration results.
+
source "drivers/mtd/chips/Kconfig"
source "drivers/mtd/maps/Kconfig"
@@ -13,6 +13,7 @@ obj-$(CONFIG_MTD_AFS_PARTS) += afs.o
obj-$(CONFIG_MTD_AR7_PARTS) += ar7part.o
obj-$(CONFIG_MTD_BCM63XX_PARTS) += bcm63xxpart.o
obj-$(CONFIG_MTD_BCM47XX_PARTS) += bcm47xxpart.o
+obj-$(CONFIG_MTD_DEVDATA) += devdata.o
# 'Users' - code which presents functionality to userspace.
obj-$(CONFIG_MTD_BLKDEVS) += mtd_blkdevs.o
new file mode 100644
@@ -0,0 +1,70 @@
+/*
+ * Copyright (C) 2015 Alban Bedel <albeu@free.fr>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ */
+
+#include <linux/module.h>
+#include <linux/mtd/mtd.h>
+#include <linux/devdata.h>
+#include <linux/of.h>
+
+int mtd_devdata_provider_read(struct device *dev, void *buffer,
+ loff_t offset, size_t size)
+{
+ struct mtd_info *mtd = container_of(dev, struct mtd_info, dev);
+ size_t retlen;
+ int err;
+
+ err = mtd_read(mtd, offset, size, &retlen, buffer);
+ if (err && err != -EUCLEAN)
+ return err;
+ return retlen == size ? 0 : -EIO;
+}
+
+static void mtd_devdata_provider_add(struct mtd_info *mtd)
+{
+ struct device *dev = &mtd->dev;
+ struct device_node *np = dev_of_node(dev);
+ struct devdata_provider *p;
+
+ /* OF devices have to provide the data-provider node */
+ if (np && !of_property_read_bool(np, "data-provider"))
+ return;
+
+ p = devm_kzalloc(dev, sizeof(*p), GFP_KERNEL);
+ p->dev = dev;
+ p->read = mtd_devdata_provider_read;
+
+ if (devm_devdata_provider_register(dev, p))
+ dev_warn(dev, "Failed to register as devdata provider\n");
+}
+
+static void mtd_devdata_provider_remove(struct mtd_info *mtd)
+{
+}
+
+static struct mtd_notifier mtd_devdata_provider_notifier = {
+ .add = mtd_devdata_provider_add,
+ .remove = mtd_devdata_provider_remove,
+};
+
+static int __init mtd_devdata_init(void)
+{
+ register_mtd_user(&mtd_devdata_provider_notifier);
+ return 0;
+}
+module_init(mtd_devdata_init);
+
+static void __exit mtd_devdata_exit(void)
+{
+ unregister_mtd_user(&mtd_devdata_provider_notifier);
+}
+module_exit(mtd_devdata_exit);
+
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("Alban Bedel <albeu@free.fr>");
+MODULE_DESCRIPTION("Driver to read device data from MTD devices");