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

Commit 72b4379e authored by Alan Cox's avatar Alan Cox Committed by Linus Torvalds
Browse files

langwell_gpio: add support for whitney point 



In this case the logic is very similar but the IRQs are not exposed and
the device is not picked up via PCI

Based on a separate internal whitney point driver by Yin Kangkai.

Signed-off-by: default avatarAlan Cox <alan@linux.intel.com>
Cc: Yin Kangkai <kangkai.yin@intel.com>
Cc: Alek Du <alek.du@intel.com>
Signed-off-by: default avatarAndrew Morton <akpm@linux-foundation.org>
Signed-off-by: default avatarLinus Torvalds <torvalds@linux-foundation.org>
parent fd0574cb

drivers/gpio/langwell_gpio.c

+82 −1
Original line number Original line Diff line number Diff line
@@ -18,10 +18,12 @@ 
/* Supports:

/* Supports:

 * Moorestown platform Langwell chip.

 * Moorestown platform Langwell chip.

 * Medfield platform Penwell chip.

 * Medfield platform Penwell chip.

 * Whitney point.

 */

 */





#include <linux/module.h>

#include <linux/module.h>

#include <linux/pci.h>

#include <linux/pci.h>

#include <linux/platform_device.h>

#include <linux/kernel.h>

#include <linux/kernel.h>

#include <linux/delay.h>

#include <linux/delay.h>

#include <linux/stddef.h>

#include <linux/stddef.h>
@@ -300,9 +302,88 @@ static struct pci_driver lnw_gpio_driver = { 
	.probe		= lnw_gpio_probe,

	.probe		= lnw_gpio_probe,

};

};







static int __devinit wp_gpio_probe(struct platform_device *pdev)

{

	struct lnw_gpio *lnw;

	struct gpio_chip *gc;

	struct resource *rc;

	int retval = 0;



	rc = platform_get_resource(pdev, IORESOURCE_MEM, 0);

	if (!rc)

		return -EINVAL;



	lnw = kzalloc(sizeof(struct lnw_gpio), GFP_KERNEL);

	if (!lnw) {

		dev_err(&pdev->dev,

			"can't allocate whitneypoint_gpio chip data\n");

		return -ENOMEM;

	}

	lnw->reg_base = ioremap_nocache(rc->start, resource_size(rc));

	if (lnw->reg_base == NULL) {

		retval = -EINVAL;

		goto err_kmalloc;

	}

	spin_lock_init(&lnw->lock);

	gc = &lnw->chip;

	gc->label = dev_name(&pdev->dev);

	gc->owner = THIS_MODULE;

	gc->direction_input = lnw_gpio_direction_input;

	gc->direction_output = lnw_gpio_direction_output;

	gc->get = lnw_gpio_get;

	gc->set = lnw_gpio_set;

	gc->to_irq = NULL;

	gc->base = 0;

	gc->ngpio = 64;

	gc->can_sleep = 0;

	retval = gpiochip_add(gc);

	if (retval) {

		dev_err(&pdev->dev, "whitneypoint gpiochip_add error %d\n",

								retval);

		goto err_ioremap;

	}

	platform_set_drvdata(pdev, lnw);

	return 0;

err_ioremap:

	iounmap(lnw->reg_base);

err_kmalloc:

	kfree(lnw);

	return retval;

}



static int __devexit wp_gpio_remove(struct platform_device *pdev)

{

	struct lnw_gpio *lnw = platform_get_drvdata(pdev);

	int err;

	err = gpiochip_remove(&lnw->chip);

	if (err)

		dev_err(&pdev->dev, "failed to remove gpio_chip.\n");

	iounmap(lnw->reg_base);

	kfree(lnw);

	platform_set_drvdata(pdev, NULL);

	return 0;

}



static struct platform_driver wp_gpio_driver = {

	.probe		= wp_gpio_probe,

	.remove		= __devexit_p(wp_gpio_remove),

	.driver		= {

		.name	= "wp_gpio",

		.owner	= THIS_MODULE,

	},

};



static int __init lnw_gpio_init(void)

static int __init lnw_gpio_init(void)

{

{

	return pci_register_driver(&lnw_gpio_driver);

	int ret;

	ret =  pci_register_driver(&lnw_gpio_driver);

	if (ret < 0)

		return ret;

	ret = platform_driver_register(&wp_gpio_driver);

	if (ret < 0)

		pci_unregister_driver(&lnw_gpio_driver);

	return ret;

}

}





device_initcall(lnw_gpio_init);
 
device_initcall(lnw_gpio_init);