116 lines
		
	
	
	
		
			2.4 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
		
		
			
		
	
	
			116 lines
		
	
	
	
		
			2.4 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
|   | /*
 | ||
|  |  * SPI access for Dialog DA9052 PMICs. | ||
|  |  * | ||
|  |  * Copyright(c) 2011 Dialog Semiconductor Ltd. | ||
|  |  * | ||
|  |  * Author: David Dajun Chen <dchen@diasemi.com> | ||
|  |  * | ||
|  |  * This program is free software; you can redistribute it and/or modify | ||
|  |  * it under the terms of the GNU General Public License as published by | ||
|  |  * the Free Software Foundation; either version 2 of the License, or | ||
|  |  * (at your option) any later version. | ||
|  |  * | ||
|  |  */ | ||
|  | 
 | ||
|  | #include <linux/device.h>
 | ||
|  | #include <linux/module.h>
 | ||
|  | #include <linux/input.h>
 | ||
|  | #include <linux/mfd/core.h>
 | ||
|  | #include <linux/spi/spi.h>
 | ||
|  | #include <linux/err.h>
 | ||
|  | 
 | ||
|  | #include <linux/mfd/da9052/da9052.h>
 | ||
|  | 
 | ||
|  | static int da9052_spi_probe(struct spi_device *spi) | ||
|  | { | ||
|  | 	int ret; | ||
|  | 	const struct spi_device_id *id = spi_get_device_id(spi); | ||
|  | 	struct da9052 *da9052 = kzalloc(sizeof(struct da9052), GFP_KERNEL); | ||
|  | 
 | ||
|  | 	if (!da9052) | ||
|  | 		return -ENOMEM; | ||
|  | 
 | ||
|  | 	spi->mode = SPI_MODE_0 | SPI_CPOL; | ||
|  | 	spi->bits_per_word = 8; | ||
|  | 	spi_setup(spi); | ||
|  | 
 | ||
|  | 	da9052->dev = &spi->dev; | ||
|  | 	da9052->chip_irq = spi->irq; | ||
|  | 
 | ||
|  | 	dev_set_drvdata(&spi->dev, da9052); | ||
|  | 
 | ||
|  | 	da9052_regmap_config.read_flag_mask = 1; | ||
|  | 	da9052_regmap_config.write_flag_mask = 0; | ||
|  | 
 | ||
|  | 	da9052->regmap = regmap_init_spi(spi, &da9052_regmap_config); | ||
|  | 	if (IS_ERR(da9052->regmap)) { | ||
|  | 		ret = PTR_ERR(da9052->regmap); | ||
|  | 		dev_err(&spi->dev, "Failed to allocate register map: %d\n", | ||
|  | 			ret); | ||
|  | 		goto err; | ||
|  | 	} | ||
|  | 
 | ||
|  | 	ret = da9052_device_init(da9052, id->driver_data); | ||
|  | 	if (ret != 0) | ||
|  | 		goto err; | ||
|  | 
 | ||
|  | 	return 0; | ||
|  | 
 | ||
|  | err: | ||
|  | 	kfree(da9052); | ||
|  | 	return ret; | ||
|  | } | ||
|  | 
 | ||
|  | static int da9052_spi_remove(struct spi_device *spi) | ||
|  | { | ||
|  | 	struct da9052 *da9052 = dev_get_drvdata(&spi->dev); | ||
|  | 
 | ||
|  | 	da9052_device_exit(da9052); | ||
|  | 	kfree(da9052); | ||
|  | 
 | ||
|  | 	return 0; | ||
|  | } | ||
|  | 
 | ||
|  | static struct spi_device_id da9052_spi_id[] = { | ||
|  | 	{"da9052", DA9052}, | ||
|  | 	{"da9053-aa", DA9053_AA}, | ||
|  | 	{"da9053-ba", DA9053_BA}, | ||
|  | 	{"da9053-bb", DA9053_BB}, | ||
|  | 	{} | ||
|  | }; | ||
|  | 
 | ||
|  | static struct spi_driver da9052_spi_driver = { | ||
|  | 	.probe = da9052_spi_probe, | ||
|  | 	.remove = __devexit_p(da9052_spi_remove), | ||
|  | 	.id_table = da9052_spi_id, | ||
|  | 	.driver = { | ||
|  | 		.name = "da9052", | ||
|  | 		.bus = &spi_bus_type, | ||
|  | 		.owner = THIS_MODULE, | ||
|  | 	}, | ||
|  | }; | ||
|  | 
 | ||
|  | static int __init da9052_spi_init(void) | ||
|  | { | ||
|  | 	int ret; | ||
|  | 
 | ||
|  | 	ret = spi_register_driver(&da9052_spi_driver); | ||
|  | 	if (ret != 0) { | ||
|  | 		pr_err("Failed to register DA9052 SPI driver, %d\n", ret); | ||
|  | 		return ret; | ||
|  | 	} | ||
|  | 
 | ||
|  | 	return 0; | ||
|  | } | ||
|  | subsys_initcall(da9052_spi_init); | ||
|  | 
 | ||
|  | static void __exit da9052_spi_exit(void) | ||
|  | { | ||
|  | 	spi_unregister_driver(&da9052_spi_driver); | ||
|  | } | ||
|  | module_exit(da9052_spi_exit); | ||
|  | 
 | ||
|  | MODULE_AUTHOR("David Dajun Chen <dchen@diasemi.com>"); | ||
|  | MODULE_DESCRIPTION("SPI driver for Dialog DA9052 PMIC"); | ||
|  | MODULE_LICENSE("GPL"); |