1 // SPDX-License-Identifier: GPL-2.0
2 //
3 // Copyright (C) 2019 Texas Instruments Incorporated - https://www.ti.com/
4 // Author: Vignesh Raghavendra <vigneshr@ti.com>
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 
map_to_hbdev(struct map_info * map)15 static struct hyperbus_device *map_to_hbdev(struct map_info *map)
16 {
17 	return container_of(map, struct hyperbus_device, map);
18 }
19 
hyperbus_read16(struct map_info * map,unsigned long addr)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 
hyperbus_write16(struct map_info * map,map_word d,unsigned long addr)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 
hyperbus_copy_from(struct map_info * map,void * to,unsigned long from,ssize_t len)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 
hyperbus_copy_to(struct map_info * map,unsigned long to,const void * from,ssize_t len)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 
hyperbus_register_device(struct hyperbus_device * hbdev)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 
hyperbus_unregister_device(struct hyperbus_device * hbdev)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 <vigneshr@ti.com>");
141