Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit df28472a authored by Tarun Kanti DebBarma's avatar Tarun Kanti DebBarma Committed by Tony Lindgren
Browse files

ARM: OMAP: dmtimer: platform driver 



Add dmtimer platform driver functions which include:
(1) platform driver initialization
(2) driver probe function
(3) driver remove function

Signed-off-by: default avatarTarun Kanti DebBarma <tarun.kanti@ti.com>
Signed-off-by: default avatarThara Gopinath <thara@ti.com>
Reviewed-by: default avatarSantosh Shilimkar <santosh.shilimkar@ti.com>
Acked-by: default avatarCousson, Benoit <b-cousson@ti.com>
Signed-off-by: default avatarTony Lindgren <tony@atomide.com>
parent c345c8b0

arch/arm/plat-omap/dmtimer.c

+133 −6
Original line number Diff line number Diff line
@@ -35,14 +35,9 @@ 
 * 675 Mass Ave, Cambridge, MA 02139, USA.

 */



#include <linux/init.h>

#include <linux/spinlock.h>

#include <linux/errno.h>

#include <linux/list.h>

#include <linux/clk.h>

#include <linux/delay.h>

#include <linux/io.h>

#include <linux/module.h>

#include <linux/slab.h>

#include <mach/hardware.h>

#include <plat/dmtimer.h>

#include <mach/irqs.h>
@@ -149,6 +144,7 @@ static const char **dm_source_names; 
static struct clk **dm_source_clocks;



static spinlock_t dm_timer_lock;

static LIST_HEAD(omap_timer_list);



/*

 * Reads timer registers in posted and non-posted mode. The posted mode bit
@@ -549,6 +545,137 @@ 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;



	if (!pdata) {

		dev_err(&pdev->dev, "%s: no platform data.\n", __func__);

		return -ENODEV;

	}



	irq = platform_get_resource(pdev, IORESOURCE_IRQ, 0);

	if (unlikely(!irq)) {

		dev_err(&pdev->dev, "%s: no IRQ resource.\n", __func__);

		return -ENODEV;

	}



	mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);

	if (unlikely(!mem)) {

		dev_err(&pdev->dev, "%s: no memory resource.\n", __func__);

		return -ENODEV;

	}



	ioarea = request_mem_region(mem->start, resource_size(mem),

			pdev->name);

	if (!ioarea) {

		dev_err(&pdev->dev, "%s: region already claimed.\n", __func__);

		return -EBUSY;

	}



	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_free_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->id = pdev->id;

	timer->irq = irq->start;

	timer->pdev = pdev;

	__omap_dm_timer_init_regs(timer);



	/* 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, "Device Probed.\n");



	return 0;



err_free_mem:

	kfree(timer);



err_free_ioregion:

	release_mem_region(mem->start, resource_size(mem));



	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;

	unsigned long flags;

	int ret = -EINVAL;



	spin_lock_irqsave(&dm_timer_lock, flags);

	list_for_each_entry(timer, &omap_timer_list, node)

		if (timer->pdev->id == pdev->id) {

			list_del(&timer->node);

			kfree(timer);

			ret = 0;

			break;

		}

	spin_unlock_irqrestore(&dm_timer_lock, flags);



	return ret;

}



static struct platform_driver omap_dm_timer_driver = {

	.probe  = omap_dm_timer_probe,

	.remove = omap_dm_timer_remove,

	.driver = {

		.name   = "omap_timer",

	},

};



static int __init omap_dm_timer_driver_init(void)

{

	return platform_driver_register(&omap_dm_timer_driver);

}



static void __exit omap_dm_timer_driver_exit(void)

{

	platform_driver_unregister(&omap_dm_timer_driver);

}



early_platform_init("earlytimer", &omap_dm_timer_driver);

module_init(omap_dm_timer_driver_init);

module_exit(omap_dm_timer_driver_exit);



MODULE_DESCRIPTION("OMAP Dual-Mode Timer Driver");

MODULE_LICENSE("GPL");

MODULE_ALIAS("platform:" DRIVER_NAME);

MODULE_AUTHOR("Texas Instruments Inc");



static int __init omap_dm_timer_init(void)

{

	struct omap_dm_timer *timer;

arch/arm/plat-omap/include/plat/dmtimer.h

+2 −0
Original line number Diff line number Diff line
@@ -229,6 +229,7 @@ int omap_dm_timers_active(void); 


struct omap_dm_timer {

	unsigned long phys_base;

	int id;

	int irq;

#ifdef CONFIG_ARCH_OMAP2PLUS

	struct clk *iclk, *fclk;
@@ -246,6 +247,7 @@ struct omap_dm_timer { 
	unsigned enabled:1;

	unsigned posted:1;

	struct platform_device *pdev;

	struct list_head node;

};



extern u32 sys_timer_reserved;