From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1036321AbdDUH6V (ORCPT ); Fri, 21 Apr 2017 03:58:21 -0400 Received: from mail-by2nam01on0044.outbound.protection.outlook.com ([104.47.34.44]:1330 "EHLO NAM01-BY2-obe.outbound.protection.outlook.com" rhost-flags-OK-OK-OK-FAIL) by vger.kernel.org with ESMTP id S1036151AbdDUH5l (ORCPT ); Fri, 21 Apr 2017 03:57:41 -0400 Authentication-Results: spf=fail (sender IP is 192.88.168.50) smtp.mailfrom=nxp.com; nxp.com; dkim=none (message not signed) header.d=none;nxp.com; dmarc=fail action=none header.from=nxp.com; From: To: CC: , Wang Dongsheng , Zhang Ying-22455 Subject: [PATCH 2/5] soc: fsl: add flextimer module alarm driver for Layerscape Date: Fri, 21 Apr 2017 15:42:44 +0800 Message-ID: <1492760567-27894-2-git-send-email-ying.zhang22455@nxp.com> X-Mailer: git-send-email 2.1.0.27.g96db324 In-Reply-To: <1492760567-27894-1-git-send-email-ying.zhang22455@nxp.com> References: <1492760567-27894-1-git-send-email-ying.zhang22455@nxp.com> X-EOPAttributedMessage: 0 X-Matching-Connectors: 131372350598489959;(91ab9b29-cfa4-454e-5278-08d120cd25b8);() X-Forefront-Antispam-Report: CIP:192.88.168.50;IPV:NLI;CTRY:US;EFV:NLI;SFV:NSPM;SFS:(10009020)(6009001)(336005)(39840400002)(39450400003)(39400400002)(39410400002)(39850400002)(39380400002)(39860400002)(2980300002)(1110001)(1109001)(339900001)(199003)(189002)(9170700003)(50466002)(8936002)(2950100002)(2876002)(6666003)(2906002)(5003940100001)(6916009)(86362001)(76176999)(48376002)(50986999)(189998001)(356003)(50226002)(110136004)(77096006)(305945005)(54906002)(5660300001)(105606002)(106466001)(8676002)(8656002)(85426001)(33646002)(4326008)(104016004)(36756003)(47776003)(86152003)(81166006)(53936002)(38730400002)(2351001)(2004002);DIR:OUT;SFP:1101;SCL:1;SRVR:BN1PR0301MB0593;H:tx30smr01.am.freescale.net;FPR:;SPF:Fail;MLV:ovrnspm;A:1;MX:1;PTR:InfoDomainNonexistent;LANG:en; X-Microsoft-Exchange-Diagnostics: 1;BN1AFFO11FD011;1:PQ9KScNBT4F7JK2n6I9SBoVJZLhd1YqQ9nMrv0nSAZvsjY++HKW8y1IIF9qlyPtv9nWBOJQyiP+SchxUB1713soNLjKqFHrMY7nv+4f1Sk87vmFchhcYAckpcegc9HCQkp2DDMS/JNIDIkKVqLBK8gYYY7q0KyF3WKOXqF0Fm3nX4T+RzVLbnrrhEH2lCpaHxG7Ag4b9D2RmjZcneX53odXkyBMS+8Fq6uxiogNeimG6FDwMByCI6CTyqqde1SGZj0deWtm5a962gCId/plPyWbOkxhKjOFw2sjl8RxJNO2GZBLH4lVRkJOnk/s/HoUFBIhNOqp6WhR4p8DacqR2XrDTG+k1xAeIOjXvS6ZkRAVljYZwo2jDPl0iEvn7lbv6+qe+Wwg0UmPd6W2rA6ki+AYrWQY6fRHcpSIeUSKAq+QMQ54ycmytBFbMyUK/suK85ZLFIv4ky3gw5WbjqQl/mp4qh9G6OoN9oruc01vwjGOoAV4qIuVFEc+MmYyS63TIskodvLHmh6L6lLT+HQawqiP2JUvgsnqanIH3yAor9RWvYwEHHT2p5QNFH5gmZXRrjPixiwUVYKbyAF4h76E3M2FI+Wiefm688AfXMb4TPEkoRqfL4OUPsiunZZDjX9mlU8GauWQra0mvq1q6AzN4P0CrAL43x4BS9OBN6ciX/U1w+bZNn7BN7LIb6xPSEive/HyigPqNRti6fVgjmLRAdF6xbtgJNxynEQUagxd2iuw= MIME-Version: 1.0 Content-Type: text/plain X-MS-Office365-Filtering-Correlation-Id: c0594b2f-b736-49fe-c607-08d4888c152f X-Microsoft-Antispam: UriScan:;BCL:0;PCL:0;RULEID:(22001)(201703131430075)(201703131517081);SRVR:BN1PR0301MB0593; X-Microsoft-Exchange-Diagnostics: 1;BN1PR0301MB0593;3:na0ICZX6vo3Ld57HcDx5vSvpxvZB4vfrvD/FrPz6iK7ZK8+FJFTeUccQtwHfblGbzYYUg3ZTCW7EQtbAgGIHemmOfhuHJ8rKhDkk5i2QZT7nX0dV12B0JIKkvPwqJrqCsMubCxKRf6h2YPY9LFJG4gV1ler7icBoYzBBHCJaKNbY+GtxrQhRzn23u3eSuk89BusNOxMwNJCLexijpATWMJIm39XB/pSFy9fdr7ogSQLzvD8YJWBuwEHEEwhw9IAT/Gbwk0JJ8agWTX55ALgwqcFIGBxQaQdXob9VnQH+jDhIE3fp1bpu/VMoqaiahBx3mxwdBDJFrkbVgxPvLlPGsXwZHRkvnBWxmEWCjkibYR5JuTdL+Qv36EtRULQaJZC56AHh+HxLBJow5CNt6fgfcO4MLPxbicaVmjI9r87ituaJHy9Wd5wW1FJaOThQY+br;25:JY0vLzMyGjccJyKgyZKKQu4OQkKVpWsLOZTe4U9CvL2uSBa28mu9TYqwtklpl37dOkcGagwYI+o+Zqm/nRz+vlbQ4d4IJ5AOu068SQzBkqigj7I9VhwaW7KLXfUkEBR7ihPWq/jIY26RRNbLo4Scf//0u9JqRAVmF0GM0NBQwb0d/vDuKtY4gu47kNNWt9eIGucegzkR3VRUy3lZg/10WmRJPlqtU19NLIw3u+24UDhFo+F91lhHGt+C8+qbWZmzVAnHe868qBlFBNic+hP/F468/y0E96fcWDSb4irhiGW+tYOdodU+DJo811dhhB2MaMxsK3uIRRCGLaYvJmgzmyoJvvXcbj09OpU/2MSUy/TtDWv14mcYyhnzlF8GuGbzJbGKj8ZVMGxl3TBS3K5BBcteY+AFlCuSBjOJ7yjD2J+pAbxyhZiDK1XNWtTf8aK3r5F5baq4zohyKnJRSuQj/w== X-Microsoft-Exchange-Diagnostics: 1;BN1PR0301MB0593;31:VpWYUa8NRNWx2Fi785oGifAcDFnFIImz2FupHx6wiFufJWu0YUgKzgo21ViK+e+lL0iY52I/QSSrxtFhYXPTLYeOG9vwbowf1Je4XzW7U7HIf7dMx628ZQCFIWV5iKJP5/dkc69A1Ugevv7EA/3nItau+7MWEkkwQ08jjHr73AyYay5Kv1L5fL12NeWXEva+a3tuy56OkLts1e6JyJBESQRu0kaU7Zh+fw/XwZBt8f4v+XvtlWwbWwLoLxdGSgnwcXvuPhTqhUJDq/9bZqDgDWs8whvGczs+ib3JeHQ5aB4= X-Microsoft-Antispam-PRVS: X-Exchange-Antispam-Report-Test: UriScan:(185117386973197); X-Exchange-Antispam-Report-CFA-Test: BCL:0;PCL:0;RULEID:(6095135)(601004)(2401047)(13017025)(13018025)(13024025)(13023025)(13015025)(8121501046)(5005006)(10201501046)(93006095)(93001095)(3002001)(6055026)(6096035)(20161123563025)(201703131430075)(201703131448075)(201703131433075)(201703161259150)(20161123556025)(20161123561025)(20161123565025);SRVR:BN1PR0301MB0593;BCL:0;PCL:0;RULEID:(400006);SRVR:BN1PR0301MB0593; X-Microsoft-Exchange-Diagnostics: 1;BN1PR0301MB0593;4:EZlQjWM5VmJnmBKWSovaOLA17SjD/0rz//4ty2ZOvWP2E2Aoxi/WRYSS5M0dN4nG5xjhoped19AtVNZwcdB18cZlIUs8+w9bhB0c5cT6tOcpVD/ykx6z8xi9elAGhQ9/K4cmmxnRNpk8L296ta1twcquUOQFqCFd6U3b9tdNW8iWj7LoypW6sP4UKdCK502Y6T9YMgLxIdF7vfa2+ddtcVuqSoZR8EUuGKOiAW3jfQ0g9wbnEmk3NRbt28kqfy960tvS8E69XIRdOY1R0nFhHu41OORtP7taZD/K1LRte8433Wv3EWNeImgGbu6/3gGqLlCvJztpn2z0oWrQK0PMA/IByc2Cj7j/sJd+U0wVPvipdVfhLr49OCJPq5LqOy62ODJuFIiTHe4/w26cNYfb9y55nQAOSt5U/FRYw3NBEohrqsf0LS+N3Y6eWtvCDKht+TyOxH96agFDPkGzbv0ZkGUW3P5dESSc9rgwl9B9zHy9mNJBAPZxkO8SfjXajMf1K8JrrWuM4YKQQUQ8hyQP9I6kYyfoQu5XCv5//gHhhoNaYD0hkl3TQo4P/e00mLu12C623UA6PjDEcXf0sf5B6LiXAir9lOc+qm5rSXHf/MS8+WKekbEjTV1m16l0kex4RdUy5V5YX9SxoYLgT2LMPYlFPDB01pnqOyjDGd+XhKnZbcIykMvRDrsACYDo6X11rmrwh8yICNQS0flBL6tn5w77zZERvRQOOWRDrmMF6rbJFhKBShGpI9Cy+F5wiWQtrTu2ym+soeC2MqUtYFKR2hxZ5toQw4JaAAoLzQDXANqkPubXw5X57lrhDL+h0xnNDgfOhLQEbH+raOMspbItbuoK1+A0bq8FuAt2LK63QQ6A22lT1hs3t4d59S+AgO/5yr2PLKacxhmZwXPS4s3FXQ== X-Forefront-PRVS: 02843AA9E0 X-Microsoft-Exchange-Diagnostics: =?us-ascii?Q?1;BN1PR0301MB0593;23:CuQgDCmynyhfcrOOzHSga5+XMbqzL95NR3hFMXR?= =?us-ascii?Q?AJ62W2a3M+/FTA5cPIMg6lYriW9OeYjCilRy6JT7lAsUbyawILJJ8k8nOnTQ?= =?us-ascii?Q?emO+Gy3Vtt5vHxBtbfd2IWhy52mgROhznn5zV/k25nUlLp24kXfYNTyPhbFx?= =?us-ascii?Q?e9cMrTSHWyzhSPu8vO/K4Sk89vW/ZJ4tADkCdn1Mest7iAvuLJz5XZ/2te8O?= =?us-ascii?Q?3gMRN9FjIykgzB1+7EoBpOGBU5wj/x3ZnugL03koTDub6lRXOhvkH9AvY7T5?= =?us-ascii?Q?OGAO/linSvDkrsmzpqOFZUI4JzBcCQDwUyCkBy7CgMVi+f5zakU9GFYnxeW7?= =?us-ascii?Q?z0N8181kjQtF8gzqKoOfW5GaOHC4dRO/B66JSDHpjyzloN03MOiVy5Dc0tw5?= =?us-ascii?Q?lRUccXrR4Hp86NmBqwE7zzmmBI7yCx6FACpre1n7wrT+Wcwmk2V9FqQ5ek3V?= =?us-ascii?Q?wO2j6oYxPfx8XD20Xxl6X55uL+Svrv1df8XMA8yGeVBjJh0DznCnlfMRm8vD?= =?us-ascii?Q?tcliutmWUuSUXuTzhlWQo0aSsb8J82On6mRzGqIJXgGHv0H/XN0lgzEPVGSL?= =?us-ascii?Q?9Nsrqnq4lqueCGFAm/zBHGkJ3lZrgO1iWTfXs38wLLR9A9rCkFjiDPCbovUs?= =?us-ascii?Q?eZfBlRsUyIuUy/6UOceNy3QUu0xu2WCZD8rdiVMhoVIPqCtfMzhnGs5glCTZ?= =?us-ascii?Q?CV5Ain9tfxrNY9XYV3HTgfLvnYtuRAuVygrDssaGYr7SjWXp1JutdPOebtBO?= =?us-ascii?Q?NIVxBr+dfZe6zHqLZaVT2NAZNree7EstIb2J8WKmZ/emFM60ZwaMlytW+nTQ?= =?us-ascii?Q?lVa1TSV2YYdakl+72VIKbQpgTBW3JZTp2bDrnb2D8741CMHE0kFtQXnGWHMy?= =?us-ascii?Q?tkFPxFUtima4ugyf3K7YWX4E3ldPaYsqQErDt954ZnbD3kkUm6D/g+wtu1hx?= =?us-ascii?Q?oplgIXsyruNBl66gBu+II+F7MHv18Dcvov/zpwLXv4oWVnN3VmJ1e1a3H5dI?= =?us-ascii?Q?6xbNpVoTIwHaOjDYuLSfu2AKHy9y9O4IpXFgs0HPZgfcp8h9GJNzabC8/JJ8?= =?us-ascii?Q?ShCYE3GQ1JyyrGMZ4Y4NjBYO26Vm0BKv6srEm6nLLAk705M+grrg5Ft4Nmny?= =?us-ascii?Q?lnYm1ZzZW2B+ixvLD8En5ushgQNJt2q0gt5Brq6nbnjrb8PKg5iDlrCZMZpw?= =?us-ascii?Q?MSn6RA8iYACAp79UdQsOd4M1uKbe401z5bPr/z1xxh+7VSdbBGJuf0O/jEUl?= =?us-ascii?Q?zEwP77ThEuvmUjtW3gQjTR9OR+0y/EL7TPvB1QGkx?= X-Microsoft-Exchange-Diagnostics: 1;BN1PR0301MB0593;6:O2WIwby861PQn7Fy9TcYUDpLrg89c+Fk4z7g/BQwbQp5S9zlF5a6+PtjUWwGBKt1eYh6EmEJdsW3F8DFJZcyw/GRgGjzmRiUiW7Fl+EAtq3i2HMklB8OWlTxIPlHTrZWaNTh12MwbhztQfBUpj3ekuRybkyUhiHpqZT/4nhtRxTt286Dmc+k3IRHCDrTOfXs9Na1SRP5A6gp/CBHOKaqg9Fc6u7M5dJoql0pBn7hBmZYFWZ2L17Wls48O3ck5zsbOfpLPFttcj6XMo2b/OWPGCPtUJ9jDA4S3vVVKR4YyVbp/V3BYB522gelxKudigOO71nHaYHni+UcIhCpAzSo6q9tg6rtT0Z199X/AGTuZINFzdDGsly3CKvTOm+H5bp5t/F8dzqOHi1P689yovHyO7Z82xvQomXwiR9AllmsQ/DWkKGhub2ocCMcZ3aZxKG01/uCga25EdY9vJdTa54cTY916QY8io7aWOIkgqobC1lP4u5nWxrq3wGBH2ekvSZtdg8BPXt5TphYVtOfo/+xzQ==;5:szpaz5/qTmTlwE9iMp1VBo9upV+LBkenoSwxApVWGJenZBPQ54idncfyzL5pbsYkX7oT9cOqqBp1/pooL2U9aKo34dFJVQY7rofMsvAZ854HJ7GOBRMc06eFTG2RsRkvENIsRkrQE3ZJBgCNGW2wfOstSaIZhseO6cbacfaqInWoQhBwclLflYYKzMFXVnWw;24:zFQc7uVWgg8rQ9Jbr06iLA/vn/9PJdwKXwwJaGHuyKMMsIU1qpjUGn9YWc8Kz8zrhP1Ywxz2AUkUDTjT2UNW8DTeSsyv5QCrHE62AjZgVLA= SpamDiagnosticOutput: 1:99 SpamDiagnosticMetadata: NSPM X-Microsoft-Exchange-Diagnostics: 1;BN1PR0301MB0593;7:AMTrnywdHrdhnmVlrEONetO1CPpU9qQbJcoWW0bhttbXQVl5n9WPx38EqJXNv/Ua464bfkN0oozQQfoxNfElf2XMTdkOzXs9K5npiCITxR3n6lOkUU6BbzmFp+KC8u2mYLkT+fD9tF9+pJPU3BHz5f1N9KOJ6C4q0priz/LQBIggJJU0qTYoH9OqaShXcVNC6chzJb0AsrIH7m71N+7aEItD9Li2R5MH4lhP7Y7tLPEOzZRnR1lXwD1LMZfGcNy4nltYULUr+tedsRMvaSAqxT8+GE1nNuYychlODwwfEws0vexg54BxzeBRss/H7QwAOhOaJozbRxE6HTgokkeJaw== X-MS-Exchange-CrossTenant-OriginalArrivalTime: 21 Apr 2017 07:57:39.6617 (UTC) X-MS-Exchange-CrossTenant-Id: 5afe0b00-7697-4969-b663-5eab37d5f47e X-MS-Exchange-CrossTenant-OriginalAttributedTenantConnectingIp: TenantId=5afe0b00-7697-4969-b663-5eab37d5f47e;Ip=[192.88.168.50];Helo=[tx30smr01.am.freescale.net] X-MS-Exchange-CrossTenant-FromEntityHeader: HybridOnPrem X-MS-Exchange-Transport-CrossTenantHeadersStamped: BN1PR0301MB0593 Sender: linux-kernel-owner@vger.kernel.org List-ID: X-Mailing-List: linux-kernel@vger.kernel.org From: Wang Dongsheng Signed-off-by: Zhang Ying-22455 --- drivers/soc/fsl/layerscape/Kconfig | 10 ++ drivers/soc/fsl/layerscape/Makefile | 1 + drivers/soc/fsl/layerscape/ftm_alarm.c | 274 +++++++++++++++++++++++++++++++++ 3 files changed, 285 insertions(+) create mode 100644 drivers/soc/fsl/layerscape/Kconfig create mode 100644 drivers/soc/fsl/layerscape/Makefile create mode 100644 drivers/soc/fsl/layerscape/ftm_alarm.c diff --git a/drivers/soc/fsl/layerscape/Kconfig b/drivers/soc/fsl/layerscape/Kconfig new file mode 100644 index 0000000..e1373aa --- /dev/null +++ b/drivers/soc/fsl/layerscape/Kconfig @@ -0,0 +1,10 @@ +# +# Layerscape Soc drivers +# +config FTM_ALARM + bool "FTM alarm driver" + default n + help + Say y here to enable FTM alarm support. The FTM alarm provides + alarm functions for wakeup system from deep sleep. There is only + one FTM can be used in ALARM(FTM 0). diff --git a/drivers/soc/fsl/layerscape/Makefile b/drivers/soc/fsl/layerscape/Makefile new file mode 100644 index 0000000..6299aa1 --- /dev/null +++ b/drivers/soc/fsl/layerscape/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_FTM_ALARM) += ftm_alarm.o diff --git a/drivers/soc/fsl/layerscape/ftm_alarm.c b/drivers/soc/fsl/layerscape/ftm_alarm.c new file mode 100644 index 0000000..c42b26b --- /dev/null +++ b/drivers/soc/fsl/layerscape/ftm_alarm.c @@ -0,0 +1,274 @@ +/* + * Freescale FlexTimer Module (FTM) Alarm driver. + * + * Copyright 2014 Freescale Semiconductor, Inc. + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of the GNU General Public License + * as published by the Free Software Foundation; either version 2 + * of the License, or (at your option) any later version. + */ + +#include +#include +#include +#include +#include +#include +#include + +#define FTM_SC 0x00 +#define FTM_SC_CLK_SHIFT 3 +#define FTM_SC_CLK_MASK (0x3 << FTM_SC_CLK_SHIFT) +#define FTM_SC_CLK(c) ((c) << FTM_SC_CLK_SHIFT) +#define FTM_SC_PS_MASK 0x7 +#define FTM_SC_TOIE BIT(6) +#define FTM_SC_TOF BIT(7) + +#define FTM_SC_CLKS_FIXED_FREQ 0x02 + +#define FTM_CNT 0x04 +#define FTM_MOD 0x08 +#define FTM_CNTIN 0x4C + +#define FIXED_FREQ_CLK 32000 +#define MAX_FREQ_DIV (1 << FTM_SC_PS_MASK) +#define MAX_COUNT_VAL 0xffff + +static void __iomem *ftm1_base; +static u32 alarm_freq; +static bool big_endian; + +static inline u32 ftm_readl(void __iomem *addr) +{ + if (big_endian) + return ioread32be(addr); + + return ioread32(addr); +} + +static inline void ftm_writel(u32 val, void __iomem *addr) +{ + if (big_endian) + iowrite32be(val, addr); + else + iowrite32(val, addr); +} + +static inline void ftm_counter_enable(void __iomem *base) +{ + u32 val; + + /* select and enable counter clock source */ + val = ftm_readl(base + FTM_SC); + val &= ~(FTM_SC_PS_MASK | FTM_SC_CLK_MASK); + val |= (FTM_SC_PS_MASK | FTM_SC_CLK(FTM_SC_CLKS_FIXED_FREQ)); + ftm_writel(val, base + FTM_SC); +} + +static inline void ftm_counter_disable(void __iomem *base) +{ + u32 val; + + /* disable counter clock source */ + val = ftm_readl(base + FTM_SC); + val &= ~(FTM_SC_PS_MASK | FTM_SC_CLK_MASK); + ftm_writel(val, base + FTM_SC); +} + +static inline void ftm_irq_acknowledge(void __iomem *base) +{ + u32 val; + + val = ftm_readl(base + FTM_SC); + val &= ~FTM_SC_TOF; + ftm_writel(val, base + FTM_SC); +} + +static inline void ftm_irq_enable(void __iomem *base) +{ + u32 val; + + val = ftm_readl(base + FTM_SC); + val |= FTM_SC_TOIE; + ftm_writel(val, base + FTM_SC); +} + +static inline void ftm_irq_disable(void __iomem *base) +{ + u32 val; + + val = ftm_readl(base + FTM_SC); + val &= ~FTM_SC_TOIE; + ftm_writel(val, base + FTM_SC); +} + +static inline void ftm_reset_counter(void __iomem *base) +{ + /* + * The CNT register contains the FTM counter value. + * Reset clears the CNT register. Writing any value to COUNT + * updates the counter with its initial value, CNTIN. + */ + ftm_writel(0x00, base + FTM_CNT); +} + +static u32 time_to_cycle(unsigned long time) +{ + u32 cycle; + + cycle = time * alarm_freq; + if (cycle > MAX_COUNT_VAL) { + pr_err("Out of alarm range.\n"); + cycle = 0; + } + + return cycle; +} + +static u32 cycle_to_time(u32 cycle) +{ + return cycle / alarm_freq + 1; +} + +static void ftm_clean_alarm(void) +{ + ftm_counter_disable(ftm1_base); + + ftm_writel(0x00, ftm1_base + FTM_CNTIN); + ftm_writel(~0UL, ftm1_base + FTM_MOD); + + ftm_reset_counter(ftm1_base); +} + +static int ftm_set_alarm(u64 cycle) +{ + ftm_irq_disable(ftm1_base); + + /* + * The counter increments until the value of MOD is reached, + * at which point the counter is reloaded with the value of CNTIN. + * The TOF (the overflow flag) bit is set when the FTM counter + * changes from MOD to CNTIN. So we should using the cycle - 1. + */ + ftm_writel(cycle - 1, ftm1_base + FTM_MOD); + + ftm_counter_enable(ftm1_base); + + ftm_irq_enable(ftm1_base); + + return 0; +} + +static irqreturn_t ftm_alarm_interrupt(int irq, void *dev_id) +{ + ftm_irq_acknowledge(ftm1_base); + ftm_irq_disable(ftm1_base); + ftm_clean_alarm(); + + return IRQ_HANDLED; +} + +static ssize_t ftm_alarm_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + u32 count, val; + + count = ftm_readl(ftm1_base + FTM_MOD); + val = ftm_readl(ftm1_base + FTM_CNT); + val = (count & MAX_COUNT_VAL) - val; + val = cycle_to_time(val); + + return sprintf(buf, "%u\n", val); +} + +static ssize_t ftm_alarm_store(struct device *dev, + struct device_attribute *attr, + const char *buf, size_t count) +{ + u32 cycle; + unsigned long time; + + if (kstrtoul(buf, 0, &time)) + return -EINVAL; + + ftm_clean_alarm(); + + cycle = time_to_cycle(time); + if (!cycle) + return -EINVAL; + + ftm_set_alarm(cycle); + + return count; +} + +static struct device_attribute ftm_alarm_attributes = __ATTR(ftm_alarm, 0644, + ftm_alarm_show, ftm_alarm_store); + +static int ftm_alarm_probe(struct platform_device *pdev) +{ + struct device_node *np = pdev->dev.of_node; + struct resource *r; + int irq; + int ret; + + r = platform_get_resource(pdev, IORESOURCE_MEM, 0); + if (!r) + return -ENODEV; + + ftm1_base = devm_ioremap_resource(&pdev->dev, r); + if (IS_ERR(ftm1_base)) + return PTR_ERR(ftm1_base); + + irq = irq_of_parse_and_map(np, 0); + if (irq <= 0) { + pr_err("ftm: unable to get IRQ from DT, %d\n", irq); + return -EINVAL; + } + + big_endian = of_property_read_bool(np, "big-endian"); + + ret = devm_request_irq(&pdev->dev, irq, ftm_alarm_interrupt, + IRQF_NO_SUSPEND, dev_name(&pdev->dev), NULL); + if (ret < 0) { + dev_err(&pdev->dev, "failed to request irq\n"); + return ret; + } + + ret = device_create_file(&pdev->dev, &ftm_alarm_attributes); + if (ret) { + dev_err(&pdev->dev, "create sysfs fail.\n"); + return ret; + } + + alarm_freq = (u32)FIXED_FREQ_CLK / (u32)MAX_FREQ_DIV; + + ftm_clean_alarm(); + + device_init_wakeup(&pdev->dev, true); + + return ret; +} + +static const struct of_device_id ftm_alarm_match[] = { + { .compatible = "fsl,ftm-alarm", }, + { .compatible = "fsl,ftm-timer", }, + { }, +}; + +static struct platform_driver ftm_alarm_driver = { + .probe = ftm_alarm_probe, + .driver = { + .name = "ftm-alarm", + .owner = THIS_MODULE, + .of_match_table = ftm_alarm_match, + }, +}; + +static int __init ftm_alarm_init(void) +{ + return platform_driver_register(&ftm_alarm_driver); +} +device_initcall(ftm_alarm_init); -- 2.1.0.27.g96db324