1
2
3
4
5
6
7
8
9#include <linux/clk.h>
10#include <linux/init.h>
11#include <linux/module.h>
12#include <linux/of_platform.h>
13#include <linux/platform_device.h>
14
15#include "ingenic_ecc.h"
16
17
18
19
20
21
22
23
24
25
26
27int ingenic_ecc_calculate(struct ingenic_ecc *ecc,
28 struct ingenic_ecc_params *params,
29 const u8 *buf, u8 *ecc_code)
30{
31 return ecc->ops->calculate(ecc, params, buf, ecc_code);
32}
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47int ingenic_ecc_correct(struct ingenic_ecc *ecc,
48 struct ingenic_ecc_params *params,
49 u8 *buf, u8 *ecc_code)
50{
51 return ecc->ops->correct(ecc, params, buf, ecc_code);
52}
53
54
55
56
57
58
59
60
61
62
63
64
65static struct ingenic_ecc *ingenic_ecc_get(struct device_node *np)
66{
67 struct platform_device *pdev;
68 struct ingenic_ecc *ecc;
69
70 pdev = of_find_device_by_node(np);
71 if (!pdev || !platform_get_drvdata(pdev))
72 return ERR_PTR(-EPROBE_DEFER);
73
74 ecc = platform_get_drvdata(pdev);
75 clk_prepare_enable(ecc->clk);
76
77 return ecc;
78}
79
80
81
82
83
84
85
86
87
88
89
90struct ingenic_ecc *of_ingenic_ecc_get(struct device_node *of_node)
91{
92 struct ingenic_ecc *ecc = NULL;
93 struct device_node *np;
94
95 np = of_parse_phandle(of_node, "ecc-engine", 0);
96
97
98
99
100
101 if (!np)
102 np = of_parse_phandle(of_node, "ingenic,bch-controller", 0);
103
104 if (np) {
105 ecc = ingenic_ecc_get(np);
106 of_node_put(np);
107 }
108 return ecc;
109}
110
111
112
113
114
115void ingenic_ecc_release(struct ingenic_ecc *ecc)
116{
117 clk_disable_unprepare(ecc->clk);
118 put_device(ecc->dev);
119}
120
121int ingenic_ecc_probe(struct platform_device *pdev)
122{
123 struct device *dev = &pdev->dev;
124 struct ingenic_ecc *ecc;
125
126 ecc = devm_kzalloc(dev, sizeof(*ecc), GFP_KERNEL);
127 if (!ecc)
128 return -ENOMEM;
129
130 ecc->ops = device_get_match_data(dev);
131 if (!ecc->ops)
132 return -EINVAL;
133
134 ecc->base = devm_platform_ioremap_resource(pdev, 0);
135 if (IS_ERR(ecc->base))
136 return PTR_ERR(ecc->base);
137
138 ecc->ops->disable(ecc);
139
140 ecc->clk = devm_clk_get(dev, NULL);
141 if (IS_ERR(ecc->clk)) {
142 dev_err(dev, "failed to get clock: %ld\n", PTR_ERR(ecc->clk));
143 return PTR_ERR(ecc->clk);
144 }
145
146 mutex_init(&ecc->lock);
147
148 ecc->dev = dev;
149 platform_set_drvdata(pdev, ecc);
150
151 return 0;
152}
153EXPORT_SYMBOL(ingenic_ecc_probe);
154