Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  * Plantower PMS7003 particulate matter sensor driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  * Copyright (c) Tomasz Duszynski <tduszyns@gmail.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) #include <asm/unaligned.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) #include <linux/completion.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <linux/device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #include <linux/iio/buffer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include <linux/iio/iio.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #include <linux/iio/trigger_consumer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <linux/iio/triggered_buffer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #include <linux/jiffies.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #include <linux/mod_devicetable.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #include <linux/mutex.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) #include <linux/serdev.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) #define PMS7003_DRIVER_NAME "pms7003"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) #define PMS7003_MAGIC 0x424d
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) /* last 2 data bytes hold frame checksum */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) #define PMS7003_MAX_DATA_LENGTH 28
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) #define PMS7003_CHECKSUM_LENGTH 2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) #define PMS7003_PM10_OFFSET 10
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) #define PMS7003_PM2P5_OFFSET 8
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) #define PMS7003_PM1_OFFSET 6
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) #define PMS7003_TIMEOUT msecs_to_jiffies(6000)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) #define PMS7003_CMD_LENGTH 7
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) #define PMS7003_PM_MAX 1000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) #define PMS7003_PM_MIN 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) enum {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) 	PM1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 	PM2P5,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 	PM10,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) enum pms7003_cmd {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 	CMD_WAKEUP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 	CMD_ENTER_PASSIVE_MODE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 	CMD_READ_PASSIVE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 	CMD_SLEEP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52)  * commands have following format:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54)  * +------+------+-----+------+-----+-----------+-----------+
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55)  * | 0x42 | 0x4d | cmd | 0x00 | arg | cksum msb | cksum lsb |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56)  * +------+------+-----+------+-----+-----------+-----------+
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) static const u8 pms7003_cmd_tbl[][PMS7003_CMD_LENGTH] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 	[CMD_WAKEUP] = { 0x42, 0x4d, 0xe4, 0x00, 0x01, 0x01, 0x74 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 	[CMD_ENTER_PASSIVE_MODE] = { 0x42, 0x4d, 0xe1, 0x00, 0x00, 0x01, 0x70 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 	[CMD_READ_PASSIVE] = { 0x42, 0x4d, 0xe2, 0x00, 0x00, 0x01, 0x71 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 	[CMD_SLEEP] = { 0x42, 0x4d, 0xe4, 0x00, 0x00, 0x01, 0x73 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) struct pms7003_frame {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 	u8 data[PMS7003_MAX_DATA_LENGTH];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 	u16 expected_length;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 	u16 length;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) struct pms7003_state {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 	struct serdev_device *serdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	struct pms7003_frame frame;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 	struct completion frame_ready;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 	struct mutex lock; /* must be held whenever state gets touched */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 	/* Used to construct scan to push to the IIO buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 	struct {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 		u16 data[3]; /* PM1, PM2P5, PM10 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 		s64 ts;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 	} scan;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) static int pms7003_do_cmd(struct pms7003_state *state, enum pms7003_cmd cmd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 	ret = serdev_device_write(state->serdev, pms7003_cmd_tbl[cmd],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 				  PMS7003_CMD_LENGTH, PMS7003_TIMEOUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 	if (ret < PMS7003_CMD_LENGTH)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 		return ret < 0 ? ret : -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 	ret = wait_for_completion_interruptible_timeout(&state->frame_ready,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 							PMS7003_TIMEOUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 	if (!ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 		ret = -ETIMEDOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 	return ret < 0 ? ret : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) static u16 pms7003_get_pm(const u8 *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 	return clamp_val(get_unaligned_be16(data),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 			 PMS7003_PM_MIN, PMS7003_PM_MAX);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) static irqreturn_t pms7003_trigger_handler(int irq, void *p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 	struct iio_poll_func *pf = p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 	struct iio_dev *indio_dev = pf->indio_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 	struct pms7003_state *state = iio_priv(indio_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 	struct pms7003_frame *frame = &state->frame;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 	mutex_lock(&state->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 	ret = pms7003_do_cmd(state, CMD_READ_PASSIVE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 		mutex_unlock(&state->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 		goto err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 	state->scan.data[PM1] =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 		pms7003_get_pm(frame->data + PMS7003_PM1_OFFSET);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 	state->scan.data[PM2P5] =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 		pms7003_get_pm(frame->data + PMS7003_PM2P5_OFFSET);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 	state->scan.data[PM10] =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 		pms7003_get_pm(frame->data + PMS7003_PM10_OFFSET);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 	mutex_unlock(&state->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 	iio_push_to_buffers_with_timestamp(indio_dev, &state->scan,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 					   iio_get_time_ns(indio_dev));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 	iio_trigger_notify_done(indio_dev->trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 	return IRQ_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) static int pms7003_read_raw(struct iio_dev *indio_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 			    struct iio_chan_spec const *chan,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 			    int *val, int *val2, long mask)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 	struct pms7003_state *state = iio_priv(indio_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 	struct pms7003_frame *frame = &state->frame;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 	switch (mask) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 	case IIO_CHAN_INFO_PROCESSED:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 		switch (chan->type) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 		case IIO_MASSCONCENTRATION:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 			mutex_lock(&state->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 			ret = pms7003_do_cmd(state, CMD_READ_PASSIVE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 			if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 				mutex_unlock(&state->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 				return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 			*val = pms7003_get_pm(frame->data + chan->address);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 			mutex_unlock(&state->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 			return IIO_VAL_INT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 		default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 			return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 	return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) static const struct iio_info pms7003_info = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 	.read_raw = pms7003_read_raw,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) #define PMS7003_CHAN(_index, _mod, _addr) { \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 	.type = IIO_MASSCONCENTRATION, \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 	.modified = 1, \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 	.channel2 = IIO_MOD_ ## _mod, \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 	.address = _addr, \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 	.info_mask_separate = BIT(IIO_CHAN_INFO_PROCESSED), \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 	.scan_index = _index, \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 	.scan_type = { \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 		.sign = 'u', \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 		.realbits = 10, \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 		.storagebits = 16, \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 		.endianness = IIO_CPU, \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 	}, \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) static const struct iio_chan_spec pms7003_channels[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 	PMS7003_CHAN(0, PM1, PMS7003_PM1_OFFSET),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 	PMS7003_CHAN(1, PM2P5, PMS7003_PM2P5_OFFSET),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 	PMS7003_CHAN(2, PM10, PMS7003_PM10_OFFSET),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 	IIO_CHAN_SOFT_TIMESTAMP(3),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) static u16 pms7003_calc_checksum(struct pms7003_frame *frame)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 	u16 checksum = (PMS7003_MAGIC >> 8) + (u8)(PMS7003_MAGIC & 0xff) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 		       (frame->length >> 8) + (u8)frame->length;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 	for (i = 0; i < frame->length - PMS7003_CHECKSUM_LENGTH; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 		checksum += frame->data[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 	return checksum;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) static bool pms7003_frame_is_okay(struct pms7003_frame *frame)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 	int offset = frame->length - PMS7003_CHECKSUM_LENGTH;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 	u16 checksum = get_unaligned_be16(frame->data + offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 	return checksum == pms7003_calc_checksum(frame);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) static int pms7003_receive_buf(struct serdev_device *serdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 			       const unsigned char *buf, size_t size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 	struct iio_dev *indio_dev = serdev_device_get_drvdata(serdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 	struct pms7003_state *state = iio_priv(indio_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 	struct pms7003_frame *frame = &state->frame;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 	int num;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 	if (!frame->expected_length) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 		u16 magic;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 		/* wait for SOF and data length */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 		if (size < 4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 			return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 		magic = get_unaligned_be16(buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 		if (magic != PMS7003_MAGIC)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 			return 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 		num = get_unaligned_be16(buf + 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 		if (num <= PMS7003_MAX_DATA_LENGTH) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 			frame->expected_length = num;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) 			frame->length = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 		return 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 	num = min(size, (size_t)(frame->expected_length - frame->length));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 	memcpy(frame->data + frame->length, buf, num);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 	frame->length += num;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 	if (frame->length == frame->expected_length) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 		if (pms7003_frame_is_okay(frame))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 			complete(&state->frame_ready);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 		frame->expected_length = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 	return num;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) static const struct serdev_device_ops pms7003_serdev_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 	.receive_buf = pms7003_receive_buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 	.write_wakeup = serdev_device_write_wakeup,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) static void pms7003_stop(void *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 	struct pms7003_state *state = data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 	pms7003_do_cmd(state, CMD_SLEEP);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) static const unsigned long pms7003_scan_masks[] = { 0x07, 0x00 };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) static int pms7003_probe(struct serdev_device *serdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 	struct pms7003_state *state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 	struct iio_dev *indio_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 	indio_dev = devm_iio_device_alloc(&serdev->dev, sizeof(*state));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 	if (!indio_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 	state = iio_priv(indio_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 	serdev_device_set_drvdata(serdev, indio_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) 	state->serdev = serdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 	indio_dev->info = &pms7003_info;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 	indio_dev->name = PMS7003_DRIVER_NAME;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) 	indio_dev->channels = pms7003_channels,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) 	indio_dev->num_channels = ARRAY_SIZE(pms7003_channels);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) 	indio_dev->modes = INDIO_DIRECT_MODE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 	indio_dev->available_scan_masks = pms7003_scan_masks;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) 	mutex_init(&state->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 	init_completion(&state->frame_ready);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 	serdev_device_set_client_ops(serdev, &pms7003_serdev_ops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) 	ret = devm_serdev_device_open(&serdev->dev, serdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) 	serdev_device_set_baudrate(serdev, 9600);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) 	serdev_device_set_flow_control(serdev, false);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 	ret = serdev_device_set_parity(serdev, SERDEV_PARITY_NONE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) 	ret = pms7003_do_cmd(state, CMD_WAKEUP);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) 		dev_err(&serdev->dev, "failed to wakeup sensor\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) 	ret = pms7003_do_cmd(state, CMD_ENTER_PASSIVE_MODE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) 		dev_err(&serdev->dev, "failed to enter passive mode\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) 	ret = devm_add_action_or_reset(&serdev->dev, pms7003_stop, state);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) 	ret = devm_iio_triggered_buffer_setup(&serdev->dev, indio_dev, NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) 					      pms7003_trigger_handler, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) 	return devm_iio_device_register(&serdev->dev, indio_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) static const struct of_device_id pms7003_of_match[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) 	{ .compatible = "plantower,pms1003" },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) 	{ .compatible = "plantower,pms3003" },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) 	{ .compatible = "plantower,pms5003" },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) 	{ .compatible = "plantower,pms6003" },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) 	{ .compatible = "plantower,pms7003" },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) 	{ .compatible = "plantower,pmsa003" },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) 	{ }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) MODULE_DEVICE_TABLE(of, pms7003_of_match);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) static struct serdev_device_driver pms7003_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) 	.driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) 		.name = PMS7003_DRIVER_NAME,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) 		.of_match_table = pms7003_of_match,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) 	.probe = pms7003_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) module_serdev_device_driver(pms7003_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) MODULE_AUTHOR("Tomasz Duszynski <tduszyns@gmail.com>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) MODULE_DESCRIPTION("Plantower PMS7003 particulate matter sensor driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) MODULE_LICENSE("GPL v2");