68 lines
		
	
	
		
			1.4 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			68 lines
		
	
	
		
			1.4 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0
 | |
| #include <linux/device.h>
 | |
| #include <linux/kernel.h>
 | |
| #include <linux/module.h>
 | |
| #include <linux/mod_devicetable.h>
 | |
| #include <linux/slab.h>
 | |
| #include <linux/i2c.h>
 | |
| #include <linux/delay.h>
 | |
| #include <linux/regmap.h>
 | |
| 
 | |
| #include "kxsd9.h"
 | |
| 
 | |
| static int kxsd9_i2c_probe(struct i2c_client *i2c,
 | |
| 			   const struct i2c_device_id *id)
 | |
| {
 | |
| 	static const struct regmap_config config = {
 | |
| 		.reg_bits = 8,
 | |
| 		.val_bits = 8,
 | |
| 		.max_register = 0x0e,
 | |
| 	};
 | |
| 	struct regmap *regmap;
 | |
| 
 | |
| 	regmap = devm_regmap_init_i2c(i2c, &config);
 | |
| 	if (IS_ERR(regmap)) {
 | |
| 		dev_err(&i2c->dev, "Failed to register i2c regmap: %pe\n",
 | |
| 			regmap);
 | |
| 		return PTR_ERR(regmap);
 | |
| 	}
 | |
| 
 | |
| 	return kxsd9_common_probe(&i2c->dev,
 | |
| 				  regmap,
 | |
| 				  i2c->name);
 | |
| }
 | |
| 
 | |
| static int kxsd9_i2c_remove(struct i2c_client *client)
 | |
| {
 | |
| 	kxsd9_common_remove(&client->dev);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static const struct of_device_id kxsd9_of_match[] = {
 | |
| 	{ .compatible = "kionix,kxsd9", },
 | |
| 	{ },
 | |
| };
 | |
| MODULE_DEVICE_TABLE(of, kxsd9_of_match);
 | |
| 
 | |
| static const struct i2c_device_id kxsd9_i2c_id[] = {
 | |
| 	{"kxsd9", 0},
 | |
| 	{ },
 | |
| };
 | |
| MODULE_DEVICE_TABLE(i2c, kxsd9_i2c_id);
 | |
| 
 | |
| static struct i2c_driver kxsd9_i2c_driver = {
 | |
| 	.driver = {
 | |
| 		.name	= "kxsd9",
 | |
| 		.of_match_table = kxsd9_of_match,
 | |
| 		.pm = &kxsd9_dev_pm_ops,
 | |
| 	},
 | |
| 	.probe		= kxsd9_i2c_probe,
 | |
| 	.remove		= kxsd9_i2c_remove,
 | |
| 	.id_table	= kxsd9_i2c_id,
 | |
| };
 | |
| module_i2c_driver(kxsd9_i2c_driver);
 | |
| 
 | |
| MODULE_LICENSE("GPL v2");
 | |
| MODULE_DESCRIPTION("KXSD9 accelerometer I2C interface");
 |