- Add generic mtd operations
- Add mtd_dread|derase|dwrite

The respetive MTD_UCLASS drivers must install the hooks to these
mtd_ops and other core ops are act as a interface b/w drivers
vs command code.

Reviewed-by: Simon Glass <s...@chromium.org>
Signed-off-by: Jagan Teki <ja...@amarulasolutions.com>
---
 drivers/mtd/mtd-uclass.c | 61 ++++++++++++++++++++++++++++++++++++++++++++++++
 include/mtd.h            | 46 ++++++++++++++++++++++++++++++++++++
 2 files changed, 107 insertions(+)

diff --git a/drivers/mtd/mtd-uclass.c b/drivers/mtd/mtd-uclass.c
index 7b7c48e..d2c587f 100644
--- a/drivers/mtd/mtd-uclass.c
+++ b/drivers/mtd/mtd-uclass.c
@@ -1,4 +1,5 @@
 /*
+ * Copyright (C) 2016 Jagan Teki <ja...@openedev.com>
  * Copyright (C) 2015 Thomas Chou <tho...@wytron.com.tw>
  *
  * SPDX-License-Identifier:    GPL-2.0+
@@ -8,6 +9,66 @@
 #include <dm.h>
 #include <errno.h>
 #include <mtd.h>
+#include <linux/log2.h>
+
+int mtd_dread(struct mtd_info *mtd, loff_t from, size_t len, size_t *retlen,
+             u_char *buf)
+{
+       struct udevice *dev = mtd->dev;
+       const struct mtd_ops *ops = mtd_get_ops(dev);
+
+       if (!ops->read)
+               return -ENOSYS;
+
+       *retlen = 0;
+       if (from < 0 || from > mtd->size || len > mtd->size - from)
+               return -EINVAL;
+       if (!len)
+               return 0;
+
+       return ops->read(dev, from, len, retlen, buf);
+}
+
+int mtd_derase(struct mtd_info *mtd, struct erase_info *instr)
+{
+       struct udevice *dev = mtd->dev;
+       const struct mtd_ops *ops = mtd_get_ops(dev);
+
+       if (!ops->erase)
+               return -ENOSYS;
+
+       if (instr->addr > mtd->size || instr->len > mtd->size - instr->addr)
+               return -EINVAL;
+       if (!(mtd->flags & MTD_WRITEABLE))
+               return -EROFS;
+       instr->fail_addr = MTD_FAIL_ADDR_UNKNOWN;
+       if (!instr->len) {
+               instr->state = MTD_ERASE_DONE;
+               return 0;
+       }
+
+       return ops->erase(dev, instr);
+}
+
+int mtd_dwrite(struct mtd_info *mtd, loff_t to, size_t len, size_t *retlen,
+                const u_char *buf)
+{
+       struct udevice *dev = mtd->dev;
+       const struct mtd_ops *ops = mtd_get_ops(dev);
+
+       if (!ops->write)
+               return -ENOSYS;
+
+       *retlen = 0;
+       if (to < 0 || to > mtd->size || len > mtd->size - to)
+               return -EINVAL;
+       if (!ops->write || !(mtd->flags & MTD_WRITEABLE))
+               return -EROFS;
+       if (!len)
+               return 0;
+
+       return ops->write(dev, to, len, retlen, buf);
+}
 
 /*
  * Implement a MTD uclass which should include most flash drivers.
diff --git a/include/mtd.h b/include/mtd.h
index 3f8c293..32b11c3 100644
--- a/include/mtd.h
+++ b/include/mtd.h
@@ -20,4 +20,50 @@ static inline struct mtd_info *mtd_get_info(struct udevice 
*dev)
        return dev_get_uclass_priv(dev);
 }
 
+struct mtd_ops {
+       int (*erase)(struct udevice *dev, struct erase_info *instr);
+       int (*read)(struct udevice *dev, loff_t from, size_t len,
+                    size_t *retlen, u_char *buf);
+       int (*write)(struct udevice *dev, loff_t to, size_t len,
+                     size_t *retlen, const u_char *buf);
+};
+
+/* Access the serial operations for a device */
+#define mtd_get_ops(dev) ((struct mtd_ops *)(dev)->driver->ops)
+
+/**
+ * mtd_dread() - read data from MTD device
+ *
+ * @mtd:       MTD device
+ * @from:      offset into device in bytes to read from
+ * @len:       length of bytes to read
+ * @retlen:    length of return bytes read to
+ * @buf:       buffer to put the data that is read
+ * @return 0 if OK, -ve on error
+ */
+int mtd_dread(struct mtd_info *mtd, loff_t from, size_t len, size_t *retlen,
+             u_char *buf);
+
+/**
+ * mtd_dwrite() - write data to MTD device
+ *
+ * @mtd:       MTD device
+ * @to:                offset into device in bytes to write to
+ * @len:       length of bytes to write
+ * @retlen:    length of return bytes to write to
+ * @buf:       buffer containing bytes to write
+ * @return 0 if OK, -ve on error
+ */
+int mtd_dwrite(struct mtd_info *mtd, loff_t to, size_t len, size_t *retlen,
+              const u_char *buf);
+
+/**
+ * mtd_derase() - erase blocks of the MTD device
+ *
+ * @mtd:       MTD device
+ * @instr:     erase info details of MTD device
+ * @return 0 if OK, -ve on error
+ */
+int mtd_derase(struct mtd_info *mtd, struct erase_info *instr);
+
 #endif /* _MTD_H_ */
-- 
2.7.4

_______________________________________________
U-Boot mailing list
U-Boot@lists.denx.de
https://lists.denx.de/listinfo/u-boot

Reply via email to