From nobody Mon Feb 9 19:05:34 2026 Received: from mx0a-0031df01.pphosted.com (mx0a-0031df01.pphosted.com [205.220.168.131]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id B08242882BE for ; Fri, 26 Dec 2025 09:19:34 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=205.220.168.131 ARC-Seal: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1766740776; cv=none; b=K+S+98rpBWOv/6YeYF2eoXLT+IFENTeiVjbc6b2xtGmJCi2xUBN42D4dR1EME1p4qHlplov6/3VIfnxgsKB8M4+aQ8NllV78Fh+V3XtyHpvMoiltLKtjkLDNYmjvStMusHl4B3PVSL3uvf6ebWqbBY6uiuslbXw/SD1b4m8QtaA= ARC-Message-Signature: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1766740776; c=relaxed/simple; bh=eTxcwVlzQOBnGz/0g5KnnF/PMqyyWhweSs9zLsLncSs=; h=From:Date:Subject:MIME-Version:Content-Type:Message-Id:References: In-Reply-To:To:Cc; b=fktd/m5JSHQM9tnuT705zuxirhbqTtXleAkxwvf0pkcuiFFjdv3Bf+F1QsAw4e6i3ADB7Zaign/eHdzvx3P+ZzV+imoiX3edsPvXKJLI0dpyIHpMRghLAs7EWuzwSF6HN0a3NlHcZf6wlI49yC90FWdzO25hBLYcTWngN5SC70A= ARC-Authentication-Results: i=1; smtp.subspace.kernel.org; dmarc=pass (p=reject dis=none) header.from=oss.qualcomm.com; spf=pass smtp.mailfrom=oss.qualcomm.com; dkim=pass (2048-bit key) header.d=qualcomm.com header.i=@qualcomm.com header.b=hvB5BVvd; dkim=pass (2048-bit key) header.d=oss.qualcomm.com header.i=@oss.qualcomm.com header.b=XhE7x9rG; arc=none smtp.client-ip=205.220.168.131 Authentication-Results: smtp.subspace.kernel.org; dmarc=pass (p=reject dis=none) header.from=oss.qualcomm.com Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=oss.qualcomm.com Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=qualcomm.com header.i=@qualcomm.com header.b="hvB5BVvd"; dkim=pass (2048-bit key) header.d=oss.qualcomm.com header.i=@oss.qualcomm.com header.b="XhE7x9rG" Received: from pps.filterd (m0279862.ppops.net [127.0.0.1]) by mx0a-0031df01.pphosted.com (8.18.1.11/8.18.1.11) with ESMTP id 5BQ8boEf890063 for ; Fri, 26 Dec 2025 09:19:34 GMT DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=qualcomm.com; h= cc:content-transfer-encoding:content-type:date:from:in-reply-to :message-id:mime-version:references:subject:to; s=qcppdkim1; bh= P2cxNG02rqVbK6Xamryhmd9ntHtyFViQL5//XE2P+9U=; b=hvB5BVvd/U+sKTsP XOq0yCUe7KnzYzG0I5OdCO2A3NdOpNFJ0mKQb5e9D0UQ2/cN4E/j0z6HSjGZc/j8 IrL36n3IazfYnPJ8PNOk172NVb+s12y2nIvq2Z6pKw2d+Ql5K6061emquYxyFAx0 Lp2uTO9Nz9/lHAaymknuXemCALC+Ok4DVX9MhbTlEe6u90ZqFnPDAaS8dKNyhePX 2usUUP9BK47d72P9aXf7D8y5E9SCiWVKYcM3BJOt4XlYFh/Q2g2A5VOvTQYRltWB InI0w84lZgUZdtdrdsbcrIuq+ghE0HtM18g+0TFk3ib/Mo6YbosjHPO/Fgjk1f/P Gh/mJQ== Received: from mail-qt1-f197.google.com (mail-qt1-f197.google.com [209.85.160.197]) by mx0a-0031df01.pphosted.com (PPS) with ESMTPS id 4b8xvcah4u-1 (version=TLSv1.3 cipher=TLS_AES_128_GCM_SHA256 bits=128 verify=NOT) for ; Fri, 26 Dec 2025 09:19:33 +0000 (GMT) Received: by mail-qt1-f197.google.com with SMTP id d75a77b69052e-4f4a5dba954so174760961cf.0 for ; Fri, 26 Dec 2025 01:19:33 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=oss.qualcomm.com; s=google; t=1766740773; x=1767345573; darn=vger.kernel.org; h=cc:to:in-reply-to:references:message-id:content-transfer-encoding :mime-version:subject:date:from:from:to:cc:subject:date:message-id :reply-to; bh=P2cxNG02rqVbK6Xamryhmd9ntHtyFViQL5//XE2P+9U=; b=XhE7x9rG2WxKlT1DzbJkGKA7K7lxAxszAwC2NgeBLqjrOJoSOsL7pIhdsj/+NpWzZH /A/Ps7oCCknvv+4+mYZNsrP0GQTfSMZxV1VQ9zdV2lJFq55esdT0x53Max6UT7e539FZ ToDQJOFwtbyB6qP0XWqMzW8Whu6tsDl31hbwwhezGkRiWJPh+Qsy7i4Ntrqvtt6/wu1r EGHtfdkNnEZuzn22/O31YUINKU41Hi2PVWsstdFwrDDYiUlWPyy9/m0kAcVOpXrU5+wD b8d4KIRhMD5sJprmjFtkuHQcZ2Kk2HY9JrkngTz9hFTTYcM/adEB+UeZLKi90sQgfW7A qkRQ== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20230601; t=1766740773; x=1767345573; h=cc:to:in-reply-to:references:message-id:content-transfer-encoding :mime-version:subject:date:from:x-gm-gg:x-gm-message-state:from:to :cc:subject:date:message-id:reply-to; bh=P2cxNG02rqVbK6Xamryhmd9ntHtyFViQL5//XE2P+9U=; b=FT1yDHDJS0UJgePsGar640u1QTzJiz1qcTx+GnmJPD+DPr2UcNkMAKXm7IrTyzpmht h8iijvcwG00KSfb2+goJyIoES27g5x5xsYrQiPh7da8/v2AK8PQIURHpeKov2aZQE8rQ pjonuayujPn1NWy/+NIEkML0ngo1zEKcxTAAf/4aAsctsqOjdL+IOsIDmARe7ABbqBN6 gbiIcIMgpt3enLExRVU1sPwmPPDgxiX/SU4bXcQTqOjqLXIDToOfW5wh6GpqZYsmxsJC AZi2wriDgHmpi2gP/WXzLAjnqoTO5pE/CuAGTl9iHzX7x178SnhXTlKa7NMZHLY4HUEq ymJQ== X-Gm-Message-State: AOJu0Yweg1gOF3PZ7lKNHfqVQal0UVpFlZv8ehNyh4wj8iHJkAZXRLx0 pODuSAZNQz3smPY4nH898/10VI1HEZwvw3TGe1U6gAsmO+L6yb+WFZ9pSrSim9TFVExUeqsrI8r ZcCpORzWla5NKAGDLeYssI0Wgojz7NEcavKF49dUZpbssFwahmRK97mEjud38GQy1R1E= X-Gm-Gg: AY/fxX48715r0YNk5ZBsLZth28W/rrMHnWdCXMD2t2gVTtPYV6jOLGC1qiFkHxEQzZE xN4Ms7iM133GndHSXqgQ0dbM1BJrB54oyObyH8RZljWQ/iybNP39ZNehSIDByxjmDOBcPjB8+5x ahrpRg2FLt+DkUyIffnomleI+H+3vIocI4rBcPXpMyLGeehOo2N0FT0UzHeyZaZYNbepCaHBCpE 6C0fkEbwwZUit8nUfrA4wAFlFSXNMf7lXtOonR9A5Ku4TO9HgLyhOYPMYZ8GNOzIbjynWgIdeR6 D+4TCUsnp7IOG4F94m70eqvLahh3cFpsrb5ybYZHv3dqe8BsETbyM6FpagJ8ThDa/J8NmFAat1M y7p9s+H/Wp1QJIa4u4kNux6UXLTZwE1jxMDJK0zWlAN7ojUw1HPNpKrnFNwum7YS+pYGJTP46bp U2 X-Received: by 2002:a05:622a:410f:b0:4ee:fe8:9348 with SMTP id d75a77b69052e-4f4abdb47b4mr312984691cf.72.1766740772697; Fri, 26 Dec 2025 01:19:32 -0800 (PST) X-Google-Smtp-Source: AGHT+IEjEyTBUNEbm5GQAVKxyJf/GJ0VKnuoCJ/KTNiktQ/gHv6ZlibzELyHUqz6stsxQNFCCz5M0Q== X-Received: by 2002:a05:622a:410f:b0:4ee:fe8:9348 with SMTP id d75a77b69052e-4f4abdb47b4mr312984581cf.72.1766740772319; Fri, 26 Dec 2025 01:19:32 -0800 (PST) Received: from WENMLIU-LAB01.ap.qualcomm.com (Global_NAT1_IAD_FW.qualcomm.com. [129.46.232.65]) by smtp.gmail.com with ESMTPSA id d75a77b69052e-4f4ac62d53dsm160612891cf.19.2025.12.26.01.19.28 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Fri, 26 Dec 2025 01:19:31 -0800 (PST) From: Wenmeng Liu Date: Fri, 26 Dec 2025 17:19:11 +0800 Subject: [PATCH v7 2/3] media: qcom: camss: Add link support for TPG Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 Content-Type: text/plain; charset="utf-8" Content-Transfer-Encoding: quoted-printable Message-Id: <20251226-camss_tpg-v7-2-ccb536734805@oss.qualcomm.com> References: <20251226-camss_tpg-v7-0-ccb536734805@oss.qualcomm.com> In-Reply-To: <20251226-camss_tpg-v7-0-ccb536734805@oss.qualcomm.com> To: Robert Foss , Todor Tomov , Bryan O'Donoghue , Vladimir Zapolskiy , Mauro Carvalho Chehab Cc: linux-kernel@vger.kernel.org, linux-media@vger.kernel.org, linux-arm-msm@vger.kernel.org, Wenmeng Liu X-Mailer: b4 0.14.2 X-Developer-Signature: v=1; a=ed25519-sha256; t=1766740760; l=7489; i=wenmeng.liu@oss.qualcomm.com; s=20250925; h=from:subject:message-id; bh=eTxcwVlzQOBnGz/0g5KnnF/PMqyyWhweSs9zLsLncSs=; b=5AA7vOJb2UKzRlRfJwLFcsFGksZ7qv7WNYTCSWu0vcYjWGWNSQbkxzywyUGAlXYT6xumIqNZp w6kaqXN4f0jCt8oI/H0CowjVSWjKB1wIhzVHperMBG/qYY/zxDXSs/v X-Developer-Key: i=wenmeng.liu@oss.qualcomm.com; a=ed25519; pk=fQJjf9C3jGDjE1zj2kO3NQLTbQEaZObVcXAzx5WLPX0= X-Proofpoint-GUID: lzS35P7Piq5G53CfKbMcycUDmWdUdfya X-Proofpoint-Spam-Details-Enc: AW1haW4tMjUxMjI2MDA4NiBTYWx0ZWRfX4Yl8Kbadb8Fw Z1eJj6Ar/jS28W7xGP8En7yGgFU68oZo67cBQpyjzo2YdDh2PhTgS8/Dz/DXxZql0L2BbcI5IKL Pe6IDjiMJqXV/EFd0+r210zIDtFSPZdoTryVihdTetdkUC5nxXKfJhNDeu9Bmwe1nEToT1QOyKV 1Q4c4+PyPBqm/+k5r8xGnHRnGuDhvD7PSrVg6xu2yGL356lH4jygCgK/VvWtXuDSyvZN6tmXuMN SuDrJy1EoMd3AUoZT29zXiyQIGWGhERBvmBguFZtFbv7u+meaRroZSfd6ou06f7Oj+2F07zbHYo k9e3yckIORcWeKWmzU1R7p/hSkK5iqGlATAzFIfgWV+qcJ9nA07EgB2/jFFOu+5QaiyfdsHm1vv EClkOJ3u0EaK+LpC/VOUggIeJTSotPhevGkzUvQ9AlB8Be7/3jvPDIm5QLg9/0d8T2UC3rh2RCz 1LL5UcSAKDLaFSWUAKA== X-Proofpoint-ORIG-GUID: lzS35P7Piq5G53CfKbMcycUDmWdUdfya X-Authority-Analysis: v=2.4 cv=M4xA6iws c=1 sm=1 tr=0 ts=694e5325 cx=c_pps a=EVbN6Ke/fEF3bsl7X48z0g==:117 a=C3Dk8TwHQYyIj7nOf9RCJw==:17 a=IkcTkHD0fZMA:10 a=wP3pNCr1ah4A:10 a=s4-Qcg_JpJYA:10 a=VkNPw1HP01LnGYTKEx00:22 a=EUspDBNiAAAA:8 a=D-OMaI2VJto731AKaP4A:9 a=QEXdDO2ut3YA:10 a=a_PwQJl-kcHnX1M80qC6:22 X-Proofpoint-Virus-Version: vendor=baseguard engine=ICAP:2.0.293,Aquarius:18.0.1121,Hydra:6.1.9,FMLib:17.12.100.49 definitions=2025-12-26_03,2025-12-26_01,2025-10-01_01 X-Proofpoint-Spam-Details: rule=outbound_notspam policy=outbound score=0 clxscore=1015 bulkscore=0 malwarescore=0 adultscore=0 suspectscore=0 impostorscore=0 lowpriorityscore=0 phishscore=0 priorityscore=1501 spamscore=0 classifier=typeunknown authscore=0 authtc= authcc= route=outbound adjust=0 reason=mlx scancount=1 engine=8.22.0-2512120000 definitions=main-2512260086 TPG is connected to the csid as an entity, the link needs to be adapted. Signed-off-by: Wenmeng Liu --- drivers/media/platform/qcom/camss/camss-csid.c | 43 ++++++++++++------ drivers/media/platform/qcom/camss/camss-csiphy.c | 1 + drivers/media/platform/qcom/camss/camss-csiphy.h | 2 + drivers/media/platform/qcom/camss/camss.c | 55 ++++++++++++++++++++= ++++ 4 files changed, 87 insertions(+), 14 deletions(-) diff --git a/drivers/media/platform/qcom/camss/camss-csid.c b/drivers/media= /platform/qcom/camss/camss-csid.c index 5284b5857368c37c202cd89dad6ae8042b637537..aea3267289ff887330480fddf3f= 8e35d9dda69e0 100644 --- a/drivers/media/platform/qcom/camss/camss-csid.c +++ b/drivers/media/platform/qcom/camss/camss-csid.c @@ -35,6 +35,8 @@ #define HW_VERSION_REVISION 16 #define HW_VERSION_GENERATION 28 =20 +#define LANE_CFG_BITWIDTH 4 + #define MSM_CSID_NAME "msm_csid" =20 const char * const csid_testgen_modes[] =3D { @@ -1227,18 +1229,22 @@ void msm_csid_get_csid_id(struct media_entity *enti= ty, u8 *id) } =20 /* - * csid_get_lane_assign - Calculate CSI2 lane assign configuration paramet= er - * @lane_cfg - CSI2 lane configuration + * csid_get_lane_assign - Calculate lane assign by csiphy/tpg lane num + * @num: lane num + * @pos_array: Array of lane positions * * Return lane assign */ -static u32 csid_get_lane_assign(struct csiphy_lanes_cfg *lane_cfg) +static u32 csid_get_lane_assign(struct csiphy_lanes_cfg *lane_cfg, int num= _lanes) { u32 lane_assign =3D 0; + int pos; int i; =20 - for (i =3D 0; i < lane_cfg->num_data; i++) - lane_assign |=3D lane_cfg->data[i].pos << (i * 4); + for (i =3D 0; i < num_lanes; i++) { + pos =3D lane_cfg ? lane_cfg->data[i].pos : i; + lane_assign |=3D pos << (i * LANE_CFG_BITWIDTH); + } =20 return lane_assign; } @@ -1266,6 +1272,7 @@ static int csid_link_setup(struct media_entity *entit= y, struct csid_device *csid; struct csiphy_device *csiphy; struct csiphy_lanes_cfg *lane_cfg; + struct tpg_device *tpg; =20 sd =3D media_entity_to_v4l2_subdev(entity); csid =3D v4l2_get_subdevdata(sd); @@ -1277,18 +1284,26 @@ static int csid_link_setup(struct media_entity *ent= ity, return -EBUSY; =20 sd =3D media_entity_to_v4l2_subdev(remote->entity); - csiphy =3D v4l2_get_subdevdata(sd); + if (sd->grp_id =3D=3D TPG_GUP_ID) { + tpg =3D v4l2_get_subdevdata(sd); =20 - /* If a sensor is not linked to CSIPHY */ - /* do no allow a link from CSIPHY to CSID */ - if (!csiphy->cfg.csi2) - return -EPERM; + csid->phy.lane_cnt =3D tpg->res->lane_cnt; + csid->phy.csiphy_id =3D tpg->id; + csid->phy.lane_assign =3D csid_get_lane_assign(NULL, csid->phy.lane_cnt= ); + } else { + csiphy =3D v4l2_get_subdevdata(sd); =20 - csid->phy.csiphy_id =3D csiphy->id; + /* If a sensor is not linked to CSIPHY */ + /* do no allow a link from CSIPHY to CSID */ + if (!csiphy->cfg.csi2) + return -EPERM; =20 - lane_cfg =3D &csiphy->cfg.csi2->lane_cfg; - csid->phy.lane_cnt =3D lane_cfg->num_data; - csid->phy.lane_assign =3D csid_get_lane_assign(lane_cfg); + csid->phy.csiphy_id =3D csiphy->id; + + lane_cfg =3D &csiphy->cfg.csi2->lane_cfg; + csid->phy.lane_cnt =3D lane_cfg->num_data; + csid->phy.lane_assign =3D csid_get_lane_assign(lane_cfg, lane_cfg->num_= data); + } } /* Decide which virtual channels to enable based on which source pads are= enabled */ if (local->flags & MEDIA_PAD_FL_SOURCE) { diff --git a/drivers/media/platform/qcom/camss/camss-csiphy.c b/drivers/med= ia/platform/qcom/camss/camss-csiphy.c index a734fb7dde0a492cf6e33f53e379557665d54f64..c15990d9d09cc8f9960729bdc11= 2d81751b4938c 100644 --- a/drivers/media/platform/qcom/camss/camss-csiphy.c +++ b/drivers/media/platform/qcom/camss/camss-csiphy.c @@ -800,6 +800,7 @@ int msm_csiphy_register_entity(struct csiphy_device *cs= iphy, sd->flags |=3D V4L2_SUBDEV_FL_HAS_DEVNODE; snprintf(sd->name, ARRAY_SIZE(sd->name), "%s%d", MSM_CSIPHY_NAME, csiphy->id); + sd->grp_id =3D CSIPHY_GUP_ID; v4l2_set_subdevdata(sd, csiphy); =20 ret =3D csiphy_init_formats(sd, NULL); diff --git a/drivers/media/platform/qcom/camss/camss-csiphy.h b/drivers/med= ia/platform/qcom/camss/camss-csiphy.h index 895f80003c441dcacf98435f91567f90afa29279..b7bcf2bdd2124f77b5354b15b33= aa1e0983143e8 100644 --- a/drivers/media/platform/qcom/camss/camss-csiphy.h +++ b/drivers/media/platform/qcom/camss/camss-csiphy.h @@ -21,6 +21,8 @@ #define MSM_CSIPHY_PAD_SRC 1 #define MSM_CSIPHY_PADS_NUM 2 =20 +#define CSIPHY_GUP_ID 1 + struct csiphy_lane { u8 pos; u8 pol; diff --git a/drivers/media/platform/qcom/camss/camss.c b/drivers/media/plat= form/qcom/camss/camss.c index fcc2b2c3cba076e598bc8aacd34efce5d71713ca..43fdcb9af101ef34b118035ca9c= 68757b66118df 100644 --- a/drivers/media/platform/qcom/camss/camss.c +++ b/drivers/media/platform/qcom/camss/camss.c @@ -4145,6 +4145,19 @@ static int camss_init_subdevices(struct camss *camss) } } =20 + if (camss->tpg) { + for (i =3D 0; i < camss->res->tpg_num; i++) { + ret =3D msm_tpg_subdev_init(camss, &camss->tpg[i], + &res->tpg_res[i], i); + if (ret < 0) { + dev_err(camss->dev, + "Failed to init tpg%d sub-device: %d\n", + i, ret); + return ret; + } + } + } + /* note: SM8250 requires VFE to be initialized before CSID */ for (i =3D 0; i < camss->res->vfe_num; i++) { ret =3D msm_vfe_subdev_init(camss, &camss->vfe[i], @@ -4233,6 +4246,23 @@ static int camss_link_entities(struct camss *camss) } } =20 + for (i =3D 0; i < camss->res->tpg_num; i++) { + for (j =3D 0; j < camss->res->csid_num; j++) { + ret =3D media_create_pad_link(&camss->tpg[i].subdev.entity, + MSM_TPG_PAD_SRC, + &camss->csid[j].subdev.entity, + MSM_CSID_PAD_SINK, + 0); + if (ret < 0) { + camss_link_err(camss, + camss->tpg[i].subdev.entity.name, + camss->csid[j].subdev.entity.name, + ret); + return ret; + } + } + } + if (camss->ispif) { for (i =3D 0; i < camss->res->csid_num; i++) { for (j =3D 0; j < camss->ispif->line_num; j++) { @@ -4337,6 +4367,19 @@ static int camss_register_entities(struct camss *cam= ss) } } =20 + if (camss->tpg) { + for (i =3D 0; i < camss->res->tpg_num; i++) { + ret =3D msm_tpg_register_entity(&camss->tpg[i], + &camss->v4l2_dev); + if (ret < 0) { + dev_err(camss->dev, + "Failed to register tpg%d entity: %d\n", + i, ret); + goto err_reg_tpg; + } + } + } + for (i =3D 0; i < camss->res->csid_num; i++) { ret =3D msm_csid_register_entity(&camss->csid[i], &camss->v4l2_dev); @@ -4380,6 +4423,13 @@ static int camss_register_entities(struct camss *cam= ss) for (i--; i >=3D 0; i--) msm_csid_unregister_entity(&camss->csid[i]); =20 + i =3D camss->res->tpg_num; +err_reg_tpg: + if (camss->tpg) { + for (i--; i >=3D 0; i--) + msm_tpg_unregister_entity(&camss->tpg[i]); + } + i =3D camss->res->csiphy_num; err_reg_csiphy: for (i--; i >=3D 0; i--) @@ -4401,6 +4451,11 @@ static void camss_unregister_entities(struct camss *= camss) for (i =3D 0; i < camss->res->csiphy_num; i++) msm_csiphy_unregister_entity(&camss->csiphy[i]); =20 + if (camss->tpg) { + for (i =3D 0; i < camss->res->tpg_num; i++) + msm_tpg_unregister_entity(&camss->tpg[i]); + } + for (i =3D 0; i < camss->res->csid_num; i++) msm_csid_unregister_entity(&camss->csid[i]); =20 --=20 2.34.1