Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 84b0ce05 authored by Peter Meerwald-Stadler's avatar Peter Meerwald-Stadler Committed by Jonathan Cameron
Browse files

iio: health: max30102: Add check for part ID 



Signed-off-by: default avatarPeter Meerwald-Stadler <pmeerw@pmeerw.net>
Acked-by: default avatarMatt Ranostay <matt.ranostay@konsulko.com>
Signed-off-by: default avatarJonathan Cameron <Jonathan.Cameron@huawei.com>
parent d0b950c7

drivers/iio/health/max30102.c

+18 −0
Original line number Diff line number Diff line
@@ -32,6 +32,7 @@ 


#define MAX30102_REGMAP_NAME	"max30102_regmap"

#define MAX30102_DRV_NAME	"max30102"

#define MAX30102_PART_NUMBER	0x15



#define MAX30102_REG_INT_STATUS			0x00

#define MAX30102_REG_INT_STATUS_PWR_RDY		BIT(0)
@@ -83,6 +84,9 @@ 
#define MAX30102_REG_TEMP_INTEGER		0x1f

#define MAX30102_REG_TEMP_FRACTION		0x20



#define MAX30102_REG_REV_ID			0xfe

#define MAX30102_REG_PART_ID			0xff



struct max30102_data {

	struct i2c_client *client;

	struct iio_dev *indio_dev;
@@ -391,6 +395,7 @@ static int max30102_probe(struct i2c_client *client, 
	struct iio_buffer *buffer;

	struct iio_dev *indio_dev;

	int ret;

	unsigned int reg;



	indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));

	if (!indio_dev)
@@ -424,6 +429,19 @@ static int max30102_probe(struct i2c_client *client, 
		return PTR_ERR(data->regmap);

	}



	/* check part ID */

	ret = regmap_read(data->regmap, MAX30102_REG_PART_ID, &reg);

	if (ret)

		return ret;

	if (reg != MAX30102_PART_NUMBER)

		return -ENODEV;



	/* show revision ID */

	ret = regmap_read(data->regmap, MAX30102_REG_REV_ID, &reg);

	if (ret)

		return ret;

	dev_dbg(&client->dev, "max3010x revision %02x\n", reg);



	ret = max30102_set_powermode(data, false);

	if (ret)

		return ret;