From patchwork Mon Oct 2 09:49:01 2017 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Ed Blake X-Patchwork-Id: 820402 Return-Path: X-Original-To: incoming@patchwork.ozlabs.org Delivered-To: patchwork-incoming@bilbo.ozlabs.org Authentication-Results: ozlabs.org; spf=none (mailfrom) smtp.mailfrom=vger.kernel.org (client-ip=209.132.180.67; helo=vger.kernel.org; envelope-from=linux-i2c-owner@vger.kernel.org; receiver=) Authentication-Results: ozlabs.org; dkim=pass (1024-bit key; unprotected) header.d=sondrel.onmicrosoft.com header.i=@sondrel.onmicrosoft.com header.b="Ob6KdP0f"; dkim-atps=neutral Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by ozlabs.org (Postfix) with ESMTP id 3y5HSR6NlKz9t3f for ; Mon, 2 Oct 2017 20:49:27 +1100 (AEDT) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1750969AbdJBJt0 (ORCPT ); Mon, 2 Oct 2017 05:49:26 -0400 Received: from mail-eopbgr50045.outbound.protection.outlook.com ([40.107.5.45]:23712 "EHLO EUR03-VE1-obe.outbound.protection.outlook.com" rhost-flags-OK-OK-OK-FAIL) by vger.kernel.org with ESMTP id S1750878AbdJBJtZ (ORCPT ); Mon, 2 Oct 2017 05:49:25 -0400 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=sondrel.onmicrosoft.com; s=selector1-sondrel-com; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version; bh=YZNEG3wwzCstnQTQumph0Q389XSemA1WWd0vwERrMwg=; b=Ob6KdP0fRFgv9pXkXh64TEYBtWJgb77+9o0THt2vcr1kMAXn2Bot3Izj1NOo2uNDBFItV2ZXI1w4MOSZ7Y3Ur8RRPQ/0UmtEur6dbvCcc4iOJs1f9NuAmIP2dVIPzJz/rRYOACv4DwCJIttUK2hXVWy3I4E0lWxPdpWWJ/coLe4= Authentication-Results: spf=none (sender IP is ) smtp.mailfrom=ed.blake@sondrel.com; Received: from iw-build-2.sondrel.com (195.88.9.101) by AM4P191MB0002.EURP191.PROD.OUTLOOK.COM (2603:10a6:200:64::10) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_CBC_SHA384_P256) id 15.20.77.7; Mon, 2 Oct 2017 09:49:23 +0000 From: Ed Blake To: wsa@the-dreams.de Cc: linux-i2c@vger.kernel.org, Ed Blake Subject: [PATCH] i2c: img-scb: Add runtime PM Date: Mon, 2 Oct 2017 10:49:01 +0100 Message-Id: <1506937741-32748-1-git-send-email-ed.blake@sondrel.com> X-Mailer: git-send-email 1.9.1 MIME-Version: 1.0 X-Originating-IP: [195.88.9.101] X-ClientProxiedBy: DB6PR06CA0003.eurprd06.prod.outlook.com (2603:10a6:6:1::16) To AM4P191MB0002.EURP191.PROD.OUTLOOK.COM (2603:10a6:200:64::10) X-MS-PublicTrafficType: Email X-MS-Office365-Filtering-Correlation-Id: 6677a84c-dcde-4e1a-6b6d-08d5097adc79 X-Microsoft-Antispam: UriScan:; BCL:0; PCL:0; RULEID:(22001)(2017030254152)(2017052603199)(201703131423075)(201703031133081)(201702281549075); SRVR:AM4P191MB0002; X-Microsoft-Exchange-Diagnostics: 1; AM4P191MB0002; 3:Rd86TPHpIcFJPi+LBSuiqWPx/6Nt7p2yizxil/XXfKX1yyULB5HLMZu1IWv5Ffcy4TRhZBAf6q6NLVPl5Hi9c4GdtOPhIASZC/vPpJxWfh0ZMJ2dE3YyAMn1C/1YLBltYi2asfTKcYr1b7xYBR2ofSknepTg5MLB8Q9Kp1ivfDLyikaumJLrqZSSuoCzVQIuBj/petdzB4MuEeSNMVF/revKFP4G3QBHl5SVbqplaf0Ke0cVamOzTUGfICBlJ9NJ; 25:NybB1wac7k1B02mjHIL1vMm7VUqfEwrPX9xi1CZCYZJMzUCgSDCR3blSNDHBIqULJvpBDFm4/3UmGwqsqo3Cb0wXFHm5ibi1ddc5wtjkx09zdLQdOI0kdNAVHOjZerexWAebFKgJ0ND3m9QbG5V/WhybCsNNaEAIK+SQIY6rRDsBC/HasVGioDwaImOOdqoZVMfxkaJxZf/ezn3TRp3IpbvHvS3LQt2mvGmbCeGmQiD953rnHP89Her4xg+R8I4OVd7+1HWuoycXxCAZz+nPYomFDyKdMskgAG5AQhRI0g5bm/Dcw6w/h4XxOqR89MuBMzZ4Hv70s7ZirCQFmI+hTA==; 31:/lWy07vIcI6HdcFfZSCUnJCrAMVbdALlgIA9mjySpEmLpEVUNzsxjUjBlPR3UYqhVyInJyjYN00+fu78Ir+90SM9nRemYRivJApoUYcN7ba3Ye0Gsr6UM05yyTNch35i9yYroEPLP5Cziu+kxkAG+RpVJLoNcO5FmwhmtY3e3AMGKhGkTxb0fuPnK/DmNSoVha4AtVehOhtKMwKep6cz1yXgSS+mQTNsVL93f3ptuPI= X-MS-TrafficTypeDiagnostic: AM4P191MB0002: X-Microsoft-Exchange-Diagnostics: 1; AM4P191MB0002; 20:gbdGRMcMjk1ljtlagbdzXX83sxB+/JxboUp55PcjlkxJdbeWRahfVKvAIQ04Oc+iuwim5r0L8DbJ+CM1GyVUXJnIndMA+pG/srcAtBoD8RKBZSlxTV7BmbaABZoPRcLihSXGYgRhajRIKbrEYBfFarYjo6EbAzU7xRDTIE3ykuuJ1YS/E6l2hH84O0GuyESLekYjFySgjOK5AvUAee3kJButyKIYTyeVenI4qLI0oFSMYCKbaTiLi6U/KrUJqJXX; 4:+ScF0cuccFfRK3NMOde4cL34HiqN7sZqHUeEQUlANsx0HYIGcQF+B+xHe1oeNhA8zfaz4mnX+8QFFUnxC6RJyQWmOiSi50HsEDSSX3PSPEcU0xQ71Tqu0hXn6OtxQpL/sArNYVSKgrqwnGQ7dzA1rri81HahqOR+oi3rAB2kLvbpoErCe0GOHUAK6Zm8UkPjyuRQvF5TlRg2KAQngHaBoL4BtKGzLnBjKdsRzsEn29j2hHOkXMZ1vqr/wq22JiLu X-Exchange-Antispam-Report-Test: UriScan:; X-Microsoft-Antispam-PRVS: X-Exchange-Antispam-Report-CFA-Test: BCL:0; PCL:0; RULEID:(100000700101)(100105000095)(100000701101)(100105300095)(100000702101)(100105100095)(6040450)(2401047)(5005006)(8121501046)(10201501046)(100000703101)(100105400095)(3002001)(93006095)(93001095)(6041248)(20161123560025)(20161123564025)(201703131423075)(201702281528075)(201703061421075)(201703061406153)(20161123558100)(20161123562025)(20161123555025)(6072148)(201708071742011)(100000704101)(100105200095)(100000705101)(100105500095); SRVR:AM4P191MB0002; BCL:0; PCL:0; RULEID:(100000800101)(100110000095)(100000801101)(100110300095)(100000802101)(100110100095)(100000803101)(100110400095)(100000804101)(100110200095)(100000805101)(100110500095); SRVR:AM4P191MB0002; X-Forefront-PRVS: 0448A97BF2 X-Forefront-Antispam-Report: SFV:NSPM; SFS:(10009020)(979002)(6009001)(346002)(376002)(39830400002)(23433003)(199003)(189002)(53416004)(5003940100001)(66066001)(50466002)(53936002)(4326008)(2906002)(81156014)(7736002)(8676002)(6666003)(81166006)(5660300001)(305945005)(47776003)(6486002)(69596002)(86362001)(478600001)(189998001)(8936002)(36756003)(25786009)(16526017)(2361001)(16586007)(316002)(50986999)(50226002)(97736004)(48376002)(101416001)(33646002)(3846002)(6116002)(68736007)(107886003)(6916009)(105586002)(106356001)(2351001)(969003)(989001)(999001)(1009001)(1019001); DIR:OUT; SFP:1101; SCL:1; SRVR:AM4P191MB0002; H:iw-build-2.sondrel.com; FPR:; SPF:None; PTR:InfoNoRecords; A:1; MX:1; LANG:en; Received-SPF: None (protection.outlook.com: sondrel.com does not designate permitted sender hosts) X-Microsoft-Exchange-Diagnostics: 1; AM4P191MB0002; 23:pfj6m9Qp0SlBXgPLDvBVNZN/i9fHrjPzDfXYf46ip95yLDkxeF4erRiOmKrjne3XMbvbuSQcadzZyLJDKO+zqT2aZxWaIGC63gL+yxDhHR+rrQ8HOK+bCZM2g7t0NKC5yL8UVayG51LZvF8V0ILp5D46M/jFi6aRH0UOq+n6c6jXs9E0+b/wbSEA57GV31kV+01WZEZX7HlfOUEeTHZXrY1/KCnNZnueB8leb4MtjKZctNqnaJ6UfEemRW69EV/U49dbT74WoCrcNlaQU5YadNLe3jQCrmTYg/Tpqe3+5qDMhyyQNLEcrD3poA8w2XAcsiSBJyvskwQSU4tAE80n9J9hZk6qe0QwZiE2CL9HnG23cgOvQKqO//QWmrNnPZ/jQZW4FlfbHay9aB/YR3l2NuHYRiztUH1wP1R8aok3inGvh3FJAOjUDatKB4wenKFFABTh/fu68rzk1MnTdpzrEiMuOsFzZRUqmh+yKVXCMnS29+dUtjFDKEAowUKDvRnafvLKzaSfB4MvEz5afogKCqdJMESRFBZx1cefwmzKxl/tLsJ7fMVutQDE81luI1rE+5y8OZfdx1Wq1XtyYAzzpXFB4ObFQBCEzyLt6rMAWicK5sVKnzE7iM1mwjxDTkQM/fyPipiYgYdPFjUd7dThLsTviwxDLvzURzdeKuUqFZV4yxI2BPPzWlK9ltG48fwAO68EnPBNV8nOiEq6rKtiiNvOUvDv/ONO09t35FaZw8OnGzD7A9OfIfTUdmaWNpqba1E0eVRhKzNDiAfeq4rnX6r/fKl+IUZ8V939P/MscrKwROggP0ElZhiRpQ3uQ+cCJvVElH71PlTa5lsxllziFJL1+8rwzO7rcs1Aj/mFmZvSwi0WMyo2mKrJAOcfGb6RF6RMpks43zDIILLeYSn1kASuM+Keg981gv7+Ah1gCCnbaad30SPfGF59frlMONe1N1BnrgLj8L9cMWV/29luPqBKX28MtKI1cq3PDlR7QiKVdMdW69lrlGe/JmvIWeV5jj6bONh0ZrqGs99oAcofFDnvGjonib+dOYen7P74HLYniuzkhnzTn4zWYoY7zNILjrsuSXydd8axBg0/CaFZvE/DBXuXCTwsF3992yk8IFAQPTVQay2jjJj+NFFTrunAS31vB0QFlx82yKX9K+bAFP7UMgd6YR5fEl2UbFq172hrABeD603dX8UCpJN7OmQ/Cy3q04Lc8yCL7dJ0375PKg== X-Microsoft-Exchange-Diagnostics: 1; AM4P191MB0002; 6:YdEg2H5GSfq8zdpIwtZ4x2ao4cx0AFVUT9gZTbg2VgqC4S0geJlSBFFoUIK6zpSkGEyrpeDH/LvyZXgJA83yMVzHHhGCQjeaaXWxAZfzn2cRyAWyVAuOERuC0abk4F9MR4mdcd5WP2vGv2zjjHrVdHzCLO5TDKGTD0c/+uQRQW/NlwuL2fokxTHH4CZFwfBPpzYsAVHub6vcdqTPj/WO+/tuJAQp2rl3w3Fu9LxAwKMR/QtzeYAG6CZISoyGZlj9v2UYzgua2MOIyJ7MCijLxJgr4ynTC/uSw85dsNPUxACnK6Z9ZfrqtCQY0LzKvFxYMOtpaAZ+V/snH2Y0TD03Ig==; 5:ydOlGF3Ps2UBnzlpP/AUn5VVT+Q3h6QNenub/K9EG/hZnwT/7MZ7wd3T0evKMpWdEbw0DtVeJ5OkrTrP7gexxrel9lZm018XIETekko9ZGGMUga3VaoG+PuiLWSOlpr1DX5SZiLPwsJPTmDz8ZfVYQ==; 24:gzzFQ1JQG8sABjQLIq97gK+sRKH1sBrSx6T/DnW9h2dn2HNIjrDpzA/ppbRtsOaRHLoA3dfiJE+jUDXEGFSVC/qMFcf6GqTMWJlVggTWCy0=; 7:FIoOypSSR36nT8KWtfggQ2V7srRfnbstdaHdle8H45+t7sIyIU/wb4OHf9wZJ8C67czJGb+Fu7lbZvu8hFlZp0xmdylj2Vwoxn5FGeudR2pax+zBPrOojaHtBqTaDDVgqX0j5gfT9nFApgSjOsyTCvPgIj8wjDzPSKzhXVouUvik3LP1vPArT1wmY8v11hvZpBDINmnZo03obCpbzrwDvMWZPFS5W8B0HvQEOTt9gnE= SpamDiagnosticOutput: 1:99 SpamDiagnosticMetadata: NSPM X-OriginatorOrg: sondrel.com X-MS-Exchange-CrossTenant-OriginalArrivalTime: 02 Oct 2017 09:49:23.0366 (UTC) X-MS-Exchange-CrossTenant-FromEntityHeader: Hosted X-MS-Exchange-CrossTenant-Id: 4faa3872-698e-4896-80ec-148b916cb1ba X-MS-Exchange-Transport-CrossTenantHeadersStamped: AM4P191MB0002 Sender: linux-i2c-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-i2c@vger.kernel.org The i2c-img-scb driver already dynamically enables / disables clocks to save power, but doesn't use the runtime PM framework. Convert the driver to use runtime PM, so that dynamic clock management will be disabled when runtime PM is disabled, and so that autosuspend can be used to avoid unnecessarily disabling and re-enabling clocks repeatedly during a sequence of transactions. Signed-off-by: Ed Blake --- drivers/i2c/busses/i2c-img-scb.c | 94 ++++++++++++++++++++++++++++++++-------- 1 file changed, 76 insertions(+), 18 deletions(-) diff --git a/drivers/i2c/busses/i2c-img-scb.c b/drivers/i2c/busses/i2c-img-scb.c index 84fb35f..4e58b3b 100644 --- a/drivers/i2c/busses/i2c-img-scb.c +++ b/drivers/i2c/busses/i2c-img-scb.c @@ -82,6 +82,7 @@ #include #include #include +#include #include #include @@ -280,6 +281,8 @@ #define ISR_COMPLETE(err) (ISR_COMPLETE_M | (ISR_STATUS_M & (err))) #define ISR_FATAL(err) (ISR_COMPLETE(err) | ISR_FATAL_M) +#define IMG_I2C_PM_TIMEOUT 1000 /* ms */ + enum img_i2c_mode { MODE_INACTIVE, MODE_RAW, @@ -408,6 +411,9 @@ struct img_i2c { unsigned int raw_timeout; }; +static int img_i2c_runtime_suspend(struct device *dev); +static int img_i2c_runtime_resume(struct device *dev); + static void img_i2c_writel(struct img_i2c *i2c, u32 offset, u32 value) { writel(value, i2c->base + offset); @@ -1054,8 +1060,8 @@ static int img_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs, atomic = true; } - ret = clk_prepare_enable(i2c->scb_clk); - if (ret) + ret = pm_runtime_get_sync(adap->dev.parent); + if (ret < 0) return ret; for (i = 0; i < num; i++) { @@ -1131,7 +1137,8 @@ static int img_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs, break; } - clk_disable_unprepare(i2c->scb_clk); + pm_runtime_mark_last_busy(adap->dev.parent); + pm_runtime_put_autosuspend(adap->dev.parent); return i2c->msg_status ? i2c->msg_status : num; } @@ -1153,8 +1160,8 @@ static int img_i2c_init(struct img_i2c *i2c) struct img_i2c_timings timing; u32 rev; - ret = clk_prepare_enable(i2c->scb_clk); - if (ret) + ret = pm_runtime_get_sync(i2c->adap.dev.parent); + if (ret < 0) return ret; rev = img_i2c_readl(i2c, SCB_CORE_REV_REG); @@ -1163,7 +1170,8 @@ static int img_i2c_init(struct img_i2c *i2c) "Unknown hardware revision (%d.%d.%d.%d)\n", (rev >> 24) & 0xff, (rev >> 16) & 0xff, (rev >> 8) & 0xff, rev & 0xff); - clk_disable_unprepare(i2c->scb_clk); + pm_runtime_mark_last_busy(i2c->adap.dev.parent); + pm_runtime_put_autosuspend(i2c->adap.dev.parent); return -EINVAL; } @@ -1314,7 +1322,8 @@ static int img_i2c_init(struct img_i2c *i2c) /* Perform a synchronous sequence to reset the bus */ ret = img_i2c_reset_bus(i2c); - clk_disable_unprepare(i2c->scb_clk); + pm_runtime_mark_last_busy(i2c->adap.dev.parent); + pm_runtime_put_autosuspend(i2c->adap.dev.parent); return ret; } @@ -1384,22 +1393,30 @@ static int img_i2c_probe(struct platform_device *pdev) platform_set_drvdata(pdev, i2c); - ret = clk_prepare_enable(i2c->sys_clk); - if (ret) - return ret; + pm_runtime_set_autosuspend_delay(&pdev->dev, IMG_I2C_PM_TIMEOUT); + pm_runtime_use_autosuspend(&pdev->dev); + pm_runtime_enable(&pdev->dev); + if (!pm_runtime_enabled(&pdev->dev)) { + ret = img_i2c_runtime_resume(&pdev->dev); + if (ret) + return ret; + } ret = img_i2c_init(i2c); if (ret) - goto disable_clk; + goto rpm_disable; ret = i2c_add_numbered_adapter(&i2c->adap); if (ret < 0) - goto disable_clk; + goto rpm_disable; return 0; -disable_clk: - clk_disable_unprepare(i2c->sys_clk); +rpm_disable: + if (!pm_runtime_enabled(&pdev->dev)) + img_i2c_runtime_suspend(&pdev->dev); + pm_runtime_disable(&pdev->dev); + pm_runtime_dont_use_autosuspend(&pdev->dev); return ret; } @@ -1408,19 +1425,55 @@ static int img_i2c_remove(struct platform_device *dev) struct img_i2c *i2c = platform_get_drvdata(dev); i2c_del_adapter(&i2c->adap); + pm_runtime_disable(&dev->dev); + if (!pm_runtime_status_suspended(&dev->dev)) + img_i2c_runtime_suspend(&dev->dev); + + return 0; +} + +static int img_i2c_runtime_suspend(struct device *dev) +{ + struct img_i2c *i2c = dev_get_drvdata(dev); + + clk_disable_unprepare(i2c->scb_clk); clk_disable_unprepare(i2c->sys_clk); return 0; } +static int img_i2c_runtime_resume(struct device *dev) +{ + struct img_i2c *i2c = dev_get_drvdata(dev); + int ret; + + ret = clk_prepare_enable(i2c->sys_clk); + if (ret) { + dev_err(dev, "Unable to enable sys clock\n"); + return ret; + } + + ret = clk_prepare_enable(i2c->scb_clk); + if (ret) { + dev_err(dev, "Unable to enable scb clock\n"); + clk_disable_unprepare(i2c->sys_clk); + return ret; + } + + return 0; +} + #ifdef CONFIG_PM_SLEEP static int img_i2c_suspend(struct device *dev) { struct img_i2c *i2c = dev_get_drvdata(dev); + int ret; - img_i2c_switch_mode(i2c, MODE_SUSPEND); + ret = pm_runtime_force_suspend(dev); + if (ret) + return ret; - clk_disable_unprepare(i2c->sys_clk); + img_i2c_switch_mode(i2c, MODE_SUSPEND); return 0; } @@ -1430,7 +1483,7 @@ static int img_i2c_resume(struct device *dev) struct img_i2c *i2c = dev_get_drvdata(dev); int ret; - ret = clk_prepare_enable(i2c->sys_clk); + ret = pm_runtime_force_resume(dev); if (ret) return ret; @@ -1440,7 +1493,12 @@ static int img_i2c_resume(struct device *dev) } #endif /* CONFIG_PM_SLEEP */ -static SIMPLE_DEV_PM_OPS(img_i2c_pm, img_i2c_suspend, img_i2c_resume); +static const struct dev_pm_ops img_i2c_pm = { + SET_RUNTIME_PM_OPS(img_i2c_runtime_suspend, + img_i2c_runtime_resume, + NULL) + SET_SYSTEM_SLEEP_PM_OPS(img_i2c_suspend, img_i2c_resume) +}; static const struct of_device_id img_scb_i2c_match[] = { { .compatible = "img,scb-i2c" },