forked from ~ljy/RK356X_SDK_RELEASE

blame | history | patch | commit | commitdiff
hc
2023-12-11 d2ccde1c8e90d38cee87a1b0309ad2827f3fd30d 
 kernel/drivers/media/i2c/adv7180.c
....@@ -1,19 +1,10 @@
1
+// SPDX-License-Identifier: GPL-2.0
12 /*
23  * adv7180.c Analog Devices ADV7180 video decoder driver
34  * Copyright (c) 2009 Intel Corporation
45  * Copyright (C) 2013 Cogent Embedded, Inc.
56  * Copyright (C) 2013 Renesas Solutions Corp.
6
- *
7
- * This program is free software; you can redistribute it and/or modify
8
- * it under the terms of the GNU General Public License version 2 as
9
- * published by the Free Software Foundation.
10
- *
11
- * This program is distributed in the hope that it will be useful,
12
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
13
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14
- * GNU General Public License for more details.
157  */
16
-
178 #include <linux/module.h>
189 #include <linux/init.h>
1910 #include <linux/errno.h>
....@@ -188,6 +179,9 @@
188179 #define ADV7180_DEFAULT_VPP_I2C_ADDR 0x42
189180 
190181 #define V4L2_CID_ADV_FAST_SWITCH	(V4L2_CID_USER_ADV7180_BASE + 0x00)
182
+
183
+/* Initial number of frames to skip to avoid possible garbage */
184
+#define ADV7180_NUM_OF_SKIP_FRAMES       2
191185 
192186 struct adv7180_state;
193187 
....@@ -732,7 +726,7 @@
732726 	case V4L2_FIELD_NONE:
733727 		if (state->chip_info->flags & ADV7180_FLAG_I2P)
734728 			break;
735
-		/* fall through */
729
+		fallthrough;
736730 	default:
737731 		format->format.field = V4L2_FIELD_ALTERNATE;
738732 		break;
....@@ -755,13 +749,25 @@
755749 	return ret;
756750 }
757751 
758
-static int adv7180_g_mbus_config(struct v4l2_subdev *sd,
759
-				 struct v4l2_mbus_config *cfg)
752
+static int adv7180_init_cfg(struct v4l2_subdev *sd,
753
+			    struct v4l2_subdev_pad_config *cfg)
754
+{
755
+	struct v4l2_subdev_format fmt = {
756
+		.which = cfg ? V4L2_SUBDEV_FORMAT_TRY
757
+			: V4L2_SUBDEV_FORMAT_ACTIVE,
758
+	};
759
+
760
+	return adv7180_set_pad_format(sd, cfg, &fmt);
761
+}
762
+
763
+static int adv7180_get_mbus_config(struct v4l2_subdev *sd,
764
+				   unsigned int pad,
765
+				   struct v4l2_mbus_config *cfg)
760766 {
761767 	struct adv7180_state *state = to_state(sd);
762768 
763769 	if (state->chip_info->flags & ADV7180_FLAG_MIPI_CSI2) {
764
-		cfg->type = V4L2_MBUS_CSI2;
770
+		cfg->type = V4L2_MBUS_CSI2_DPHY;
765771 		cfg->flags = V4L2_MBUS_CSI2_1_LANE |
766772 				V4L2_MBUS_CSI2_CHANNEL_0 |
767773 				V4L2_MBUS_CSI2_CONTINUOUS_CLOCK;
....@@ -774,6 +780,13 @@
774780 				 V4L2_MBUS_DATA_ACTIVE_HIGH;
775781 		cfg->type = V4L2_MBUS_BT656;
776782 	}
783
+
784
+	return 0;
785
+}
786
+
787
+static int adv7180_get_skip_frames(struct v4l2_subdev *sd, u32 *frames)
788
+{
789
+	*frames = ADV7180_NUM_OF_SKIP_FRAMES;
777790 
778791 	return 0;
779792 }
....@@ -840,7 +853,6 @@
840853 	.querystd = adv7180_querystd,
841854 	.g_input_status = adv7180_g_input_status,
842855 	.s_routing = adv7180_s_routing,
843
-	.g_mbus_config = adv7180_g_mbus_config,
844856 	.g_pixelaspect = adv7180_g_pixelaspect,
845857 	.g_tvnorms = adv7180_g_tvnorms,
846858 	.s_stream = adv7180_s_stream,
....@@ -853,15 +865,22 @@
853865 };
854866 
855867 static const struct v4l2_subdev_pad_ops adv7180_pad_ops = {
868
+	.init_cfg = adv7180_init_cfg,
856869 	.enum_mbus_code = adv7180_enum_mbus_code,
857870 	.set_fmt = adv7180_set_pad_format,
858871 	.get_fmt = adv7180_get_pad_format,
872
+	.get_mbus_config = adv7180_get_mbus_config,
873
+};
874
+
875
+static const struct v4l2_subdev_sensor_ops adv7180_sensor_ops = {
876
+	.g_skip_frames = adv7180_get_skip_frames,
859877 };
860878 
861879 static const struct v4l2_subdev_ops adv7180_ops = {
862880 	.core = &adv7180_core_ops,
863881 	.video = &adv7180_video_ops,
864882 	.pad = &adv7180_pad_ops,
883
+	.sensor = &adv7180_sensor_ops,
865884 };
866885 
867886 static irqreturn_t adv7180_irq(int irq, void *devid)
....@@ -1303,9 +1322,6 @@
13031322 	if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
13041323 		return -EIO;
13051324 
1306
-	v4l_info(client, "chip found @ 0x%02x (%s)\n",
1307
-		 client->addr, client->adapter->name);
1308
-
13091325 	state = devm_kzalloc(&client->dev, sizeof(*state), GFP_KERNEL);
13101326 	if (state == NULL)
13111327 		return -ENOMEM;
....@@ -1323,17 +1339,17 @@
13231339 	}
13241340 
13251341 	if (state->chip_info->flags & ADV7180_FLAG_MIPI_CSI2) {
1326
-		state->csi_client = i2c_new_dummy(client->adapter,
1342
+		state->csi_client = i2c_new_dummy_device(client->adapter,
13271343 				ADV7180_DEFAULT_CSI_I2C_ADDR);
1328
-		if (!state->csi_client)
1329
-			return -ENOMEM;
1344
+		if (IS_ERR(state->csi_client))
1345
+			return PTR_ERR(state->csi_client);
13301346 	}
13311347 
13321348 	if (state->chip_info->flags & ADV7180_FLAG_I2P) {
1333
-		state->vpp_client = i2c_new_dummy(client->adapter,
1349
+		state->vpp_client = i2c_new_dummy_device(client->adapter,
13341350 				ADV7180_DEFAULT_VPP_I2C_ADDR);
1335
-		if (!state->vpp_client) {
1336
-			ret = -ENOMEM;
1351
+		if (IS_ERR(state->vpp_client)) {
1352
+			ret = PTR_ERR(state->vpp_client);
13371353 			goto err_unregister_csi_client;
13381354 		}
13391355 	}
....@@ -1376,6 +1392,9 @@
13761392 	if (ret)
13771393 		goto err_free_irq;
13781394 
1395
+	v4l_info(client, "chip found @ 0x%02x (%s)\n",
1396
+		 client->addr, client->adapter->name);
1397
+
13791398 	return 0;
13801399 
13811400 err_free_irq: