drivers/char/hw_random/timeriomem-rng.c

   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>
  26 #include <linux/hw_random.h>
  27 #include <linux/io.h>
  28 #include <linux/timeriomem-rng.h>
  29 #include <linux/jiffies.h>
  30 #include <linux/sched.h>
  31 #include <linux/timer.h>
  32 #include <linux/completion.h>
  33
  34 static struct timeriomem_rng_data *timeriomem_rng_data;
  35
  36 static void timeriomem_rng_trigger(unsigned long);
  37 static DEFINE_TIMER(timeriomem_rng_timer, timeriomem_rng_trigger, 0, 0);
  38
  39 /*
  40  * have data return 1, however return 0 if we have nothing
  41  */
  42 static int timeriomem_rng_data_present(struct hwrng *rng, int wait)
  43 {
  44         if (rng->priv == 0)
  45                 return 1;
  46
  47         if (!wait || timeriomem_rng_data->present)
  48                 return timeriomem_rng_data->present;
  49
  50         wait_for_completion(&timeriomem_rng_data->completion);
  51
  52         return 1;
  53 }
  54
  55 static int timeriomem_rng_data_read(struct hwrng *rng, u32 *data)
  56 {
  57         unsigned long cur;
  58         s32 delay;
  59
  60         *data = readl(timeriomem_rng_data->address);
  61
  62         if (rng->priv != 0) {
  63                 cur = jiffies;
  64
  65                 delay = cur - timeriomem_rng_timer.expires;
  66                 delay = rng->priv - (delay % rng->priv);
  67
  68                 timeriomem_rng_timer.expires = cur + delay;
  69                 timeriomem_rng_data->present = 0;
  70
  71                 init_completion(&timeriomem_rng_data->completion);
  72                 add_timer(&timeriomem_rng_timer);
  73         }
  74
  75         return 4;
  76 }
  77
  78 static void timeriomem_rng_trigger(unsigned long dummy)
  79 {
  80         timeriomem_rng_data->present = 1;
  81         complete(&timeriomem_rng_data->completion);
  82 }
  83
  84 static struct hwrng timeriomem_rng_ops = {
  85         .name           = "timeriomem",
  86         .data_present   = timeriomem_rng_data_present,
  87         .data_read      = timeriomem_rng_data_read,
  88         .priv           = 0,
  89 };
  90
  91 static int __init timeriomem_rng_probe(struct platform_device *pdev)
  92 {
  93         struct resource *res, *mem;
  94         int ret;
  95
  96         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  97
  98         if (!res)
  99                 return -ENOENT;
 100
 101         mem = request_mem_region(res->start, res->end - res->start + 1,
 102                                  pdev->name);
 103         if (mem == NULL)
 104                 return -EBUSY;
 105
 106         dev_set_drvdata(&pdev->dev, mem);
 107
 108         timeriomem_rng_data = pdev->dev.platform_data;
 109
 110         timeriomem_rng_data->address = ioremap(res->start,
 111                                                 res->end - res->start + 1);
 112         if (!timeriomem_rng_data->address) {
 113                 ret = -ENOMEM;
 114                 goto err_ioremap;
 115         }
 116
 117         if (timeriomem_rng_data->period != 0
 118                 && usecs_to_jiffies(timeriomem_rng_data->period) > 0) {
 119                 timeriomem_rng_timer.expires = jiffies;
 120
 121                 timeriomem_rng_ops.priv = usecs_to_jiffies(
 122                                                 timeriomem_rng_data->period);
 123         }
 124         timeriomem_rng_data->present = 1;
 125
 126         ret = hwrng_register(&timeriomem_rng_ops);
 127         if (ret)
 128                 goto err_register;
 129
 130         dev_info(&pdev->dev, "32bits from 0x%p @ %dus\n",
 131                         timeriomem_rng_data->address,
 132                         timeriomem_rng_data->period);
 133
 134         return 0;
 135
 136 err_register:
 137         dev_err(&pdev->dev, "problem registering\n");
 138         iounmap(timeriomem_rng_data->address);
 139 err_ioremap:
 140         release_resource(mem);
 141
 142         return ret;
 143 }
 144
 145 static int __devexit timeriomem_rng_remove(struct platform_device *pdev)
 146 {
 147         struct resource *mem = dev_get_drvdata(&pdev->dev);
 148
 149         del_timer_sync(&timeriomem_rng_timer);
 150         hwrng_unregister(&timeriomem_rng_ops);
 151
 152         iounmap(timeriomem_rng_data->address);
 153         release_resource(mem);
 154
 155         return 0;
 156 }
 157
 158 static struct platform_driver timeriomem_rng_driver = {
 159         .driver = {
 160                 .name           = "timeriomem_rng",
 161                 .owner          = THIS_MODULE,
 162         },
 163         .probe          = timeriomem_rng_probe,
 164         .remove         = __devexit_p(timeriomem_rng_remove),
 165 };
 166
 167 static int __init timeriomem_rng_init(void)
 168 {
 169         return platform_driver_register(&timeriomem_rng_driver);
 170 }
 171
 172 static void __exit timeriomem_rng_exit(void)
 173 {
 174         platform_driver_unregister(&timeriomem_rng_driver);
 175 }
 176
 177 module_init(timeriomem_rng_init);
 178 module_exit(timeriomem_rng_exit);
 179
 180 MODULE_LICENSE("GPL");
 181 MODULE_AUTHOR("Alexander Clouter <alex@digriz.org.uk>");
 182 MODULE_DESCRIPTION("Timer IOMEM H/W RNG driver");