On Tue, Dec 07, 2010 at 05:14:16AM +0530, Tarun Kanti DebBarma wrote:
> From: Thara Gopinath <th...@ti.com>
>
> Add dmtimer platform driver functions which include:
> (1) platform driver initialization
> (2) driver probe function
> (3) driver remove function
>
> Signed-off-by: Tarun Kanti DebBarma <tarun.ka...@ti.com>
> Signed-off-by: Thara Gopinath <th...@ti.com>
> Reviewed-by: Cousson, Benoit <b-cous...@ti.com>
> Reviewed-by: Varadarajan, Charulatha <ch...@ti.com>
> ---
> arch/arm/plat-omap/dmtimer.c | 156
> +++++++++++++++++++++++++++++++++++++++++-
> 1 files changed, 154 insertions(+), 2 deletions(-)
>
> diff --git a/arch/arm/plat-omap/dmtimer.c b/arch/arm/plat-omap/dmtimer.c
> index 9bf6ac8..ddc875b 100644
> --- a/arch/arm/plat-omap/dmtimer.c
> +++ b/arch/arm/plat-omap/dmtimer.c
> @@ -43,6 +43,8 @@
> #include <linux/delay.h>
> #include <linux/io.h>
> #include <linux/module.h>
> +#include <linux/slab.h>
> +#include <linux/err.h>
> #include <mach/hardware.h>
not required. You can cleanup
> #include <plat/dmtimer.h>
> #include <mach/irqs.h>
not required. You can cleanup
> @@ -167,6 +169,7 @@ struct omap_dm_timer {
> unsigned enabled:1;
> unsigned posted:1;
> struct platform_device *pdev;
> + struct list_head node;
> };
>
> static int dm_timer_count;
> @@ -270,7 +273,8 @@ static struct omap_dm_timer *dm_timers;
> static const char **dm_source_names;
> static struct clk **dm_source_clocks;
>
> -static spinlock_t dm_timer_lock;
> +static LIST_HEAD(omap_timer_list);
> +static DEFINE_SPINLOCK(dm_timer_lock);
>
> /*
> * Reads timer registers in posted and non-posted mode. The posted mode bit
> @@ -702,6 +706,155 @@ int omap_dm_timers_active(void)
> }
> EXPORT_SYMBOL_GPL(omap_dm_timers_active);
>
> +/**
> + * omap_dm_timer_probe - probe function called for every registered device
> + * @pdev: pointer to current timer platform device
> + *
> + * Called by driver framework at the end of device registration for all
> + * timer devices.
> + */
> +static int __devinit omap_dm_timer_probe(struct platform_device *pdev)
> +{
> + int ret;
> + unsigned long flags;
> + struct omap_dm_timer *timer;
> + struct resource *mem, *irq, *ioarea;
> + struct dmtimer_platform_data *pdata = pdev->dev.platform_data;
> +
> + dev_dbg(&pdev->dev, "%s: +\n", __func__);
> +
> + if (!pdata) {
> + dev_err(&pdev->dev, "%s: no platform data\n", __func__);
> + return -ENODEV;
> + }
> +
> + spin_lock_irqsave(&dm_timer_lock, flags);
> + list_for_each_entry(timer, &omap_timer_list, node)
> + if (timer->pdev->id == pdev->id) {
> + timer->pdev = pdev;
> + spin_unlock_irqrestore(&dm_timer_lock, flags);
> + return 0;
> + }
> + spin_unlock_irqrestore(&dm_timer_lock, flags);
> +
> + irq = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
> + if (unlikely(!irq)) {
> + dev_err(&pdev->dev, "%s: no IRQ resource\n", __func__);
> + ret = -ENODEV;
> + goto err_free_pdev;
> + }
> +
> + mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
> + if (unlikely(!mem)) {
> + dev_err(&pdev->dev, "%s: no memory resource\n", __func__);
> + ret = -ENODEV;
> + goto err_free_pdev;
> + }
> +
> + ioarea = request_mem_region(mem->start, resource_size(mem),
> + pdev->name);
> + if (!ioarea) {
> + dev_err(&pdev->dev, "%s: region already claimed\n", __func__);
> + ret = -EBUSY;
> + goto err_free_pdev;
> + }
> +
> + timer = kzalloc(sizeof(struct omap_dm_timer), GFP_KERNEL);
> + if (!timer) {
> + dev_err(&pdev->dev, "%s: no memory for omap_dm_timer\n",
> + __func__);
> + ret = -ENOMEM;
> + goto err_release_ioregion;
> + }
> +
> + timer->io_base = ioremap(mem->start, resource_size(mem));
> + if (!timer->io_base) {
> + dev_err(&pdev->dev, "%s: ioremap failed\n", __func__);
> + ret = -ENOMEM;
> + goto err_free_mem;
> + }
> +
> + timer->irq = irq->start;
> + timer->pdev = pdev;
> + timer->reserved = 0;
> +
> + /* add the timer element to the list */
> + spin_lock_irqsave(&dm_timer_lock, flags);
> + list_add_tail(&timer->node, &omap_timer_list);
> + spin_unlock_irqrestore(&dm_timer_lock, flags);
> +
> + dev_dbg(&pdev->dev, " bound to its driver\n");
> +
> + return 0;
> +
> +err_free_mem:
> + kfree(timer);
> +
> +err_release_ioregion:
> + release_mem_region(mem->start, resource_size(mem));
> +
> +err_free_pdev:
You can also free pdata?
> + platform_device_del(pdev);
> +
> + return ret;
> +}
> +
> +/**
> + * omap_dm_timer_remove - cleanup a registered timer device
> + * @pdev: pointer to current timer platform device
> + *
> + * Called by driver framework whenever a timer device is unregistered.
> + * In addition to freeing platform resources it also deletes the timer
> + * entry from the local list.
> + */
> +static int __devexit omap_dm_timer_remove(struct platform_device *pdev)
> +{
> + struct omap_dm_timer *timer, *tmp;
> + unsigned long flags;
> + int ret = -EINVAL;
> +
> + spin_lock_irqsave(&dm_timer_lock, flags);
> + list_for_each_entry_safe(timer, tmp, &omap_timer_list, node) {
> + if (timer->pdev->id == pdev->id) {
> + platform_device_del(timer->pdev);
> + list_del(&timer->node);
> + kfree(timer);
kfree(pdev->dev.platform_data);
-Manjunath
--
To unsubscribe from this list: send the line "unsubscribe linux-omap" in
the body of a message to majord...@vger.kernel.org
More majordomo info at http://vger.kernel.org/majordomo-info.html
