3 * Copyright (C) 2014 IBM
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
15 * You should have received a copy of the GNU General Public License
16 * along with this program.
19 #define DRVNAME "rtc-opal"
20 #define pr_fmt(fmt) DRVNAME ": " fmt
22 #include <linux/module.h>
23 #include <linux/err.h>
24 #include <linux/rtc.h>
25 #include <linux/delay.h>
26 #include <linux/bcd.h>
27 #include <linux/platform_device.h>
30 #include <asm/firmware.h>
32 static void opal_to_tm(u32 y_m_d
, u64 h_m_s_ms
, struct rtc_time
*tm
)
34 tm
->tm_year
= ((bcd2bin(y_m_d
>> 24) * 100) +
35 bcd2bin((y_m_d
>> 16) & 0xff)) - 1900;
36 tm
->tm_mon
= bcd2bin((y_m_d
>> 8) & 0xff) - 1;
37 tm
->tm_mday
= bcd2bin(y_m_d
& 0xff);
38 tm
->tm_hour
= bcd2bin((h_m_s_ms
>> 56) & 0xff);
39 tm
->tm_min
= bcd2bin((h_m_s_ms
>> 48) & 0xff);
40 tm
->tm_sec
= bcd2bin((h_m_s_ms
>> 40) & 0xff);
45 static void tm_to_opal(struct rtc_time
*tm
, u32
*y_m_d
, u64
*h_m_s_ms
)
47 *y_m_d
|= ((u32
)bin2bcd((tm
->tm_year
+ 1900) / 100)) << 24;
48 *y_m_d
|= ((u32
)bin2bcd((tm
->tm_year
+ 1900) % 100)) << 16;
49 *y_m_d
|= ((u32
)bin2bcd((tm
->tm_mon
+ 1))) << 8;
50 *y_m_d
|= ((u32
)bin2bcd(tm
->tm_mday
));
52 *h_m_s_ms
|= ((u64
)bin2bcd(tm
->tm_hour
)) << 56;
53 *h_m_s_ms
|= ((u64
)bin2bcd(tm
->tm_min
)) << 48;
54 *h_m_s_ms
|= ((u64
)bin2bcd(tm
->tm_sec
)) << 40;
57 static int opal_get_rtc_time(struct device
*dev
, struct rtc_time
*tm
)
65 while (rc
== OPAL_BUSY
|| rc
== OPAL_BUSY_EVENT
) {
66 rc
= opal_rtc_read(&__y_m_d
, &__h_m_s_ms
);
67 if (rc
== OPAL_BUSY_EVENT
)
68 opal_poll_events(NULL
);
73 if (rc
!= OPAL_SUCCESS
)
76 y_m_d
= be32_to_cpu(__y_m_d
);
77 h_m_s_ms
= be64_to_cpu(__h_m_s_ms
);
78 opal_to_tm(y_m_d
, h_m_s_ms
, tm
);
83 static int opal_set_rtc_time(struct device
*dev
, struct rtc_time
*tm
)
89 tm_to_opal(tm
, &y_m_d
, &h_m_s_ms
);
90 while (rc
== OPAL_BUSY
|| rc
== OPAL_BUSY_EVENT
) {
91 rc
= opal_rtc_write(y_m_d
, h_m_s_ms
);
92 if (rc
== OPAL_BUSY_EVENT
)
93 opal_poll_events(NULL
);
98 return rc
== OPAL_SUCCESS
? 0 : -EIO
;
104 * TPO get/set OPAL calls care about the hour and min and to make it consistent
105 * with the rtc utility time conversion functions, we use the 'u64' to store
106 * its value and perform bit shift by 32 before use..
108 static int opal_get_tpo_time(struct device
*dev
, struct rtc_wkalrm
*alarm
)
110 __be32 __y_m_d
, __h_m
;
116 token
= opal_async_get_token_interruptible();
118 if (token
!= -ERESTARTSYS
)
119 pr_err("Failed to get the async token\n");
124 rc
= opal_tpo_read(token
, &__y_m_d
, &__h_m
);
125 if (rc
!= OPAL_ASYNC_COMPLETION
) {
130 rc
= opal_async_wait_response(token
, &msg
);
136 rc
= be64_to_cpu(msg
.params
[1]);
137 if (rc
!= OPAL_SUCCESS
) {
142 y_m_d
= be32_to_cpu(__y_m_d
);
143 h_m_s_ms
= ((u64
)be32_to_cpu(__h_m
) << 32);
144 opal_to_tm(y_m_d
, h_m_s_ms
, &alarm
->time
);
147 opal_async_release_token(token
);
151 /* Set Timed Power-On */
152 static int opal_set_tpo_time(struct device
*dev
, struct rtc_wkalrm
*alarm
)
154 u64 h_m_s_ms
= 0, token
;
159 tm_to_opal(&alarm
->time
, &y_m_d
, &h_m_s_ms
);
161 token
= opal_async_get_token_interruptible();
163 if (token
!= -ERESTARTSYS
)
164 pr_err("Failed to get the async token\n");
169 /* TPO, we care about hour and minute */
170 rc
= opal_tpo_write(token
, y_m_d
,
171 (u32
)((h_m_s_ms
>> 32) & 0xffff0000));
172 if (rc
!= OPAL_ASYNC_COMPLETION
) {
177 rc
= opal_async_wait_response(token
, &msg
);
183 rc
= be64_to_cpu(msg
.params
[1]);
184 if (rc
!= OPAL_SUCCESS
)
188 opal_async_release_token(token
);
192 static const struct rtc_class_ops opal_rtc_ops
= {
193 .read_time
= opal_get_rtc_time
,
194 .set_time
= opal_set_rtc_time
,
195 .read_alarm
= opal_get_tpo_time
,
196 .set_alarm
= opal_set_tpo_time
,
199 static int opal_rtc_probe(struct platform_device
*pdev
)
201 struct rtc_device
*rtc
;
203 if (pdev
->dev
.of_node
&& of_get_property(pdev
->dev
.of_node
, "has-tpo",
205 device_set_wakeup_capable(&pdev
->dev
, true);
207 rtc
= devm_rtc_device_register(&pdev
->dev
, DRVNAME
, &opal_rtc_ops
,
212 rtc
->uie_unsupported
= 1;
217 static const struct of_device_id opal_rtc_match
[] = {
219 .compatible
= "ibm,opal-rtc",
223 MODULE_DEVICE_TABLE(of
, opal_rtc_match
);
225 static const struct platform_device_id opal_rtc_driver_ids
[] = {
231 MODULE_DEVICE_TABLE(platform
, opal_rtc_driver_ids
);
233 static struct platform_driver opal_rtc_driver
= {
234 .probe
= opal_rtc_probe
,
235 .id_table
= opal_rtc_driver_ids
,
238 .owner
= THIS_MODULE
,
239 .of_match_table
= opal_rtc_match
,
243 static int __init
opal_rtc_init(void)
245 if (!firmware_has_feature(FW_FEATURE_OPAL
))
248 return platform_driver_register(&opal_rtc_driver
);
251 static void __exit
opal_rtc_exit(void)
253 platform_driver_unregister(&opal_rtc_driver
);
256 MODULE_AUTHOR("Neelesh Gupta <neelegup@linux.vnet.ibm.com>");
257 MODULE_DESCRIPTION("IBM OPAL RTC driver");
258 MODULE_LICENSE("GPL");
260 module_init(opal_rtc_init
);
261 module_exit(opal_rtc_exit
);