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

Commit e475eedb authored by Magnus Damm's avatar Magnus Damm Committed by Paul Mundt
Browse files

clocksource: sh_cmt earlytimer support 



Add Early Platform Driver support to the sh_cmt driver
using the earlytimer class.

Signed-off-by: default avatarMagnus Damm <damm@igel.co.jp>
Signed-off-by: default avatarPaul Mundt <lethal@linux-sh.org>
parent aefe6475

drivers/clocksource/sh_cmt.c

+16 −2
Original line number Diff line number Diff line
@@ -566,9 +566,19 @@ static int sh_cmt_setup(struct sh_cmt_priv *p, struct platform_device *pdev) 
static int __devinit sh_cmt_probe(struct platform_device *pdev)

{

	struct sh_cmt_priv *p = platform_get_drvdata(pdev);

	struct sh_cmt_config *cfg = pdev->dev.platform_data;

	int ret;



	if (p) {

		pr_info("sh_cmt: %s kept as earlytimer\n", cfg->name);

		return 0;

	}



	if (is_early_platform_device(pdev))

		p = alloc_bootmem(sizeof(*p));

	else

		p = kmalloc(sizeof(*p), GFP_KERNEL);



	if (p == NULL) {

		dev_err(&pdev->dev, "failed to allocate driver data\n");

		return -ENOMEM;
@@ -576,6 +586,9 @@ static int __devinit sh_cmt_probe(struct platform_device *pdev) 


	ret = sh_cmt_setup(p, pdev);

	if (ret) {

		if (is_early_platform_device(pdev))

			free_bootmem(__pa(p), sizeof(*p));

		else

			kfree(p);



		platform_set_drvdata(pdev, NULL);
@@ -606,6 +619,7 @@ static void __exit sh_cmt_exit(void) 
	platform_driver_unregister(&sh_cmt_device_driver);

}



early_platform_init("earlytimer", &sh_cmt_device_driver);

module_init(sh_cmt_init);

module_exit(sh_cmt_exit);