259 lines
6.4 KiB
C
259 lines
6.4 KiB
C
|
// SPDX-License-Identifier: GPL-2.0
|
||
|
/*
|
||
|
* Sensirion SPS30 particulate matter sensor i2c driver
|
||
|
*
|
||
|
* Copyright (c) 2020 Tomasz Duszynski <tomasz.duszynski@octakon.com>
|
||
|
*
|
||
|
* I2C slave address: 0x69
|
||
|
*/
|
||
|
#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
|
||
|
/* max number of bytes needed to store PM measurements or serial string */
|
||
|
#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;
|
||
|
|
||
|
/*
|
||
|
* Sensor does not support repeated start so instead of
|
||
|
* sending two i2c messages in a row we just send one by one.
|
||
|
*/
|
||
|
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)
|
||
|
{
|
||
|
/*
|
||
|
* Internally sensor stores measurements in a following manner:
|
||
|
*
|
||
|
* PM1: upper two bytes, crc8, lower two bytes, crc8
|
||
|
* PM2P5: upper two bytes, crc8, lower two bytes, crc8
|
||
|
* PM4: upper two bytes, crc8, lower two bytes, crc8
|
||
|
* PM10: upper two bytes, crc8, lower two bytes, crc8
|
||
|
*
|
||
|
* What follows next are number concentration measurements and
|
||
|
* typical particle size measurement which we omit.
|
||
|
*/
|
||
|
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) {
|
||
|
/* each two bytes are followed by a crc8 */
|
||
|
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;
|
||
|
|
||
|
/* validate received data and strip off crc bytes */
|
||
|
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)
|
||
|
{
|
||
|
/* request BE IEEE754 formatted data */
|
||
|
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);
|
||
|
/*
|
||
|
* Power-on-reset causes sensor to produce some glitch on i2c bus and
|
||
|
* some controllers end up in error state. Recover simply by placing
|
||
|
* some data on the bus, for example STOP_MEAS command, which
|
||
|
* is NOP in this case.
|
||
|
*/
|
||
|
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)
|
||
|
{
|
||
|
/* measurements are ready within a second */
|
||
|
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)
|
||
|
{
|
||
|
/* extra nul just in case */
|
||
|
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_new = 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");
|