forked from luck/tmp_suning_uos_patched
100 lines
2.8 KiB
C
100 lines
2.8 KiB
C
|
/*
|
||
|
|
* Murata ZPA2326 I2C pressure and temperature sensor driver
|
||
|
|
*
|
||
|
|
* Copyright (c) 2016 Parrot S.A.
|
||
|
|
*
|
||
|
|
* Author: Gregor Boirie <gregor.boirie@parrot.com>
|
||
|
|
*
|
||
|
|
* This program is free software; you can redistribute it and/or modify it
|
||
|
|
* under the terms of the GNU General Public License version 2 as published by
|
||
|
|
* the Free Software Foundation.
|
||
|
|
*
|
||
|
|
* This program is distributed in the hope that it will be useful, but WITHOUT
|
||
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
||
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
||
|
|
* more details.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/module.h>
|
||
|
|
#include <linux/regmap.h>
|
||
|
|
#include <linux/i2c.h>
|
||
|
|
#include <linux/of_device.h>
|
||
|
|
#include "zpa2326.h"
|
||
|
|
|
||
|
|
/*
|
||
|
|
* read_flag_mask:
|
||
|
|
* - address bit 7 must be set to request a register read operation
|
||
|
|
*/
|
||
|
|
static const struct regmap_config zpa2326_regmap_i2c_config = {
|
||
|
|
.reg_bits = 8,
|
||
|
|
.val_bits = 8,
|
||
|
|
.writeable_reg = zpa2326_isreg_writeable,
|
||
|
|
.readable_reg = zpa2326_isreg_readable,
|
||
|
|
.precious_reg = zpa2326_isreg_precious,
|
||
|
|
.max_register = ZPA2326_TEMP_OUT_H_REG,
|
||
|
|
.read_flag_mask = BIT(7),
|
||
|
|
.cache_type = REGCACHE_NONE,
|
||
|
|
};
|
||
|
|
|
||
|
|
static unsigned int zpa2326_i2c_hwid(const struct i2c_client *client)
|
||
|
|
{
|
||
|
|
#define ZPA2326_SA0(_addr) (_addr & BIT(0))
|
||
|
|
#define ZPA2326_DEVICE_ID_SA0_SHIFT (1)
|
||
|
|
|
||
|
|
/* Identification register bit 1 mirrors device address bit 0. */
|
||
|
|
return (ZPA2326_DEVICE_ID |
|
||
|
|
(ZPA2326_SA0(client->addr) << ZPA2326_DEVICE_ID_SA0_SHIFT));
|
||
|
|
}
|
||
|
|
|
||
|
|
static int zpa2326_probe_i2c(struct i2c_client *client,
|
||
|
|
const struct i2c_device_id *i2c_id)
|
||
|
|
{
|
||
|
|
struct regmap *regmap;
|
||
|
|
|
||
|
|
regmap = devm_regmap_init_i2c(client, &zpa2326_regmap_i2c_config);
|
||
|
|
if (IS_ERR(regmap)) {
|
||
|
|
dev_err(&client->dev, "failed to init registers map");
|
||
|
|
return PTR_ERR(regmap);
|
||
|
|
}
|
||
|
|
|
||
|
|
return zpa2326_probe(&client->dev, i2c_id->name, client->irq,
|
||
|
|
zpa2326_i2c_hwid(client), regmap);
|
||
|
|
}
|
||
|
|
|
||
|
|
static int zpa2326_remove_i2c(struct i2c_client *client)
|
||
|
|
{
|
||
|
|
zpa2326_remove(&client->dev);
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static const struct i2c_device_id zpa2326_i2c_ids[] = {
|
||
|
|
{ "zpa2326", 0 },
|
||
|
|
{ },
|
||
|
|
};
|
||
|
|
MODULE_DEVICE_TABLE(i2c, zpa2326_i2c_ids);
|
||
|
|
|
||
|
|
#if defined(CONFIG_OF)
|
||
|
|
static const struct of_device_id zpa2326_i2c_matches[] = {
|
||
|
|
{ .compatible = "murata,zpa2326" },
|
||
|
|
{ }
|
||
|
|
};
|
||
|
|
MODULE_DEVICE_TABLE(of, zpa2326_i2c_matches);
|
||
|
|
#endif
|
||
|
|
|
||
|
|
static struct i2c_driver zpa2326_i2c_driver = {
|
||
|
|
.driver = {
|
||
|
|
.name = "zpa2326-i2c",
|
||
|
|
.of_match_table = of_match_ptr(zpa2326_i2c_matches),
|
||
|
|
.pm = ZPA2326_PM_OPS,
|
||
|
|
},
|
||
|
|
.probe = zpa2326_probe_i2c,
|
||
|
|
.remove = zpa2326_remove_i2c,
|
||
|
|
.id_table = zpa2326_i2c_ids,
|
||
|
|
};
|
||
|
|
module_i2c_driver(zpa2326_i2c_driver);
|
||
|
|
|
||
|
|
MODULE_AUTHOR("Gregor Boirie <gregor.boirie@parrot.com>");
|
||
|
|
MODULE_DESCRIPTION("I2C driver for Murata ZPA2326 pressure sensor");
|
||
|
|
MODULE_LICENSE("GPL v2");
|