mirror of
https://github.com/Ysurac/openmptcprouter.git
synced 2025-02-13 20:01:55 +00:00
47 lines
1.6 KiB
Diff
47 lines
1.6 KiB
Diff
From 8931837c2d596f407798f080437e9f6af7f6d784 Mon Sep 17 00:00:00 2001
|
|
From: Dave Stevenson <dave.stevenson@raspberrypi.com>
|
|
Date: Mon, 6 Jul 2020 17:51:32 +0100
|
|
Subject: [PATCH 363/552] media: i2c: ov9281: Read chip ID via 2 reads
|
|
|
|
Vision Components have made an OV9281 module which blocks reading
|
|
back the majority of registers to comply with NDAs, and in doing
|
|
so doesn't allow auto-increment register reading as used when
|
|
reading the chip ID.
|
|
|
|
Use two reads and manually combine the results.
|
|
|
|
Signed-off-by: Dave Stevenson <dave.stevenson@raspberrypi.com>
|
|
---
|
|
drivers/media/i2c/ov9281.c | 14 +++++++++-----
|
|
1 file changed, 9 insertions(+), 5 deletions(-)
|
|
|
|
diff --git a/drivers/media/i2c/ov9281.c b/drivers/media/i2c/ov9281.c
|
|
index b28dbe6d08c3..837b37198bb4 100644
|
|
--- a/drivers/media/i2c/ov9281.c
|
|
+++ b/drivers/media/i2c/ov9281.c
|
|
@@ -904,13 +904,17 @@ static int ov9281_check_sensor_id(struct ov9281 *ov9281,
|
|
struct i2c_client *client)
|
|
{
|
|
struct device *dev = &ov9281->client->dev;
|
|
- u32 id = 0;
|
|
+ u32 id = 0, id_msb;
|
|
int ret;
|
|
|
|
- ret = ov9281_read_reg(client, OV9281_REG_CHIP_ID,
|
|
- OV9281_REG_VALUE_16BIT, &id);
|
|
- if (id != CHIP_ID) {
|
|
- dev_err(dev, "Unexpected sensor id(%06x), ret(%d)\n", id, ret);
|
|
+ ret = ov9281_read_reg(client, OV9281_REG_CHIP_ID + 1,
|
|
+ OV9281_REG_VALUE_08BIT, &id);
|
|
+ if (!ret)
|
|
+ ret = ov9281_read_reg(client, OV9281_REG_CHIP_ID,
|
|
+ OV9281_REG_VALUE_08BIT, &id_msb);
|
|
+ id |= (id_msb << 8);
|
|
+ if (ret || id != CHIP_ID) {
|
|
+ dev_err(dev, "Unexpected sensor id(%04x), ret(%d)\n", id, ret);
|
|
return -ENODEV;
|
|
}
|
|
|
|
--
|
|
2.33.0
|
|
|