From patchwork Tue Nov 24 05:43:05 2015 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Jisheng Zhang X-Patchwork-Id: 7687631 Return-Path: X-Original-To: patchwork-linux-arm@patchwork.kernel.org Delivered-To: patchwork-parsemail@patchwork2.web.kernel.org Received: from mail.kernel.org (mail.kernel.org [198.145.29.136]) by patchwork2.web.kernel.org (Postfix) with ESMTP id D7897BF90C for ; Tue, 24 Nov 2015 05:49:03 +0000 (UTC) Received: from mail.kernel.org (localhost [127.0.0.1]) by mail.kernel.org (Postfix) with ESMTP id D220020382 for ; Tue, 24 Nov 2015 05:49:02 +0000 (UTC) Received: from bombadil.infradead.org (bombadil.infradead.org [198.137.202.9]) (using TLSv1.2 with cipher AES128-GCM-SHA256 (128/128 bits)) (No client certificate requested) by mail.kernel.org (Postfix) with ESMTPS id EC7CB20849 for ; Tue, 24 Nov 2015 05:49:01 +0000 (UTC) Received: from localhost ([127.0.0.1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.80.1 #2 (Red Hat Linux)) id 1a16Rg-0004mn-LO; Tue, 24 Nov 2015 05:47:16 +0000 Received: from mx0b-0016f401.pphosted.com ([67.231.156.173]) by bombadil.infradead.org with esmtps (Exim 4.80.1 #2 (Red Hat Linux)) id 1a16Rc-0004hm-TA for linux-arm-kernel@lists.infradead.org; Tue, 24 Nov 2015 05:47:13 +0000 Received: from pps.filterd (m0045851.ppops.net [127.0.0.1]) by mx0b-0016f401.pphosted.com (8.15.0.59/8.15.0.59) with SMTP id tAO5kFG5019533; Mon, 23 Nov 2015 21:46:47 -0800 Received: from sc-exch02.marvell.com ([199.233.58.182]) by mx0b-0016f401.pphosted.com with ESMTP id 1ybwfa3063-1 (version=TLSv1/SSLv3 cipher=ECDHE-RSA-AES256-SHA bits=256 verify=NOT); Mon, 23 Nov 2015 21:46:47 -0800 Received: from SC-EXCH01.marvell.com (10.93.176.81) by SC-EXCH02.marvell.com (10.93.176.82) with Microsoft SMTP Server (TLS) id 15.0.1044.25; Mon, 23 Nov 2015 21:46:45 -0800 Received: from maili.marvell.com (10.93.176.43) by SC-EXCH01.marvell.com (10.93.176.81) with Microsoft SMTP Server id 15.0.1044.25 via Frontend Transport; Mon, 23 Nov 2015 21:46:45 -0800 Received: from xhacker.marvell.com (unknown [10.37.135.134]) by maili.marvell.com (Postfix) with ESMTP id 5A3713F703F; Mon, 23 Nov 2015 21:46:44 -0800 (PST) From: Jisheng Zhang To: , , Subject: [PATCH] pwm: berlin: Add PM support Date: Tue, 24 Nov 2015 13:43:05 +0800 Message-ID: <1448343785-1540-1-git-send-email-jszhang@marvell.com> X-Mailer: git-send-email 2.6.2 MIME-Version: 1.0 X-Proofpoint-Virus-Version: vendor=fsecure engine=2.50.10432:, , definitions=2015-11-24_04:, , signatures=0 X-Proofpoint-Spam-Details: rule=inbound_notspam policy=inbound score=0 spamscore=0 suspectscore=0 malwarescore=0 phishscore=0 adultscore=0 bulkscore=0 classifier=spam adjust=0 reason=mlx scancount=1 engine=8.0.1-1507310000 definitions=main-1511240109 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20151123_214713_107553_C43E4776 X-CRM114-Status: GOOD ( 13.75 ) X-Spam-Score: -2.6 (--) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.20 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: Jisheng Zhang , linux-pwm@vger.kernel.org, linux-kernel@vger.kernel.org, linux-arm-kernel@lists.infradead.org Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+patchwork-linux-arm=patchwork.kernel.org@lists.infradead.org X-Spam-Status: No, score=-4.8 required=5.0 tests=BAYES_00, RCVD_IN_DNSWL_MED, RP_MATCHES_RCVD, UNPARSEABLE_RELAY autolearn=unavailable version=3.3.1 X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on mail.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP This patch adds S2R support for berlin pwm driver. Signed-off-by: Jisheng Zhang --- drivers/pwm/pwm-berlin.c | 57 +++++++++++++++++++++++++++++++++++++++++++++++- 1 file changed, 56 insertions(+), 1 deletion(-) diff --git a/drivers/pwm/pwm-berlin.c b/drivers/pwm/pwm-berlin.c index 6510812..2afdb40 100644 --- a/drivers/pwm/pwm-berlin.c +++ b/drivers/pwm/pwm-berlin.c @@ -27,10 +27,20 @@ #define BERLIN_PWM_TCNT 0xc #define BERLIN_PWM_MAX_TCNT 65535 +#define NUM_PWM_CHANNEL 4 /* berlin PWM channels */ + +struct berlin_pwm_context { + u32 enable; + u32 ctrl; + u32 duty; + u32 tcnt; +}; + struct berlin_pwm_chip { struct pwm_chip chip; struct clk *clk; void __iomem *base; + struct berlin_pwm_context ctx[NUM_PWM_CHANNEL]; }; static inline struct berlin_pwm_chip *to_berlin_pwm_chip(struct pwm_chip *chip) @@ -176,7 +186,7 @@ static int berlin_pwm_probe(struct platform_device *pdev) pwm->chip.dev = &pdev->dev; pwm->chip.ops = &berlin_pwm_ops; pwm->chip.base = -1; - pwm->chip.npwm = 4; + pwm->chip.npwm = NUM_PWM_CHANNEL; pwm->chip.can_sleep = true; pwm->chip.of_xlate = of_pwm_xlate_with_flags; pwm->chip.of_pwm_n_cells = 3; @@ -204,12 +214,57 @@ static int berlin_pwm_remove(struct platform_device *pdev) return ret; } +#ifdef CONFIG_PM_SLEEP +static int berlin_pwm_suspend(struct device *dev) +{ + int i; + struct berlin_pwm_chip *pwm = dev_get_drvdata(dev); + + for (i = 0; i < pwm->chip.npwm; i++) { + struct berlin_pwm_context *ctx = &pwm->ctx[i]; + + ctx->enable = berlin_pwm_readl(pwm, i, BERLIN_PWM_ENABLE); + ctx->ctrl = berlin_pwm_readl(pwm, i, BERLIN_PWM_CONTROL); + ctx->duty = berlin_pwm_readl(pwm, i, BERLIN_PWM_DUTY); + ctx->tcnt = berlin_pwm_readl(pwm, i, BERLIN_PWM_TCNT); + } + clk_disable_unprepare(pwm->clk); + + return 0; +} + +static int berlin_pwm_resume(struct device *dev) +{ + int i; + struct berlin_pwm_chip *pwm = dev_get_drvdata(dev); + + clk_prepare_enable(pwm->clk); + for (i = 0; i < pwm->chip.npwm; i++) { + struct berlin_pwm_context *ctx = &pwm->ctx[i]; + + berlin_pwm_writel(pwm, i, ctx->ctrl, BERLIN_PWM_CONTROL); + berlin_pwm_writel(pwm, i, ctx->duty, BERLIN_PWM_DUTY); + berlin_pwm_writel(pwm, i, ctx->tcnt, BERLIN_PWM_TCNT); + berlin_pwm_writel(pwm, i, ctx->enable, BERLIN_PWM_ENABLE); + } + + return 0; +} + +static SIMPLE_DEV_PM_OPS(berlin_pwm_pm_ops, berlin_pwm_suspend, + berlin_pwm_resume); +#define BERLIN_PWM_PM_OPS (&berlin_pwm_pm_ops) +#else +#define BERLIN_PWM_PM_OPS NULL +#endif + static struct platform_driver berlin_pwm_driver = { .probe = berlin_pwm_probe, .remove = berlin_pwm_remove, .driver = { .name = "berlin-pwm", .of_match_table = berlin_pwm_match, + .pm = BERLIN_PWM_PM_OPS, }, }; module_platform_driver(berlin_pwm_driver);