Commit | Line | Data |
---|---|---|
9c3c133b AC |
1 | /* |
2 | * drivers/char/hw_random/timeriomem-rng.c | |
3 | * | |
4 | * Copyright (C) 2009 Alexander Clouter <alex@digriz.org.uk> | |
5 | * | |
6 | * Derived from drivers/char/hw_random/omap-rng.c | |
7 | * Copyright 2005 (c) MontaVista Software, Inc. | |
8 | * Author: Deepak Saxena <dsaxena@plexity.net> | |
9 | * | |
10 | * This program is free software; you can redistribute it and/or modify | |
11 | * it under the terms of the GNU General Public License version 2 as | |
12 | * published by the Free Software Foundation. | |
13 | * | |
14 | * Overview: | |
15 | * This driver is useful for platforms that have an IO range that provides | |
16 | * periodic random data from a single IO memory address. All the platform | |
17 | * has to do is provide the address and 'wait time' that new data becomes | |
18 | * available. | |
19 | * | |
20 | * TODO: add support for reading sizes other than 32bits and masking | |
21 | */ | |
22 | ||
23 | #include <linux/module.h> | |
24 | #include <linux/kernel.h> | |
25 | #include <linux/platform_device.h> | |
b149a30d | 26 | #include <linux/of.h> |
9c3c133b AC |
27 | #include <linux/hw_random.h> |
28 | #include <linux/io.h> | |
1907da78 | 29 | #include <linux/slab.h> |
9c3c133b AC |
30 | #include <linux/timeriomem-rng.h> |
31 | #include <linux/jiffies.h> | |
32 | #include <linux/sched.h> | |
33 | #include <linux/timer.h> | |
34 | #include <linux/completion.h> | |
35 | ||
1907da78 AC |
36 | struct timeriomem_rng_private_data { |
37 | void __iomem *io_base; | |
38 | unsigned int expires; | |
39 | unsigned int period; | |
40 | unsigned int present:1; | |
9c3c133b | 41 | |
1907da78 AC |
42 | struct timer_list timer; |
43 | struct completion completion; | |
44 | ||
45 | struct hwrng timeriomem_rng_ops; | |
46 | }; | |
47 | ||
48 | #define to_rng_priv(rng) \ | |
49 | ((struct timeriomem_rng_private_data *)rng->priv) | |
9c3c133b AC |
50 | |
51 | /* | |
52 | * have data return 1, however return 0 if we have nothing | |
53 | */ | |
54 | static int timeriomem_rng_data_present(struct hwrng *rng, int wait) | |
55 | { | |
1907da78 | 56 | struct timeriomem_rng_private_data *priv = to_rng_priv(rng); |
9c3c133b | 57 | |
1907da78 AC |
58 | if (!wait || priv->present) |
59 | return priv->present; | |
9c3c133b | 60 | |
1907da78 | 61 | wait_for_completion(&priv->completion); |
9c3c133b AC |
62 | |
63 | return 1; | |
64 | } | |
65 | ||
66 | static int timeriomem_rng_data_read(struct hwrng *rng, u32 *data) | |
67 | { | |
1907da78 | 68 | struct timeriomem_rng_private_data *priv = to_rng_priv(rng); |
9c3c133b AC |
69 | unsigned long cur; |
70 | s32 delay; | |
71 | ||
1907da78 | 72 | *data = readl(priv->io_base); |
9c3c133b | 73 | |
1907da78 | 74 | cur = jiffies; |
9c3c133b | 75 | |
1907da78 AC |
76 | delay = cur - priv->expires; |
77 | delay = priv->period - (delay % priv->period); | |
9c3c133b | 78 | |
1907da78 AC |
79 | priv->expires = cur + delay; |
80 | priv->present = 0; | |
9c3c133b | 81 | |
16735d02 | 82 | reinit_completion(&priv->completion); |
1907da78 | 83 | mod_timer(&priv->timer, priv->expires); |
9c3c133b AC |
84 | |
85 | return 4; | |
86 | } | |
87 | ||
1907da78 | 88 | static void timeriomem_rng_trigger(unsigned long data) |
9c3c133b | 89 | { |
1907da78 AC |
90 | struct timeriomem_rng_private_data *priv |
91 | = (struct timeriomem_rng_private_data *)data; | |
9c3c133b | 92 | |
1907da78 AC |
93 | priv->present = 1; |
94 | complete(&priv->completion); | |
95 | } | |
9c3c133b | 96 | |
bcd2982a | 97 | static int timeriomem_rng_probe(struct platform_device *pdev) |
9c3c133b | 98 | { |
1907da78 AC |
99 | struct timeriomem_rng_data *pdata = pdev->dev.platform_data; |
100 | struct timeriomem_rng_private_data *priv; | |
08ced854 | 101 | struct resource *res; |
1907da78 AC |
102 | int err = 0; |
103 | int period; | |
9c3c133b | 104 | |
b149a30d | 105 | if (!pdev->dev.of_node && !pdata) { |
1907da78 AC |
106 | dev_err(&pdev->dev, "timeriomem_rng_data is missing\n"); |
107 | return -EINVAL; | |
108 | } | |
3341323b | 109 | |
1907da78 | 110 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
3341323b | 111 | if (!res) |
1907da78 | 112 | return -ENXIO; |
3341323b | 113 | |
1907da78 AC |
114 | if (res->start % 4 != 0 || resource_size(res) != 4) { |
115 | dev_err(&pdev->dev, | |
116 | "address must be four bytes wide and aligned\n"); | |
117 | return -EINVAL; | |
118 | } | |
9c3c133b | 119 | |
1907da78 | 120 | /* Allocate memory for the device structure (and zero it) */ |
93b7f9c9 JH |
121 | priv = devm_kzalloc(&pdev->dev, |
122 | sizeof(struct timeriomem_rng_private_data), GFP_KERNEL); | |
7bad94aa | 123 | if (!priv) |
1907da78 | 124 | return -ENOMEM; |
1907da78 AC |
125 | |
126 | platform_set_drvdata(pdev, priv); | |
3341323b | 127 | |
b149a30d AC |
128 | if (pdev->dev.of_node) { |
129 | int i; | |
130 | ||
131 | if (!of_property_read_u32(pdev->dev.of_node, | |
132 | "period", &i)) | |
133 | period = i; | |
134 | else { | |
135 | dev_err(&pdev->dev, "missing period\n"); | |
93b7f9c9 | 136 | return -EINVAL; |
b149a30d | 137 | } |
93b7f9c9 | 138 | } else { |
b149a30d | 139 | period = pdata->period; |
93b7f9c9 | 140 | } |
9c3c133b | 141 | |
1907da78 AC |
142 | priv->period = usecs_to_jiffies(period); |
143 | if (priv->period < 1) { | |
144 | dev_err(&pdev->dev, "period is less than one jiffy\n"); | |
93b7f9c9 | 145 | return -EINVAL; |
9c3c133b | 146 | } |
9c3c133b | 147 | |
1907da78 AC |
148 | priv->expires = jiffies; |
149 | priv->present = 1; | |
150 | ||
151 | init_completion(&priv->completion); | |
152 | complete(&priv->completion); | |
153 | ||
154 | setup_timer(&priv->timer, timeriomem_rng_trigger, (unsigned long)priv); | |
155 | ||
156 | priv->timeriomem_rng_ops.name = dev_name(&pdev->dev); | |
157 | priv->timeriomem_rng_ops.data_present = timeriomem_rng_data_present; | |
158 | priv->timeriomem_rng_ops.data_read = timeriomem_rng_data_read; | |
159 | priv->timeriomem_rng_ops.priv = (unsigned long)priv; | |
160 | ||
93b7f9c9 JH |
161 | priv->io_base = devm_ioremap_resource(&pdev->dev, res); |
162 | if (IS_ERR(priv->io_base)) { | |
163 | err = PTR_ERR(priv->io_base); | |
1907da78 AC |
164 | goto out_timer; |
165 | } | |
166 | ||
1907da78 AC |
167 | err = hwrng_register(&priv->timeriomem_rng_ops); |
168 | if (err) { | |
169 | dev_err(&pdev->dev, "problem registering\n"); | |
93b7f9c9 | 170 | goto out_timer; |
1907da78 | 171 | } |
9c3c133b AC |
172 | |
173 | dev_info(&pdev->dev, "32bits from 0x%p @ %dus\n", | |
1907da78 | 174 | priv->io_base, period); |
9c3c133b AC |
175 | |
176 | return 0; | |
3341323b | 177 | |
1907da78 AC |
178 | out_timer: |
179 | del_timer_sync(&priv->timer); | |
1907da78 | 180 | return err; |
9c3c133b AC |
181 | } |
182 | ||
39af33fc | 183 | static int timeriomem_rng_remove(struct platform_device *pdev) |
9c3c133b | 184 | { |
1907da78 | 185 | struct timeriomem_rng_private_data *priv = platform_get_drvdata(pdev); |
1907da78 AC |
186 | |
187 | hwrng_unregister(&priv->timeriomem_rng_ops); | |
9c3c133b | 188 | |
1907da78 | 189 | del_timer_sync(&priv->timer); |
3341323b | 190 | |
9c3c133b AC |
191 | return 0; |
192 | } | |
193 | ||
b149a30d AC |
194 | static const struct of_device_id timeriomem_rng_match[] = { |
195 | { .compatible = "timeriomem_rng" }, | |
196 | {}, | |
197 | }; | |
198 | MODULE_DEVICE_TABLE(of, timeriomem_rng_match); | |
199 | ||
9c3c133b AC |
200 | static struct platform_driver timeriomem_rng_driver = { |
201 | .driver = { | |
202 | .name = "timeriomem_rng", | |
b149a30d | 203 | .of_match_table = timeriomem_rng_match, |
9c3c133b AC |
204 | }, |
205 | .probe = timeriomem_rng_probe, | |
bcd2982a | 206 | .remove = timeriomem_rng_remove, |
9c3c133b AC |
207 | }; |
208 | ||
b21cb324 | 209 | module_platform_driver(timeriomem_rng_driver); |
9c3c133b AC |
210 | |
211 | MODULE_LICENSE("GPL"); | |
212 | MODULE_AUTHOR("Alexander Clouter <alex@digriz.org.uk>"); | |
213 | MODULE_DESCRIPTION("Timer IOMEM H/W RNG driver"); |