drivers/mtd/hyperbus/hyperbus-core.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 //
   3 // Copyright (C) 2019 Texas Instruments Incorporated - https://www.ti.com/
   4 // Author: Vignesh Raghavendra <[email protected]>
   5
   6 #include <linux/err.h>
   7 #include <linux/kernel.h>
   8 #include <linux/module.h>
   9 #include <linux/mtd/hyperbus.h>
  10 #include <linux/mtd/map.h>
  11 #include <linux/mtd/mtd.h>
  12 #include <linux/of.h>
  13 #include <linux/types.h>
  14
  15 static struct hyperbus_device *map_to_hbdev(struct map_info *map)
  16 {
  17         return container_of(map, struct hyperbus_device, map);
  18 }
  19
  20 static map_word hyperbus_read16(struct map_info *map, unsigned long addr)
  21 {
  22         struct hyperbus_device *hbdev = map_to_hbdev(map);
  23         struct hyperbus_ctlr *ctlr = hbdev->ctlr;
  24         map_word read_data;
  25
  26         read_data.x[0] = ctlr->ops->read16(hbdev, addr);
  27
  28         return read_data;
  29 }
  30
  31 static void hyperbus_write16(struct map_info *map, map_word d,
  32                              unsigned long addr)
  33 {
  34         struct hyperbus_device *hbdev = map_to_hbdev(map);
  35         struct hyperbus_ctlr *ctlr = hbdev->ctlr;
  36
  37         ctlr->ops->write16(hbdev, addr, d.x[0]);
  38 }
  39
  40 static void hyperbus_copy_from(struct map_info *map, void *to,
  41                                unsigned long from, ssize_t len)
  42 {
  43         struct hyperbus_device *hbdev = map_to_hbdev(map);
  44         struct hyperbus_ctlr *ctlr = hbdev->ctlr;
  45
  46         ctlr->ops->copy_from(hbdev, to, from, len);
  47 }
  48
  49 static void hyperbus_copy_to(struct map_info *map, unsigned long to,
  50                              const void *from, ssize_t len)
  51 {
  52         struct hyperbus_device *hbdev = map_to_hbdev(map);
  53         struct hyperbus_ctlr *ctlr = hbdev->ctlr;
  54
  55         ctlr->ops->copy_to(hbdev, to, from, len);
  56 }
  57
  58 int hyperbus_register_device(struct hyperbus_device *hbdev)
  59 {
  60         const struct hyperbus_ops *ops;
  61         struct hyperbus_ctlr *ctlr;
  62         struct device_node *np;
  63         struct map_info *map;
  64         struct device *dev;
  65         int ret;
  66
  67         if (!hbdev || !hbdev->np || !hbdev->ctlr || !hbdev->ctlr->dev) {
  68                 pr_err("hyperbus: please fill all the necessary fields!\n");
  69                 return -EINVAL;
  70         }
  71
  72         np = hbdev->np;
  73         ctlr = hbdev->ctlr;
  74         if (!of_device_is_compatible(np, "cypress,hyperflash")) {
  75                 dev_err(ctlr->dev, "\"cypress,hyperflash\" compatible missing\n");
  76                 return -ENODEV;
  77         }
  78
  79         hbdev->memtype = HYPERFLASH;
  80
  81         dev = ctlr->dev;
  82         map = &hbdev->map;
  83         map->name = dev_name(dev);
  84         map->bankwidth = 2;
  85         map->device_node = np;
  86
  87         simple_map_init(map);
  88         ops = ctlr->ops;
  89         if (ops) {
  90                 if (ops->read16)
  91                         map->read = hyperbus_read16;
  92                 if (ops->write16)
  93                         map->write = hyperbus_write16;
  94                 if (ops->copy_to)
  95                         map->copy_to = hyperbus_copy_to;
  96                 if (ops->copy_from)
  97                         map->copy_from = hyperbus_copy_from;
  98
  99                 if (ops->calibrate && !ctlr->calibrated) {
 100                         ret = ops->calibrate(hbdev);
 101                         if (!ret) {
 102                                 dev_err(dev, "Calibration failed\n");
 103                                 return -ENODEV;
 104                         }
 105                         ctlr->calibrated = true;
 106                 }
 107         }
 108
 109         hbdev->mtd = do_map_probe("cfi_probe", map);
 110         if (!hbdev->mtd) {
 111                 dev_err(dev, "probing of hyperbus device failed\n");
 112                 return -ENODEV;
 113         }
 114
 115         hbdev->mtd->dev.parent = dev;
 116         mtd_set_of_node(hbdev->mtd, np);
 117
 118         ret = mtd_device_register(hbdev->mtd, NULL, 0);
 119         if (ret) {
 120                 dev_err(dev, "failed to register mtd device\n");
 121                 map_destroy(hbdev->mtd);
 122                 return ret;
 123         }
 124
 125         return 0;
 126 }
 127 EXPORT_SYMBOL_GPL(hyperbus_register_device);
 128
 129 void hyperbus_unregister_device(struct hyperbus_device *hbdev)
 130 {
 131         if (hbdev && hbdev->mtd) {
 132                 WARN_ON(mtd_device_unregister(hbdev->mtd));
 133                 map_destroy(hbdev->mtd);
 134         }
 135 }
 136 EXPORT_SYMBOL_GPL(hyperbus_unregister_device);
 137
 138 MODULE_DESCRIPTION("HyperBus Framework");
 139 MODULE_LICENSE("GPL v2");
 140 MODULE_AUTHOR("Vignesh Raghavendra <[email protected]>");