#include <asm/unaligned.h>
#include <linux/crc8.h>
#include <linux/delay.h>
#include <linux/device.h>
#include <linux/errno.h>
#include <linux/i2c.h>
#include <linux/mod_devicetable.h>
#include <linux/module.h>
#include <linux/types.h>
#include "sps30.h"
#define SPS30_I2C_CRC8_POLYNOMIAL 0x31
#define SPS30_I2C_MAX_BUF_SIZE 48
DECLARE_CRC8_TABLE(sps30_i2c_crc8_table);
#define SPS30_I2C_START_MEAS 0x0010
#define SPS30_I2C_STOP_MEAS 0x0104
#define SPS30_I2C_READ_MEAS 0x0300
#define SPS30_I2C_MEAS_READY 0x0202
#define SPS30_I2C_RESET 0xd304
#define SPS30_I2C_CLEAN_FAN 0x5607
#define SPS30_I2C_PERIOD 0x8004
#define SPS30_I2C_READ_SERIAL 0xd033
#define SPS30_I2C_READ_VERSION 0xd100
static int sps30_i2c_xfer(struct sps30_state *state, unsigned char *txbuf, size_t txsize,
unsigned char *rxbuf, size_t rxsize)
{
struct i2c_client *client = to_i2c_client(state->dev);
int ret;
ret = i2c_master_send(client, txbuf, txsize);
if (ret < 0)
return ret;
if (ret != txsize)
return -EIO;
if (!rxsize)
return 0;
ret = i2c_master_recv(client, rxbuf, rxsize);
if (ret < 0)
return ret;
if (ret != rxsize)
return -EIO;
return 0;
}
static int sps30_i2c_command(struct sps30_state *state, u16 cmd, void *arg, size_t arg_size,
void *rsp, size_t rsp_size)
{
unsigned char buf[SPS30_I2C_MAX_BUF_SIZE];
unsigned char *tmp;
unsigned char crc;
size_t i;
int ret;
put_unaligned_be16(cmd, buf);
i = 2;
if (rsp) {
rsp_size += rsp_size / 2;
} else {
tmp = arg;
while (arg_size) {
buf[i] = *tmp++;
buf[i + 1] = *tmp++;
buf[i + 2] = crc8(sps30_i2c_crc8_table, buf + i, 2, CRC8_INIT_VALUE);
arg_size -= 2;
i += 3;
}
}
ret = sps30_i2c_xfer(state, buf, i, buf, rsp_size);
if (ret)
return ret;
tmp = rsp;
for (i = 0; i < rsp_size; i += 3) {
crc = crc8(sps30_i2c_crc8_table, buf + i, 2, CRC8_INIT_VALUE);
if (crc != buf[i + 2]) {
dev_err(state->dev, "data integrity check failed\n");
return -EIO;
}
*tmp++ = buf[i];
*tmp++ = buf[i + 1];
}
return 0;
}
static int sps30_i2c_start_meas(struct sps30_state *state)
{
unsigned char buf[] = { 0x03, 0x00 };
return sps30_i2c_command(state, SPS30_I2C_START_MEAS, buf, sizeof(buf), NULL, 0);
}
static int sps30_i2c_stop_meas(struct sps30_state *state)
{
return sps30_i2c_command(state, SPS30_I2C_STOP_MEAS, NULL, 0, NULL, 0);
}
static int sps30_i2c_reset(struct sps30_state *state)
{
int ret;
ret = sps30_i2c_command(state, SPS30_I2C_RESET, NULL, 0, NULL, 0);
msleep(500);
sps30_i2c_stop_meas(state);
return ret;
}
static bool sps30_i2c_meas_ready(struct sps30_state *state)
{
unsigned char buf[2];
int ret;
ret = sps30_i2c_command(state, SPS30_I2C_MEAS_READY, NULL, 0, buf, sizeof(buf));
if (ret)
return false;
return buf[1];
}
static int sps30_i2c_read_meas(struct sps30_state *state, __be32 *meas, size_t num)
{
if (msleep_interruptible(1000))
return -EINTR;
if (!sps30_i2c_meas_ready(state))
return -ETIMEDOUT;
return sps30_i2c_command(state, SPS30_I2C_READ_MEAS, NULL, 0, meas, sizeof(num) * num);
}
static int sps30_i2c_clean_fan(struct sps30_state *state)
{
return sps30_i2c_command(state, SPS30_I2C_CLEAN_FAN, NULL, 0, NULL, 0);
}
static int sps30_i2c_read_cleaning_period(struct sps30_state *state, __be32 *period)
{
return sps30_i2c_command(state, SPS30_I2C_PERIOD, NULL, 0, period, sizeof(*period));
}
static int sps30_i2c_write_cleaning_period(struct sps30_state *state, __be32 period)
{
return sps30_i2c_command(state, SPS30_I2C_PERIOD, &period, sizeof(period), NULL, 0);
}
static int sps30_i2c_show_info(struct sps30_state *state)
{
unsigned char buf[32 + 1] = { 0x00 };
int ret;
ret = sps30_i2c_command(state, SPS30_I2C_READ_SERIAL, NULL, 0, buf, sizeof(buf) - 1);
if (ret)
return ret;
dev_info(state->dev, "serial number: %s\n", buf);
ret = sps30_i2c_command(state, SPS30_I2C_READ_VERSION, NULL, 0, buf, 2);
if (ret)
return ret;
dev_info(state->dev, "fw version: %u.%u\n", buf[0], buf[1]);
return 0;
}
static const struct sps30_ops sps30_i2c_ops = {
.start_meas = sps30_i2c_start_meas,
.stop_meas = sps30_i2c_stop_meas,
.read_meas = sps30_i2c_read_meas,
.reset = sps30_i2c_reset,
.clean_fan = sps30_i2c_clean_fan,
.read_cleaning_period = sps30_i2c_read_cleaning_period,
.write_cleaning_period = sps30_i2c_write_cleaning_period,
.show_info = sps30_i2c_show_info,
};
static int sps30_i2c_probe(struct i2c_client *client)
{
if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C))
return -EOPNOTSUPP;
crc8_populate_msb(sps30_i2c_crc8_table, SPS30_I2C_CRC8_POLYNOMIAL);
return sps30_probe(&client->dev, client->name, NULL, &sps30_i2c_ops);
}
static const struct i2c_device_id sps30_i2c_id[] = {
{ "sps30" },
{ }
};
MODULE_DEVICE_TABLE(i2c, sps30_i2c_id);
static const struct of_device_id sps30_i2c_of_match[] = {
{ .compatible = "sensirion,sps30" },
{ }
};
MODULE_DEVICE_TABLE(of, sps30_i2c_of_match);
static struct i2c_driver sps30_i2c_driver = {
.driver = {
.name = KBUILD_MODNAME,
.of_match_table = sps30_i2c_of_match,
},
.id_table = sps30_i2c_id,
.probe = sps30_i2c_probe,
};
module_i2c_driver(sps30_i2c_driver);
MODULE_AUTHOR("Tomasz Duszynski <tomasz.duszynski@octakon.com>");
MODULE_DESCRIPTION("Sensirion SPS30 particulate matter sensor i2c driver");
MODULE_LICENSE("GPL v2");
MODULE_IMPORT_NS