From patchwork Thu Jul 20 09:17:00 2023 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: "Peng Fan (OSS)" X-Patchwork-Id: 123131 Return-Path: Delivered-To: ouuuleilei@gmail.com Received: by 2002:a59:c923:0:b0:3e4:2afc:c1 with SMTP id j3csp2994408vqt; Thu, 20 Jul 2023 02:31:25 -0700 (PDT) X-Google-Smtp-Source: APBJJlG4DgUXAm8nc2tvSaalrYoqcZTLtHVqWsgdhxIrtiGR1/u7MbkFYDQaLUgdkyOczySQFAax X-Received: by 2002:a05:6a20:3c8d:b0:131:eeba:184b with SMTP id b13-20020a056a203c8d00b00131eeba184bmr6074046pzj.25.1689845484983; Thu, 20 Jul 2023 02:31:24 -0700 (PDT) ARC-Seal: i=2; a=rsa-sha256; t=1689845484; cv=pass; d=google.com; s=arc-20160816; b=KellsfyYCnUUQWTvQdfoLJwAg8o1tJEaJDzSScCQwk79G/aCqoWkG2jxzc6xvrdljw LCIj9rRwF3uoDwF25G2yquTP0SesdJSEcw0uSbQI7179Kz6GRp/0+ksy96vt3xZIy6qy 1+Jf8o4nnTJ3I7Ho8sazBxHJ1fnb8l2JiQT69EqJJl7TagQq40FoHCue16BCNg5UGCN+ +VGbU7Golejc2H2xy0dGFJr71ZNVMWVyygqWwpTThPYn98AAcR+Fjqux1SxevIFbxHIe rI0I8vQaRc5Laaa8CBwbbFtn5s6vgsKlCxaBwAT02De2dfzPqqUZ7sGFdqsXqGz3CxNn M1YA== ARC-Message-Signature: i=2; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:mime-version:content-transfer-encoding :references:in-reply-to:message-id:date:subject:cc:to:from :dkim-signature; bh=xvDdV2wD3kAct/OCQawOHD6CkCKngznVXUMmhD6D4MQ=; fh=TlZEgCjOXNq8CKSnQ5emAFoUhkQr53TmuXUrJtBtV5c=; b=KEpdJiWI31B4wefT+Ebni0HGttlXFcWRY2PLp8ejpIqR0bIRPb2/+NRPKAx/dwIsJi 4OSTT+yOWbAeFQpMfYRVW3cTdsR5X3htBtlVY8gaEQYTF0PsxVLaDPNQ3+9rG9gC5PJc nQtgBCMg1eKlLIiz1Mi6b351ehbDTFZAhrZsdJIUuXVZ6DYO7rr+TE9cSGxfxTj4XOWn gd8vQovSlTEw4Ywr5YroCqKhuI+Mqk/cBNmkcODgXARA/OT0Yr4BrmqXVUE3rh8B+IVz 8w1UYui5yOLt2YYdYf9Wp7Pah7T4FcbKGPdOHndJscUA8zRXtqXMEn9UPto4sYPD3w0z RMSA== ARC-Authentication-Results: i=2; mx.google.com; dkim=pass header.i=@NXP1.onmicrosoft.com header.s=selector2-NXP1-onmicrosoft-com header.b=lLCVVNSi; arc=pass (i=1 spf=pass spfdomain=oss.nxp.com dkim=pass dkdomain=oss.nxp.com dmarc=pass fromdomain=oss.nxp.com); spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=fail (p=NONE sp=NONE dis=NONE) header.from=nxp.com Received: from out1.vger.email (out1.vger.email. [2620:137:e000::1:20]) by mx.google.com with ESMTP id jc6-20020a17090325c600b001bb21e1e6dbsi534630plb.383.2023.07.20.02.31.10; Thu, 20 Jul 2023 02:31:24 -0700 (PDT) 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; Authentication-Results: mx.google.com; dkim=pass header.i=@NXP1.onmicrosoft.com header.s=selector2-NXP1-onmicrosoft-com header.b=lLCVVNSi; arc=pass (i=1 spf=pass spfdomain=oss.nxp.com dkim=pass dkdomain=oss.nxp.com dmarc=pass fromdomain=oss.nxp.com); spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=fail (p=NONE sp=NONE dis=NONE) header.from=nxp.com Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S230400AbjGTJ2Z (ORCPT + 99 others); Thu, 20 Jul 2023 05:28:25 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:58948 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S229947AbjGTJ1l (ORCPT ); Thu, 20 Jul 2023 05:27:41 -0400 Received: from EUR05-DB8-obe.outbound.protection.outlook.com (mail-db8eur05on2045.outbound.protection.outlook.com [40.107.20.45]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 8428D49E9; Thu, 20 Jul 2023 02:12:43 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; s=arcselector9901; d=microsoft.com; cv=none; b=g9CzFS//uJt9XS9yyrs9LbOQQcg4yGjFczoCFZbeA/UwfmOCKykR5+kVCMzxa1gkO1uHj64Z2gi7SWyP9yjGa1y6vZrq5sHjaLhz44hztahlW1W9gB/hy1AB3V+bFtrnMIbOhuUTxDjJxlftE+91A5JvfYRSe6j+q1044caN3wMXcaSJiMmWaTKKS8F/uPQOBpvNrbsg4PXEhG9ZUYtZHHqiX+8cySXseV5dUrftJ3V89UR6kCoc00hUOLNchlqNdvqn0V+nKvGUekj1RB2ieaQxyIHv4NGCXIMudjnFSb5EZgUolWaO5Q0GpWVXP1BdwTmWS5IGVJO6F92pUBZofQ== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=microsoft.com; s=arcselector9901; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-AntiSpam-MessageData-ChunkCount:X-MS-Exchange-AntiSpam-MessageData-0:X-MS-Exchange-AntiSpam-MessageData-1; bh=xvDdV2wD3kAct/OCQawOHD6CkCKngznVXUMmhD6D4MQ=; b=I+QpUQWBWLr3cWkUQ4hNTrUZnkDAAOQZYoXuhnkHZ1I15wqAK0Q/daUQX3RL3btianXHPBJmgeQKcVoHN/Xx8UR3KKmtDaIZfQEWJWzXbJFFme3eaagPjr0R5NgsdDKBRjbxf5F8/urKbusFY8sS5GQ3xuaW3JM3USUAiNGuvB3B2VM8NHj+26jpYoVnhpyQ82dm7KBixoBhnvdWYcU0d/zLKj8beY7KV3rSc0d2pthUCgf+eCR8E95MFfsAu0Wqlx/de1a9uusu1SxWA5t3vLAosJJLoiHuaMB+J9/fgKQODMh7dd1Tei/nGOzz8QhYeUlQNts0FYXK5SAJ6AiAzg== ARC-Authentication-Results: i=1; mx.microsoft.com 1; spf=pass smtp.mailfrom=oss.nxp.com; dmarc=pass action=none header.from=oss.nxp.com; dkim=pass header.d=oss.nxp.com; arc=none DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=NXP1.onmicrosoft.com; s=selector2-NXP1-onmicrosoft-com; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-SenderADCheck; bh=xvDdV2wD3kAct/OCQawOHD6CkCKngznVXUMmhD6D4MQ=; b=lLCVVNSi4PoZ0txo2BTI4EqhADCxe4flkAHwnv0iNfUBHp9h42s0BdVeiJ0+IVyu4iyaPhdy8Mmzw5KNl5S2DRhRYMJsDSb1V7XrPeM0kCvRakL1BPXrudTVOraFPg6yIz4160iAzMl0Yviaba1u0UIpUiP3q9pKKTTNxNfLlgg= Authentication-Results: dkim=none (message not signed) header.d=none;dmarc=none action=none header.from=oss.nxp.com; Received: from DU0PR04MB9417.eurprd04.prod.outlook.com (2603:10a6:10:358::11) by PAXPR04MB8943.eurprd04.prod.outlook.com (2603:10a6:102:20e::14) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.6588.35; Thu, 20 Jul 2023 09:12:40 +0000 Received: from DU0PR04MB9417.eurprd04.prod.outlook.com ([fe80::c874:7c87:c13b:64f8]) by DU0PR04MB9417.eurprd04.prod.outlook.com ([fe80::c874:7c87:c13b:64f8%5]) with mapi id 15.20.6609.024; Thu, 20 Jul 2023 09:12:40 +0000 From: "Peng Fan (OSS)" To: ulf.hansson@linaro.org, shawnguo@kernel.org, s.hauer@pengutronix.de Cc: kernel@pengutronix.de, festevam@gmail.com, linux-imx@nxp.com, linux-arm-kernel@lists.infradead.org, linux-kernel@vger.kernel.org, linux-pm@vger.kernel.org, Peng Fan Subject: [PATCH V2 7/8] genpd: imx: scu-pd: add multi states support Date: Thu, 20 Jul 2023 17:17:00 +0800 Message-Id: <20230720091701.517197-8-peng.fan@oss.nxp.com> X-Mailer: git-send-email 2.37.1 In-Reply-To: <20230720091701.517197-1-peng.fan@oss.nxp.com> References: <20230720091701.517197-1-peng.fan@oss.nxp.com> X-ClientProxiedBy: SI2PR02CA0044.apcprd02.prod.outlook.com (2603:1096:4:196::17) To DU0PR04MB9417.eurprd04.prod.outlook.com (2603:10a6:10:358::11) MIME-Version: 1.0 X-MS-Exchange-MessageSentRepresentingType: 1 X-MS-PublicTrafficType: Email X-MS-TrafficTypeDiagnostic: DU0PR04MB9417:EE_|PAXPR04MB8943:EE_ X-MS-Office365-Filtering-Correlation-Id: 329b5d6b-9798-489c-76e3-08db8901780f X-MS-Exchange-SharedMailbox-RoutingAgent-Processed: True X-MS-Exchange-SenderADCheck: 1 X-MS-Exchange-AntiSpam-Relay: 0 X-Microsoft-Antispam: BCL:0; X-Microsoft-Antispam-Message-Info: 3cwFRirP03Nc3evVZE4MJM632tpsn2gD4Cx0DVQCrjvgbmwTupxEg73zQtQTUuBknYTd/ePMxYRZOZl2IXGjEuOujqpDp9VMYMDCrXS5PMOfPCNcu5+Vup9H4zKAvmLK4h64K8zY0YqQKorMq0rfr8lqFuq1W7GeJSnK4fFyl106BMSSe415OH7W8q13PuhSqYsBQokJm/eFCj6D/qkVq43sxf7PG9oXfVhpzBn09ud/IjPSIk0szRM2dkwv1MiTW5Mj85JMSnFCaCWw0062XbH3jNEqJ6Zspzp28fXadJci2V8ljYS+nLGJeKTIDcR3Bz3G0D9lIXqHIoXo7Rn0x8hhCwRHXiwKFMUDlZRwnf8//6ouh+vRqFYROq/BrEgqcpbre0Uji5dLTUrCNNuVPQrDgH5btKe2j0uHSgQmf6o/hhw3IFDbxGMrWEWbrdYHorljce/bteMnrZYsMeL/jH+j4pdXZjMIgGFzM7t7KX3tIwJoanekXtlCpd1C8OXkWEiH+/s6VfXQ6A8D7rjoQXZwhltWhw98kz1p5zbq3x8+zv59rJRRXdZlQOHcnzRKvYxlsXHgsQcnqQbhQhJx1UNGaUCH1qU1OLEsDcurzDGnmmbB07aLaGVFvyVSLMie X-Forefront-Antispam-Report: CIP:255.255.255.255;CTRY:;LANG:en;SCL:1;SRV:;IPV:NLI;SFV:NSPM;H:DU0PR04MB9417.eurprd04.prod.outlook.com;PTR:;CAT:NONE;SFS:(13230028)(4636009)(39860400002)(396003)(376002)(366004)(346002)(136003)(451199021)(66476007)(478600001)(41300700001)(26005)(186003)(1076003)(6506007)(6512007)(6486002)(6666004)(52116002)(316002)(4326008)(5660300002)(8936002)(66946007)(66556008)(8676002)(2906002)(2616005)(83380400001)(38100700002)(38350700002)(86362001);DIR:OUT;SFP:1101; X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1 X-MS-Exchange-AntiSpam-MessageData-0: G2l2FJ6zMEt2pC/G53yKw9imnj0de7Utr0AWGp6NIeS2sqlxRDE9NbeX+Yf/EjfIXe/DFGW2UJGGjrDFNcrbCoEH23UtH7uKqauU5fiZJD5YLUyi4qy2eqHHRSqz12smgC78epZP8bU7lYfxZGcj66EJVqEDkfmlMMnh1ITQtxXAo2oxbScgYD9G49iDFVZnEaZHVYgRKavKuqK7AvuFEY7aGZQ6/e7uzMB4fqLxZTCpfVkMbZegkGtk767E4Z0vUFplm9AeJYxn6SbTtqkNfSBlRU2alSTspOSrNwXMCaa6t+VpiCc69eR9itgTu7mRcbraRZOS/zZFlK6I223jjeF/dpHki9gRXFYR/GSrSHVGJWUgFxYdB4TBvzM8v+UcFVUmKjAP7c2KidACVkI3b2A2e8SbhjAb5CxuvTI9SWiWPcbFucIqhWHOSTH2t9Tb5auy7rNHXjzf7DlKYFTXZ9KSwn7T8XaZiXHE51NWws4Y3wr7CJTj9gv2tAZcwm7P/7iF2ovxr9LSyaQn9HmWFZ7HHBNdSBycKZH/iAlp3sADlxT+VMorKkFr9OzCazHy1wQnkjx7CoWULUgVWJf3ZqEqCA0gVkhCCZVHvoEWHCgznbDdGIEBSS9GhN4fHkyoygyo/sg0uexFGpCuwoLuUt6l936wOZSTcU7JtUfNaijqxRgWmnBYv2hjm1GggTXt9r26X1+T6X6paXdjEublX3S1XW1FvoLhPo8XUrv5LiSMGtgNAx9kTD7OZkX7SrMpRQKNSw7qZxgn30+00gP5zDJ2BG2NpXAExozxBkXMBVEvv5nQXUViSeg/t2lMXmHRlRVrCiuEcOqFi7pLXSosghVCWWMqIo0d/uTvJY5nsJVvT0h9do9ctEKcsUZSMitc+O2fc5XJZaHd1OEa781PwbbLYY8c1VJoJzk/3dWawfrRE5P7yGAwFYb4Fmb+ACkuOegDV8841TufFrjBkQiBtMwNNLN067PB11sp/VaSv8+I3FHkqKm09b4UgdLK5nPJDso283ecuee9+Al8n2YEJquEhzK/6lSMVV9BaoFldS5CD7bJ3AwuJT+fY0SUC7mW+UJUCRarQtNkicwCiJUhgQ2ntdaf+SE9uYDq1td7Qa9HSHFKBl3PoWfi/+JulVRJZpL2r151NYibAXHhpqhFzg0OQOkfwHwwfK0vGtv/87V532vqI9ubOAB6fBHD8v8hLDsIp7lGnYQTN0O14S3I9/L8uX/zRtQrL+zQzM4j7KlzjsRcx9A/bcjOrXWdOEp1HZVjo0ug1nU8bFvT0SUdhiPTP+yNYqo13OG8AYSO2oMryXERsRisR4P0NdsW3IZgKczWP/P9jRw0qfYYjhVwvmZj07+fn7oGGYiMSf1kNREhSkzrx1AXmcTt6/fCwXBQ0Dj+r03+xQ2us3PI7eTubyMEYVZArX+zZ3Ilql1aaCdW4/VIvLU4J8wulBvLlxysmX215fNpexv3f/yFJhvVwtIW0s9TMGfwVhSN1HfbxhubfpAowaJKcwgZQYQI+YXGEbG6QrmQf4YMhQuXaHydr9Sv+36lBf4LMPeVD3fGaHaY8FV/dDBdl1e37anAhd5u X-OriginatorOrg: oss.nxp.com X-MS-Exchange-CrossTenant-Network-Message-Id: 329b5d6b-9798-489c-76e3-08db8901780f X-MS-Exchange-CrossTenant-AuthSource: DU0PR04MB9417.eurprd04.prod.outlook.com X-MS-Exchange-CrossTenant-AuthAs: Internal X-MS-Exchange-CrossTenant-OriginalArrivalTime: 20 Jul 2023 09:12:40.6981 (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: ruie3O2qQZRnB1hpko4gLKEq/w/MJrMVhXE9bmivdNjsvFLJb03dwvT28ahawDMq64J2rDq1Ox26IFPejTXXPA== X-MS-Exchange-Transport-CrossTenantHeadersStamped: PAXPR04MB8943 X-Spam-Status: No, score=-1.9 required=5.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,RCVD_IN_DNSWL_NONE,RCVD_IN_MSPIKE_H2,SPF_HELO_PASS,SPF_PASS, T_SCC_BODY_TEXT_LINE 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: X-Mailing-List: linux-kernel@vger.kernel.org X-getmail-retrieved-from-mailbox: INBOX X-GMAIL-THRID: 1771931418968315048 X-GMAIL-MSGID: 1771931418968315048 From: Peng Fan Add multi states support, this is to support devices could run in LP mode when runtime suspend, and OFF mode when system suspend. Signed-off-by: Peng Fan --- drivers/genpd/imx/scu-pd.c | 48 ++++++++++++++++++++++++++++++++++++-- 1 file changed, 46 insertions(+), 2 deletions(-) diff --git a/drivers/genpd/imx/scu-pd.c b/drivers/genpd/imx/scu-pd.c index 763af1ac454d..31de56366a50 100644 --- a/drivers/genpd/imx/scu-pd.c +++ b/drivers/genpd/imx/scu-pd.c @@ -65,6 +65,12 @@ #include #include +enum { + PD_STATE_LP, + PD_STATE_OFF, + PD_STATE_MAX +}; + /* SCU Power Mode Protocol definition */ struct imx_sc_msg_req_set_resource_power_mode { struct imx_sc_rpc_msg hdr; @@ -368,7 +374,8 @@ static int imx_sc_pd_power(struct generic_pm_domain *domain, bool power_on) hdr->size = 2; msg.resource = pd->rsrc; - msg.mode = power_on ? IMX_SC_PM_PW_MODE_ON : IMX_SC_PM_PW_MODE_LP; + msg.mode = power_on ? IMX_SC_PM_PW_MODE_ON : pd->pd.state_idx ? + IMX_SC_PM_PW_MODE_OFF : IMX_SC_PM_PW_MODE_LP; /* keep uart console power on for no_console_suspend */ if (imx_con_rsrc == pd->rsrc && !console_suspend_enabled && !power_on) @@ -412,11 +419,33 @@ static struct generic_pm_domain *imx_scu_pd_xlate(struct of_phandle_args *spec, return domain; } +static bool imx_sc_pd_suspend_ok(struct device *dev) +{ + /* Always true */ + return true; +} + +static bool imx_sc_pd_power_down_ok(struct dev_pm_domain *pd) +{ + struct generic_pm_domain *genpd = pd_to_genpd(pd); + + /* For runtime suspend, choose LP mode */ + genpd->state_idx = 0; + + return true; +} + +struct dev_power_governor imx_sc_pd_qos_governor = { + .suspend_ok = imx_sc_pd_suspend_ok, + .power_down_ok = imx_sc_pd_power_down_ok, +}; + static struct imx_sc_pm_domain * imx_scu_add_pm_domain(struct device *dev, int idx, const struct imx_sc_pd_range *pd_ranges) { struct imx_sc_pm_domain *sc_pd; + struct genpd_power_state *states; bool is_off; int mode, ret; @@ -427,9 +456,22 @@ imx_scu_add_pm_domain(struct device *dev, int idx, if (!sc_pd) return ERR_PTR(-ENOMEM); + states = devm_kcalloc(dev, PD_STATE_MAX, sizeof(*states), GFP_KERNEL); + if (!states) { + devm_kfree(dev, sc_pd); + return ERR_PTR(-ENOMEM); + } + sc_pd->rsrc = pd_ranges->rsrc + idx; sc_pd->pd.power_off = imx_sc_pd_power_off; sc_pd->pd.power_on = imx_sc_pd_power_on; + states[PD_STATE_LP].power_off_latency_ns = 25000; + states[PD_STATE_LP].power_on_latency_ns = 25000; + states[PD_STATE_OFF].power_off_latency_ns = 2500000; + states[PD_STATE_OFF].power_on_latency_ns = 2500000; + + sc_pd->pd.states = states; + sc_pd->pd.state_count = PD_STATE_MAX; if (pd_ranges->postfix) snprintf(sc_pd->name, sizeof(sc_pd->name), @@ -455,14 +497,16 @@ imx_scu_add_pm_domain(struct device *dev, int idx, sc_pd->name, sc_pd->rsrc); devm_kfree(dev, sc_pd); + devm_kfree(dev, states); return NULL; } - ret = pm_genpd_init(&sc_pd->pd, NULL, is_off); + ret = pm_genpd_init(&sc_pd->pd, &imx_sc_pd_qos_governor, is_off); if (ret) { dev_warn(dev, "failed to init pd %s rsrc id %d", sc_pd->name, sc_pd->rsrc); devm_kfree(dev, sc_pd); + devm_kfree(dev, states); return NULL; }