Greg Kroah-Hartman
598cf27219
Link: https://lore.kernel.org/r/20260217200002.683975158@linuxfoundation.org Tested-by: Florian Fainelli <florian.fainelli@broadcom.com> Tested-by: Takeshi Ogasawara <takeshi.ogasawara@futuring-girl.com> Tested-by: Peter Schneider <pschneider1968@googlemail.com> Tested-by: Jon Hunter <jonathanh@nvidia.com> Tested-by: Salvatore Bonaccorso <carnil@debian.org> Tested-by: Brett A C Sheffield <bacs@librecast.net> Tested-by: Mark Brown <broonie@kernel.org> Tested-by: Luna Jernberg <droidbittin@gmail.com> Tested-by: Ronald Warsow <rwarsow@gmx.de> Tested-by: Justin M. Forbes <jforbes@fedoraproject.org> Tested-by: Ron Economos <re@w6rz.net> Tested-by: Miguel Ojeda <ojeda@kernel.org> Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
134 lines
3.6 KiB
C
134 lines
3.6 KiB
C
// SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0
|
|
/*
|
|
* Copyright (c) 2025 Robert Bosch GmbH.
|
|
*/
|
|
#include <linux/i2c.h>
|
|
#include <linux/mod_devicetable.h>
|
|
#include <linux/module.h>
|
|
#include <linux/regmap.h>
|
|
|
|
#include "smi330.h"
|
|
|
|
#define SMI330_NUM_DUMMY_BYTES 2
|
|
#define SMI330_I2C_MAX_RX_BUFFER_SIZE \
|
|
(SMI330_NUM_DUMMY_BYTES + SMI330_SCAN_LEN * sizeof(s16))
|
|
|
|
struct smi330_i2c_priv {
|
|
struct i2c_client *i2c;
|
|
u8 rx_buffer[SMI330_I2C_MAX_RX_BUFFER_SIZE];
|
|
};
|
|
|
|
static int smi330_regmap_i2c_read(void *context, const void *reg_buf,
|
|
size_t reg_size, void *val_buf,
|
|
size_t val_size)
|
|
{
|
|
struct smi330_i2c_priv *priv = context;
|
|
int ret;
|
|
|
|
if (SMI330_NUM_DUMMY_BYTES + val_size > SMI330_I2C_MAX_RX_BUFFER_SIZE)
|
|
return -EINVAL;
|
|
|
|
/*
|
|
* SMI330 I2C read frame:
|
|
* <Slave address[6:0], RnW> <x, Register address[6:0]>
|
|
* <Slave address[6:0], RnW> <Dummy[7:0]> <Dummy[7:0]> <Data_0[7:0]> <Data_1[15:8]>...
|
|
* <Data_N[7:0]> <Data_N[15:8]>
|
|
* Remark: Slave address is not considered part of the frame in the following definitions
|
|
*/
|
|
struct i2c_msg msgs[] = {
|
|
{
|
|
.addr = priv->i2c->addr,
|
|
.flags = priv->i2c->flags,
|
|
.len = reg_size,
|
|
.buf = (u8 *)reg_buf,
|
|
},
|
|
{
|
|
.addr = priv->i2c->addr,
|
|
.flags = priv->i2c->flags | I2C_M_RD,
|
|
.len = SMI330_NUM_DUMMY_BYTES + val_size,
|
|
.buf = priv->rx_buffer,
|
|
},
|
|
};
|
|
|
|
ret = i2c_transfer(priv->i2c->adapter, msgs, ARRAY_SIZE(msgs));
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
memcpy(val_buf, priv->rx_buffer + SMI330_NUM_DUMMY_BYTES, val_size);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int smi330_regmap_i2c_write(void *context, const void *data,
|
|
size_t count)
|
|
{
|
|
struct smi330_i2c_priv *priv = context;
|
|
u8 reg;
|
|
|
|
/*
|
|
* SMI330 I2C write frame:
|
|
* <Slave address[6:0], RnW> <x, Register address[6:0]> <Data_0[7:0]> <Data_1[15:8]>...
|
|
* <Data_N[7:0]> <Data_N[15:8]>
|
|
* Remark: Slave address is not considered part of the frame in the following definitions
|
|
*/
|
|
reg = *(u8 *)data;
|
|
return i2c_smbus_write_i2c_block_data(priv->i2c, reg,
|
|
count - sizeof(u8),
|
|
data + sizeof(u8));
|
|
}
|
|
|
|
static const struct regmap_bus smi330_regmap_bus = {
|
|
.read = smi330_regmap_i2c_read,
|
|
.write = smi330_regmap_i2c_write,
|
|
};
|
|
|
|
static int smi330_i2c_probe(struct i2c_client *i2c)
|
|
{
|
|
struct device *dev = &i2c->dev;
|
|
struct smi330_i2c_priv *priv;
|
|
struct regmap *regmap;
|
|
|
|
priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
|
|
if (!priv)
|
|
return -ENOMEM;
|
|
|
|
priv->i2c = i2c;
|
|
regmap = devm_regmap_init(dev, &smi330_regmap_bus, priv,
|
|
&smi330_regmap_config);
|
|
if (IS_ERR(regmap))
|
|
return dev_err_probe(dev, PTR_ERR(regmap),
|
|
"Failed to initialize I2C Regmap\n");
|
|
|
|
return smi330_core_probe(dev, regmap);
|
|
}
|
|
|
|
static const struct i2c_device_id smi330_i2c_device_id[] = {
|
|
{ .name = "smi330" },
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(i2c, smi330_i2c_device_id);
|
|
|
|
static const struct of_device_id smi330_of_match[] = {
|
|
{ .compatible = "bosch,smi330" },
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(of, smi330_of_match);
|
|
|
|
static struct i2c_driver smi330_i2c_driver = {
|
|
.probe = smi330_i2c_probe,
|
|
.id_table = smi330_i2c_device_id,
|
|
.driver = {
|
|
.of_match_table = smi330_of_match,
|
|
.name = "smi330_i2c",
|
|
},
|
|
};
|
|
module_i2c_driver(smi330_i2c_driver);
|
|
|
|
MODULE_AUTHOR("Stefan Gutmann <stefan.gutmann@de.bosch.com>");
|
|
MODULE_AUTHOR("Roman Huber <roman.huber@de.bosch.com>");
|
|
MODULE_AUTHOR("Filip Andrei <Andrei.Filip@ro.bosch.com>");
|
|
MODULE_AUTHOR("Drimbarean Avram Andrei <Avram-Andrei.Drimbarean@ro.bosch.com>");
|
|
MODULE_DESCRIPTION("Bosch SMI330 I2C driver");
|
|
MODULE_LICENSE("Dual BSD/GPL");
|
|
MODULE_IMPORT_NS("IIO_SMI330");
|