Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) client-ip=23.128.96.18;
From:   Stefan Riedmueller <s.riedmueller@phytec.de>
To:     Laurent Pinchart <laurent.pinchart@ideasonboard.com>
Cc:     Mauro Carvalho Chehab <mchehab@kernel.org>,
        Sakari Ailus <sakari.ailus@linux.intel.com>,
        linux-media@vger.kernel.org, linux-kernel@vger.kernel.org,
        Enrico Scholz <enrico.scholz@sigma-chemnitz.de>,
        Stefan Riedmueller <s.riedmueller@phytec.de>
Subject: [PATCH 3/5] media: mt9p031: Implement [gs]_register debug calls
Date:   Fri, 25 Sep 2020 09:50:27 +0200
Message-Id: <20200925075029.32181-3-s.riedmueller@phytec.de>
In-Reply-To: <20200925075029.32181-1-s.riedmueller@phytec.de>
References: <20200925075029.32181-1-s.riedmueller@phytec.de>
MIME-Version: 1.0
Content-Transfer-Encoding: quoted-printable
Precedence: bulk

From: Enrico Scholz <enrico.scholz@sigma-chemnitz.de>

Implement g=5Fregister and s=5Fregister v4l2=5Fsubdev=5Fcore=5Fops to access
camera register directly from userspace for debug purposes.

Signed-off-by: Enrico Scholz <enrico.scholz@sigma-chemnitz.de>
Signed-off-by: Stefan Riedmueller <s.riedmueller@phytec.de>
---
 drivers/media/i2c/mt9p031.c | 28 ++++++++++++++++++++++++++++
 1 file changed, 28 insertions(+)

diff --git a/drivers/media/i2c/mt9p031.c b/drivers/media/i2c/mt9p031.c
index ce192be4531f..f5d6a7890c47 100644
--- a/drivers/media/i2c/mt9p031.c
+++ b/drivers/media/i2c/mt9p031.c
@@ -703,6 +703,30 @@ static int mt9p031=5Frestore=5Fblc(struct mt9p031 *mt9=
p031)
 	return 0;
 }
=20
+#ifdef CONFIG=5FVIDEO=5FADV=5FDEBUG
+static int mt9p031=5Fg=5Fregister(struct v4l2=5Fsubdev *sd,
+			      struct v4l2=5Fdbg=5Fregister *reg)
+{
+	struct i2c=5Fclient *client =3D v4l2=5Fget=5Fsubdevdata(sd);
+	int ret;
+
+	ret =3D mt9p031=5Fread(client, reg->reg);
+	if (ret < 0)
+		return ret;
+
+	reg->val =3D ret;
+	return 0;
+}
+
+static int mt9p031=5Fs=5Fregister(struct v4l2=5Fsubdev *sd,
+			      struct v4l2=5Fdbg=5Fregister const *reg)
+{
+	struct i2c=5Fclient *client =3D v4l2=5Fget=5Fsubdevdata(sd);
+
+	return mt9p031=5Fwrite(client, reg->reg, reg->val);
+}
+#endif
+
 static int mt9p031=5Fs=5Fctrl(struct v4l2=5Fctrl *ctrl)
 {
 	struct mt9p031 *mt9p031 =3D
@@ -1000,6 +1024,10 @@ static int mt9p031=5Fclose(struct v4l2=5Fsubdev *sub=
dev, struct v4l2=5Fsubdev=5Ffh *fh)
=20
 static const struct v4l2=5Fsubdev=5Fcore=5Fops mt9p031=5Fsubdev=5Fcore=5Fo=
ps =3D {
 	.s=5Fpower        =3D mt9p031=5Fset=5Fpower,
+#ifdef CONFIG=5FVIDEO=5FADV=5FDEBUG
+	.s=5Fregister	=3D mt9p031=5Fs=5Fregister,
+	.g=5Fregister	=3D mt9p031=5Fg=5Fregister,
+#endif
 };
=20
 static const struct v4l2=5Fsubdev=5Fvideo=5Fops mt9p031=5Fsubdev=5Fvideo=
=5Fops =3D {
--=20
2.25.1