From nobody Wed Dec 17 15:34:56 2025 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by smtp.lore.kernel.org (Postfix) with ESMTP id CB611C4167B for ; Sat, 25 Nov 2023 18:23:37 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S231904AbjKYSX3 (ORCPT ); Sat, 25 Nov 2023 13:23:29 -0500 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:45980 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S229746AbjKYSX0 (ORCPT ); Sat, 25 Nov 2023 13:23:26 -0500 Received: from mx07-00178001.pphosted.com (mx07-00178001.pphosted.com [185.132.182.106]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id EF3FBD3; Sat, 25 Nov 2023 10:23:31 -0800 (PST) Received: from pps.filterd (m0288072.ppops.net [127.0.0.1]) by mx07-00178001.pphosted.com (8.17.1.22/8.17.1.22) with ESMTP id 3AP1NcLd017784; Sat, 25 Nov 2023 19:23:15 +0100 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=foss.st.com; h= from:to:cc:subject:date:message-id:in-reply-to:references :mime-version:content-transfer-encoding:content-type; s= selector1; bh=c9CbByJ4q7lI396RIfpc5M725lJvNGjFgx6JOsUCteQ=; b=o5 yZWac1+X0fb7sBFt9jWUkoQRhcsCMd400gt7qM1q8unVZcGHsWlw4iXh2qK1qPkI 7zntRjJ3+sHC8MDt/lqaHS/1wjvW0Pu/F2h60UgH1zZ2yZTUKEQPiKDUvMkip6Mo IwovnQghzsFr0hryptFWcMc/BymCoqyhSmuwc/mqtntvZ8IMWKLlC1gQYsPnCWWj WUSEUhv9V550gvx5JSCt25K46McoCPy+tTjolf0r8HzATopmHDeYf/IbeV0SswYg uLUbzKnl9PQqR4ucROC7HA1a5rce9VgYox8NsVBceXXJnTkxGcn1OaDLRvPUne7v y46zu6cS4xZTp41z4zng== Received: from beta.dmz-eu.st.com (beta.dmz-eu.st.com [164.129.1.35]) by mx07-00178001.pphosted.com (PPS) with ESMTPS id 3uk77kj4ry-1 (version=TLSv1.2 cipher=ECDHE-RSA-AES256-GCM-SHA384 bits=256 verify=NOT); Sat, 25 Nov 2023 19:23:14 +0100 (CET) Received: from euls16034.sgp.st.com (euls16034.sgp.st.com [10.75.44.20]) by beta.dmz-eu.st.com (STMicroelectronics) with ESMTP id DB99E10002A; Sat, 25 Nov 2023 19:23:13 +0100 (CET) Received: from Webmail-eu.st.com (shfdag1node1.st.com [10.75.129.69]) by euls16034.sgp.st.com (STMicroelectronics) with ESMTP id D06CC23C6A4; Sat, 25 Nov 2023 19:23:13 +0100 (CET) Received: from localhost (10.129.178.213) by SHFDAG1NODE1.st.com (10.75.129.69) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_128_GCM_SHA256) id 15.1.2507.27; Sat, 25 Nov 2023 19:23:14 +0100 From: Alain Volmat To: Mauro Carvalho Chehab , Benjamin Mugnier , Sylvain Petinot CC: Sakari Ailus , Alain Volmat , , Subject: [PATCH 4/7] media: i2c: st-mipid02: use active state to store pad formats Date: Sat, 25 Nov 2023 19:20:52 +0100 Message-ID: <20231125182057.1379357-5-alain.volmat@foss.st.com> X-Mailer: git-send-email 2.25.1 In-Reply-To: <20231125182057.1379357-1-alain.volmat@foss.st.com> References: <20231125182057.1379357-1-alain.volmat@foss.st.com> MIME-Version: 1.0 Content-Transfer-Encoding: quoted-printable X-Originating-IP: [10.129.178.213] X-ClientProxiedBy: SHFCAS1NODE2.st.com (10.75.129.73) To SHFDAG1NODE1.st.com (10.75.129.69) X-Proofpoint-Virus-Version: vendor=baseguard engine=ICAP:2.0.272,Aquarius:18.0.987,Hydra:6.0.619,FMLib:17.11.176.26 definitions=2023-11-25_17,2023-11-22_01,2023-05-22_02 Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org Content-Type: text/plain; charset="utf-8" Store formats information within pad allowing to simplify further more the driver (mutex / format store within the driver structure no more necessary). Signed-off-by: Alain Volmat --- drivers/media/i2c/st-mipid02.c | 206 ++++++++++++--------------------- 1 file changed, 75 insertions(+), 131 deletions(-) diff --git a/drivers/media/i2c/st-mipid02.c b/drivers/media/i2c/st-mipid02.c index 15f6c9e8b7f1..7af209905d7b 100644 --- a/drivers/media/i2c/st-mipid02.c +++ b/drivers/media/i2c/st-mipid02.c @@ -112,9 +112,6 @@ struct mipid02_dev { u8 pix_width_ctrl; u8 pix_width_ctrl_emb; } r; - /* lock to protect all members below */ - struct mutex lock; - struct v4l2_mbus_framefmt fmt; }; =20 static int bpp_from_code(__u32 code) @@ -192,18 +189,6 @@ static u8 data_type_from_code(__u32 code) } } =20 -static void init_format(struct v4l2_mbus_framefmt *fmt) -{ - fmt->code =3D MEDIA_BUS_FMT_SBGGR8_1X8; - fmt->field =3D V4L2_FIELD_NONE; - fmt->colorspace =3D V4L2_COLORSPACE_SRGB; - fmt->ycbcr_enc =3D V4L2_MAP_YCBCR_ENC_DEFAULT(V4L2_COLORSPACE_SRGB); - fmt->quantization =3D V4L2_QUANTIZATION_FULL_RANGE; - fmt->xfer_func =3D V4L2_MAP_XFER_FUNC_DEFAULT(V4L2_COLORSPACE_SRGB); - fmt->width =3D 640; - fmt->height =3D 480; -} - static __u32 get_fmt_code(__u32 code) { unsigned int i; @@ -317,12 +302,13 @@ static int mipid02_detect(struct mipid02_dev *bridge) * will be retrieve from connected device via v4l2_get_link_freq, bit per = pixel * and number of lanes. */ -static int mipid02_configure_from_rx_speed(struct mipid02_dev *bridge) +static int mipid02_configure_from_rx_speed(struct mipid02_dev *bridge, + struct v4l2_mbus_framefmt *fmt) { struct i2c_client *client =3D bridge->i2c_client; struct v4l2_subdev *subdev =3D bridge->s_subdev; struct v4l2_fwnode_endpoint *ep =3D &bridge->rx; - u32 bpp =3D bpp_from_code(bridge->fmt.code); + u32 bpp =3D bpp_from_code(fmt->code); /* * clk_lane_reg1 requires 4 times the unit interval time, and bitrate * is twice the link frequency, hence ui_4 =3D 1000000000 * 4 / 2 @@ -394,7 +380,8 @@ static int mipid02_configure_data1_lane(struct mipid02_= dev *bridge, int nb, return 0; } =20 -static int mipid02_configure_from_rx(struct mipid02_dev *bridge) +static int mipid02_configure_from_rx(struct mipid02_dev *bridge, + struct v4l2_mbus_framefmt *fmt) { struct v4l2_fwnode_endpoint *ep =3D &bridge->rx; bool are_lanes_swap =3D ep->bus.mipi_csi2.data_lanes[0] =3D=3D 2; @@ -419,7 +406,7 @@ static int mipid02_configure_from_rx(struct mipid02_dev= *bridge) bridge->r.mode_reg1 |=3D are_lanes_swap ? MODE_DATA_SWAP : 0; bridge->r.mode_reg1 |=3D (nb - 1) << 1; =20 - return mipid02_configure_from_rx_speed(bridge); + return mipid02_configure_from_rx_speed(bridge, fmt); } =20 static int mipid02_configure_from_tx(struct mipid02_dev *bridge) @@ -439,16 +426,17 @@ static int mipid02_configure_from_tx(struct mipid02_d= ev *bridge) return 0; } =20 -static int mipid02_configure_from_code(struct mipid02_dev *bridge) +static int mipid02_configure_from_code(struct mipid02_dev *bridge, + struct v4l2_mbus_framefmt *fmt) { u8 data_type; =20 bridge->r.data_id_rreg =3D 0; =20 - if (bridge->fmt.code !=3D MEDIA_BUS_FMT_JPEG_1X8) { + if (fmt->code !=3D MEDIA_BUS_FMT_JPEG_1X8) { bridge->r.data_selection_ctrl |=3D SELECTION_MANUAL_DATA; =20 - data_type =3D data_type_from_code(bridge->fmt.code); + data_type =3D data_type_from_code(fmt->code); if (!data_type) return -EINVAL; bridge->r.data_id_rreg =3D data_type; @@ -485,23 +473,31 @@ static int mipid02_stream_disable(struct mipid02_dev = *bridge) static int mipid02_stream_enable(struct mipid02_dev *bridge) { struct i2c_client *client =3D bridge->i2c_client; + struct v4l2_subdev_state *state; + struct v4l2_mbus_framefmt *fmt; int ret =3D -EINVAL; =20 if (!bridge->s_subdev) goto error; =20 memset(&bridge->r, 0, sizeof(bridge->r)); + + state =3D v4l2_subdev_lock_and_get_active_state(&bridge->sd); + fmt =3D v4l2_subdev_state_get_format(state, MIPID02_SINK_0); + /* build registers content */ - ret =3D mipid02_configure_from_rx(bridge); + ret =3D mipid02_configure_from_rx(bridge, fmt); if (ret) goto error; ret =3D mipid02_configure_from_tx(bridge); if (ret) goto error; - ret =3D mipid02_configure_from_code(bridge); + ret =3D mipid02_configure_from_code(bridge, fmt); if (ret) goto error; =20 + v4l2_subdev_unlock_state(state); + /* write mipi registers */ cci_write(bridge->regmap, MIPID02_CLK_LANE_REG1, bridge->r.clk_lane_reg1, &ret); @@ -556,11 +552,32 @@ static int mipid02_s_stream(struct v4l2_subdev *sd, i= nt enable) return ret; } =20 +static const struct v4l2_mbus_framefmt default_fmt =3D { + .code =3D MEDIA_BUS_FMT_SBGGR8_1X8, + .field =3D V4L2_FIELD_NONE, + .colorspace =3D V4L2_COLORSPACE_SRGB, + .ycbcr_enc =3D V4L2_YCBCR_ENC_DEFAULT, + .quantization =3D V4L2_QUANTIZATION_FULL_RANGE, + .xfer_func =3D V4L2_XFER_FUNC_DEFAULT, + .width =3D 640, + .height =3D 480, +}; + +static int mipid02_init_cfg(struct v4l2_subdev *sd, + struct v4l2_subdev_state *state) +{ + *v4l2_subdev_state_get_format(state, MIPID02_SINK_0) =3D default_fmt; + /* MIPID02_SINK_1 isn't supported yet */ + *v4l2_subdev_state_get_format(state, MIPID02_SOURCE) =3D default_fmt; + + return 0; +} + static int mipid02_enum_mbus_code(struct v4l2_subdev *sd, struct v4l2_subdev_state *sd_state, struct v4l2_subdev_mbus_code_enum *code) { - struct mipid02_dev *bridge =3D to_mipid02_dev(sd); + struct v4l2_mbus_framefmt *sink_fmt; int ret =3D 0; =20 switch (code->pad) { @@ -571,10 +588,13 @@ static int mipid02_enum_mbus_code(struct v4l2_subdev = *sd, code->code =3D mipid02_supported_fmt_codes[code->index]; break; case MIPID02_SOURCE: - if (code->index =3D=3D 0) - code->code =3D serial_to_parallel_code(bridge->fmt.code); - else + if (code->index =3D=3D 0) { + sink_fmt =3D v4l2_subdev_state_get_format(sd_state, + MIPID02_SINK_0); + code->code =3D serial_to_parallel_code(sink_fmt->code); + } else { ret =3D -EINVAL; + } break; default: ret =3D -EINVAL; @@ -583,113 +603,36 @@ static int mipid02_enum_mbus_code(struct v4l2_subdev= *sd, return ret; } =20 -static int mipid02_get_fmt(struct v4l2_subdev *sd, - struct v4l2_subdev_state *sd_state, - struct v4l2_subdev_format *format) -{ - struct v4l2_mbus_framefmt *mbus_fmt =3D &format->format; - struct mipid02_dev *bridge =3D to_mipid02_dev(sd); - struct i2c_client *client =3D bridge->i2c_client; - struct v4l2_mbus_framefmt *fmt; - - dev_dbg(&client->dev, "%s probe %d", __func__, format->pad); - - if (format->pad >=3D MIPID02_PAD_NB) - return -EINVAL; - /* second CSI-2 pad not yet supported */ - if (format->pad =3D=3D MIPID02_SINK_1) - return -EINVAL; - - if (format->which =3D=3D V4L2_SUBDEV_FORMAT_TRY) - fmt =3D v4l2_subdev_state_get_format(sd_state, format->pad); - else - fmt =3D &bridge->fmt; - - mutex_lock(&bridge->lock); - - *mbus_fmt =3D *fmt; - /* code may need to be converted for source */ - if (format->pad =3D=3D MIPID02_SOURCE) - mbus_fmt->code =3D serial_to_parallel_code(mbus_fmt->code); - - mutex_unlock(&bridge->lock); - - return 0; -} - -static void mipid02_set_fmt_source(struct v4l2_subdev *sd, - struct v4l2_subdev_state *sd_state, - struct v4l2_subdev_format *format) -{ - struct mipid02_dev *bridge =3D to_mipid02_dev(sd); - - /* source pad mirror sink pad */ - if (format->which =3D=3D V4L2_SUBDEV_FORMAT_ACTIVE) - format->format =3D bridge->fmt; - else - format->format =3D *v4l2_subdev_state_get_format(sd_state, - MIPID02_SINK_0); - - /* but code may need to be converted */ - format->format.code =3D serial_to_parallel_code(format->format.code); - - /* only apply format for V4L2_SUBDEV_FORMAT_TRY case */ - if (format->which !=3D V4L2_SUBDEV_FORMAT_TRY) - return; - - *v4l2_subdev_state_get_format(sd_state, MIPID02_SOURCE) =3D - format->format; -} - -static void mipid02_set_fmt_sink(struct v4l2_subdev *sd, - struct v4l2_subdev_state *sd_state, - struct v4l2_subdev_format *format) -{ - struct mipid02_dev *bridge =3D to_mipid02_dev(sd); - struct v4l2_subdev_format source_fmt; - struct v4l2_mbus_framefmt *fmt; - - format->format.code =3D get_fmt_code(format->format.code); - - if (format->which =3D=3D V4L2_SUBDEV_FORMAT_TRY) - fmt =3D v4l2_subdev_state_get_format(sd_state, format->pad); - else - fmt =3D &bridge->fmt; - - *fmt =3D format->format; - - /* - * Propagate the format change to the source pad, taking - * care not to update the format pointer given back to user - */ - source_fmt =3D *format; - mipid02_set_fmt_source(sd, sd_state, &source_fmt); -} - static int mipid02_set_fmt(struct v4l2_subdev *sd, struct v4l2_subdev_state *sd_state, - struct v4l2_subdev_format *format) + struct v4l2_subdev_format *fmt) { struct mipid02_dev *bridge =3D to_mipid02_dev(sd); struct i2c_client *client =3D bridge->i2c_client; - int ret =3D 0; + struct v4l2_mbus_framefmt *pad_fmt; =20 - dev_dbg(&client->dev, "%s for %d", __func__, format->pad); + dev_dbg(&client->dev, "%s for %d", __func__, fmt->pad); =20 - if (format->pad >=3D MIPID02_PAD_NB) - return -EINVAL; /* second CSI-2 pad not yet supported */ - if (format->pad =3D=3D MIPID02_SINK_1) + if (fmt->pad =3D=3D MIPID02_SINK_1) return -EINVAL; =20 - mutex_lock(&bridge->lock); + pad_fmt =3D v4l2_subdev_state_get_format(sd_state, fmt->pad); + fmt->format.code =3D get_fmt_code(fmt->format.code); =20 - if (format->pad =3D=3D MIPID02_SOURCE) - mipid02_set_fmt_source(sd, sd_state, format); - else - mipid02_set_fmt_sink(sd, sd_state, format); + /* code may need to be converted */ + if (fmt->pad =3D=3D MIPID02_SOURCE) + fmt->format.code =3D serial_to_parallel_code(fmt->format.code); =20 - mutex_unlock(&bridge->lock); + *pad_fmt =3D fmt->format; + + /* Propagate the format to the source pad in case of sink pad update */ + if (fmt->pad =3D=3D MIPID02_SINK_0) { + pad_fmt =3D v4l2_subdev_state_get_format(sd_state, + MIPID02_SOURCE); + *pad_fmt =3D fmt->format; + pad_fmt->code =3D serial_to_parallel_code(fmt->format.code); + } =20 return 0; } @@ -699,8 +642,9 @@ static const struct v4l2_subdev_video_ops mipid02_video= _ops =3D { }; =20 static const struct v4l2_subdev_pad_ops mipid02_pad_ops =3D { + .init_cfg =3D mipid02_init_cfg, .enum_mbus_code =3D mipid02_enum_mbus_code, - .get_fmt =3D mipid02_get_fmt, + .get_fmt =3D v4l2_subdev_get_fmt, .set_fmt =3D mipid02_set_fmt, }; =20 @@ -868,8 +812,6 @@ static int mipid02_probe(struct i2c_client *client) if (!bridge) return -ENOMEM; =20 - init_format(&bridge->fmt); - bridge->i2c_client =3D client; v4l2_i2c_subdev_init(&bridge->sd, client, &mipid02_subdev_ops); =20 @@ -907,7 +849,6 @@ static int mipid02_probe(struct i2c_client *client) return dev_err_probe(dev, PTR_ERR(bridge->regmap), "failed to get cci regmap\n"); =20 - mutex_init(&bridge->lock); bridge->sd.flags |=3D V4L2_SUBDEV_FL_HAS_DEVNODE; bridge->sd.entity.function =3D MEDIA_ENT_F_VID_IF_BRIDGE; bridge->sd.entity.ops =3D &mipid02_subdev_entity_ops; @@ -918,7 +859,13 @@ static int mipid02_probe(struct i2c_client *client) bridge->pad); if (ret) { dev_err(&client->dev, "pads init failed %d", ret); - goto mutex_cleanup; + return ret; + } + + ret =3D v4l2_subdev_init_finalize(&bridge->sd); + if (ret < 0) { + dev_err(dev, "subdev init error: %d\n", ret); + goto entity_cleanup; } =20 /* enable clock, power and reset device if available */ @@ -962,8 +909,6 @@ static int mipid02_probe(struct i2c_client *client) mipid02_set_power_off(bridge); entity_cleanup: media_entity_cleanup(&bridge->sd.entity); -mutex_cleanup: - mutex_destroy(&bridge->lock); =20 return ret; } @@ -978,7 +923,6 @@ static void mipid02_remove(struct i2c_client *client) v4l2_async_unregister_subdev(&bridge->sd); mipid02_set_power_off(bridge); media_entity_cleanup(&bridge->sd.entity); - mutex_destroy(&bridge->lock); } =20 static const struct of_device_id mipid02_dt_ids[] =3D { --=20 2.25.1