Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) client-ip=2620:137:e000::1:20;
From:   Sandor Yu <Sandor.yu@nxp.com>
To:     andrzej.hajda@intel.com, neil.armstrong@linaro.org,
        rfoss@kernel.org, Laurent.pinchart@ideasonboard.com,
        jonas@kwiboo.se, jernej.skrabec@gmail.com, airlied@gmail.com,
        daniel@ffwll.ch, u.kleine-koenig@pengutronix.de,
        dri-devel@lists.freedesktop.org, linux-kernel@vger.kernel.org
Cc:     Sandor.yu@nxp.com
Subject: [PATCH] drm: bridge: dw_hdmi: Add cec suspend/resume functions
Date:   Fri, 21 Jul 2023 20:44:15 +0800
Message-Id: <20230721124415.1513223-1-Sandor.yu@nxp.com>
Content-Transfer-Encoding: 8bit
Content-Type: text/plain
MIME-Version: 1.0
X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1
X-MS-Exchange-AntiSpam-MessageData-0: =?us-ascii?Q?vdLq/lB26jzQpU4XSFSA3Xeu4tfIwEdzZDPgKzDBKCr/4T0UwRGwLmBA+NS7?=
 =?us-ascii?Q?cTqUZMKyQAqx547uj1sI+w1NhG3CD+kaV3x0N9xhKGSZl7uymVha1T5hKsbs?=
 =?us-ascii?Q?nPoDa1mWAmnZaXRhXZ9AWC+tRq7Isd+s3zcg6GyCbFaNkAniAHoKYP4S2YO3?=
 =?us-ascii?Q?ipompYPMZXieJVKl6V0PLSfl4AfztZDBva2SdPJDHJKoNpMyKHHqcBDghdw3?=
 =?us-ascii?Q?yovJAk3NfsovRzpf6aD1JeRnReVO/EqBnNGdTnI9PC+otKQg/oxnSiLqHxDn?=
 =?us-ascii?Q?otfxp5Iz1p2guoH8X/m+JBIrnYvqs6KLJ+xIN3IHm2UQi/dR85+xKG7zhiRd?=
 =?us-ascii?Q?sXI9O9EPtiJtiNL+q0dtmf0LsOhsI6ovc3PuLc5/QcRZ5t3hFhQZ73d4CeDJ?=
 =?us-ascii?Q?jfz2Udm2wN7swfYownWsqa4H1eymrZFNJFeS9otmZjr7G1r3u0UjVdrA220m?=
 =?us-ascii?Q?XrIlor+Zc+F1hrLHc4mH6jb7Fn+vBWKPSLhiPdUDzErxlC4VpA44kB/xIsmm?=
 =?us-ascii?Q?WcLRNi9hNzAnlrrgu40fJ5P9q/UmpPlGBuZn7QO5LRfv1VHiJQkYFdAtOAbl?=
 =?us-ascii?Q?Dm/6jStQTVdqZnnUyZ937GZwg4bXaT5XzdydrSM1Sij1CirQI9ABP/ZP1y2f?=
 =?us-ascii?Q?tfPTW8HPDQYhRht5HsgRdMWy45XMAthz9gwvAeOo19Kuuqr/pn2d1PT6Ir6S?=
 =?us-ascii?Q?0/JPuAefQLx9nSI1FO7LyMCinMIkrFZyDSiVaUHKPQK4uG20NVHu/VRcVARc?=
 =?us-ascii?Q?Qgzz2iWzoXFs/iWDyA+BgACy7QjCPrO0BKzkYTwS+L722fOzIWCqGJQHY79l?=
 =?us-ascii?Q?eJgrsAkk955HnXWAOkEN6G5bOdBpxveePN8YedOt/kjTHpFvdZ6n2Ff/dSVZ?=
 =?us-ascii?Q?jQtVqa15XuaZFSoLPL1R38qGEwEXVEqg3s1+YmT0NCYgN1PMKzMlMnlc+EZ4?=
 =?us-ascii?Q?Z3GQxlnRIKwnr59KHYbmOyT8BnybOSfrJuoh6dRjXdYKFVbe8pvEGI7wSx6N?=
 =?us-ascii?Q?m/H4VzJNs3sXYO0kdBGIKUfFfKywxg5/qf6V68aFE8fpGQhF1WRbCbLRq09J?=
 =?us-ascii?Q?80OBjY6dhzt4gc/BRadsdvtlV9F35Fg4tqvdNmeITGvdUYPm4zEEPLH4jbaf?=
 =?us-ascii?Q?6tPwr+xiMaLe7ZFLT/u4f83fEMGT2Ia1YJb25Zq/jQy1l+FbmjrhQqPh/m1J?=
 =?us-ascii?Q?DT3TS1yhNNmj34F+P5cdQwYhm92Kiio3c7eJlGifacPhc66/3xxvTUK/ZPmt?=
 =?us-ascii?Q?palJvobU3erFNS8eRa04hWbbIdqt5dvsEz8sQmpGhdO3cV56hkPhUAAK2wk+?=
 =?us-ascii?Q?Wz1KiOqbO2hd4iUwmLElMG+SfPnXXOCwXq9PGgpu5wqlNjqhpA1NexZHy6Bn?=
 =?us-ascii?Q?x2GrgeAzJQFv9jq/t8ZPhy1t4ISx0Wy1RCmKICd38/1eAb2KXJPM9xFkhIcs?=
 =?us-ascii?Q?AVPq+aR6OYlFChN97zmwyyoK21MDc07XsjnM90Buco3fKp0A6/Gq+Vaymqt9?=
 =?us-ascii?Q?OgxVXEpZ8jTRXWjhBzvC7dZpU0vpwbceJK5nEmGK/tbTZIQUZ0ImOvyLXWP5?=
 =?us-ascii?Q?3mQi0i6yUCr7OOxrnbxvqU8AD5fRBBeTpnzIteRP?=
X-OriginatorOrg: nxp.com
X-MS-Exchange-CrossTenant-Network-Message-Id: e76da41d-452a-4458-1d3c-08db89e84fa2
X-MS-Exchange-CrossTenant-AuthSource: PAXPR04MB9448.eurprd04.prod.outlook.com
X-MS-Exchange-CrossTenant-AuthAs: Internal
X-MS-Exchange-CrossTenant-OriginalArrivalTime: 21 Jul 2023 12:45:06.6231
 (UTC)
X-MS-Exchange-CrossTenant-FromEntityHeader: Hosted
X-MS-Exchange-CrossTenant-Id: 686ea1d3-bc2b-4c6f-a92c-d99c5c301635
X-MS-Exchange-CrossTenant-MailboxType: HOSTED
X-MS-Exchange-CrossTenant-UserPrincipalName: 4HAzXkBz8rM/EKZM6HwHhZj274gX/pg0ltSdzsO6lQf45vtleC37JUE9nPJszB3vQb54+jCkq/DFS7+FltelNw==
X-MS-Exchange-Transport-CrossTenantHeadersStamped: DU2PR04MB8645
X-Spam-Status: No, score=-2.1 required=5.0 tests=BAYES_00,DKIM_SIGNED,
        DKIM_VALID,DKIM_VALID_AU,DKIM_VALID_EF,RCVD_IN_DNSWL_BLOCKED,
        RCVD_IN_MSPIKE_H2,SPF_HELO_PASS,SPF_PASS,T_SCC_BODY_TEXT_LINE,
        URIBL_BLOCKED autolearn=ham autolearn_force=no version=3.4.6
X-Spam-Checker-Version: SpamAssassin 3.4.6 (2021-04-09) on
        lindbergh.monkeyblade.net
Precedence: bulk
List-ID: <linux-kernel.vger.kernel.org>
X-Mailing-List: linux-kernel@vger.kernel.org

CEC interrupt status/mask and logical address registers
will be reset when device enter suspend.
It will cause cec fail to work after device resume.
Add CEC suspend/resume functions, reinitialize logical address registers
and restore interrupt status/mask registers after resume.

Signed-off-by: Sandor Yu <Sandor.yu@nxp.com>
---
 drivers/gpu/drm/bridge/synopsys/dw-hdmi-cec.c | 37 +++++++++++++++++++
 1 file changed, 37 insertions(+)

diff --git a/drivers/gpu/drm/bridge/synopsys/dw-hdmi-cec.c b/drivers/gpu/drm/bridge/synopsys/dw-hdmi-cec.c
index 9389ce526eb13..be21c11de1f2a 100644
--- a/drivers/gpu/drm/bridge/synopsys/dw-hdmi-cec.c
+++ b/drivers/gpu/drm/bridge/synopsys/dw-hdmi-cec.c
@@ -62,6 +62,10 @@ struct dw_hdmi_cec {
 	bool rx_done;
 	struct cec_notifier *notify;
 	int irq;
+
+	u8 regs_polarity;
+	u8 regs_mask;
+	u8 regs_mute_stat0;
 };
 
 static void dw_hdmi_write(struct dw_hdmi_cec *cec, u8 val, int offset)
@@ -304,11 +308,44 @@ static void dw_hdmi_cec_remove(struct platform_device *pdev)
 	cec_unregister_adapter(cec->adap);
 }
 
+static int __maybe_unused dw_hdmi_cec_resume(struct device *dev)
+{
+	struct dw_hdmi_cec *cec = dev_get_drvdata(dev);
+
+	/* Restore logical address */
+	dw_hdmi_write(cec, cec->addresses & 255, HDMI_CEC_ADDR_L);
+	dw_hdmi_write(cec, cec->addresses >> 8, HDMI_CEC_ADDR_H);
+
+	/* Restore interrupt status/mask registers */
+	dw_hdmi_write(cec, cec->regs_polarity, HDMI_CEC_POLARITY);
+	dw_hdmi_write(cec, cec->regs_mask, HDMI_CEC_MASK);
+	dw_hdmi_write(cec, cec->regs_mute_stat0, HDMI_IH_MUTE_CEC_STAT0);
+
+	return 0;
+}
+
+static int __maybe_unused dw_hdmi_cec_suspend(struct device *dev)
+{
+	struct dw_hdmi_cec *cec = dev_get_drvdata(dev);
+
+	/* store interrupt status/mask registers */
+	 cec->regs_polarity = dw_hdmi_read(cec, HDMI_CEC_POLARITY);
+	 cec->regs_mask = dw_hdmi_read(cec, HDMI_CEC_MASK);
+	 cec->regs_mute_stat0 = dw_hdmi_read(cec, HDMI_IH_MUTE_CEC_STAT0);
+
+	return 0;
+}
+
+static const struct dev_pm_ops dw_hdmi_cec_pm = {
+	SET_SYSTEM_SLEEP_PM_OPS(dw_hdmi_cec_suspend, dw_hdmi_cec_resume)
+};
+
 static struct platform_driver dw_hdmi_cec_driver = {
 	.probe	= dw_hdmi_cec_probe,
 	.remove_new = dw_hdmi_cec_remove,
 	.driver = {
 		.name = "dw-hdmi-cec",
+		.pm = &dw_hdmi_cec_pm,
 	},
 };
 module_platform_driver(dw_hdmi_cec_driver);
-- 
2.34.1