Blame view

drivers/rtc/rtc-opal.c 5.98 KB
16b1d26e7   Neelesh Gupta   rtc/tpo: Driver t...
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
  /*
   * IBM OPAL RTC driver
   * Copyright (C) 2014 IBM
   *
   * 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.
   *
   * This program is distributed in the hope that it will be useful,
   * but WITHOUT ANY WARRANTY; without even the implied warranty of
   * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
   * GNU General Public License for more details.
   *
   * You should have received a copy of the GNU General Public License
   * along with this program.
   */
a737e835e   Joe Perches   rtc: use more sta...
18
  #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
16b1d26e7   Neelesh Gupta   rtc/tpo: Driver t...
19
  #define DRVNAME		"rtc-opal"
16b1d26e7   Neelesh Gupta   rtc/tpo: Driver t...
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
  
  #include <linux/module.h>
  #include <linux/err.h>
  #include <linux/rtc.h>
  #include <linux/delay.h>
  #include <linux/bcd.h>
  #include <linux/platform_device.h>
  #include <linux/of.h>
  #include <asm/opal.h>
  #include <asm/firmware.h>
  
  static void opal_to_tm(u32 y_m_d, u64 h_m_s_ms, struct rtc_time *tm)
  {
  	tm->tm_year = ((bcd2bin(y_m_d >> 24) * 100) +
  		       bcd2bin((y_m_d >> 16) & 0xff)) - 1900;
  	tm->tm_mon  = bcd2bin((y_m_d >> 8) & 0xff) - 1;
  	tm->tm_mday = bcd2bin(y_m_d & 0xff);
  	tm->tm_hour = bcd2bin((h_m_s_ms >> 56) & 0xff);
  	tm->tm_min  = bcd2bin((h_m_s_ms >> 48) & 0xff);
  	tm->tm_sec  = bcd2bin((h_m_s_ms >> 40) & 0xff);
00b912b0c   Daniel Axtens   powerpc: Remove b...
40
  	tm->tm_wday = -1;
16b1d26e7   Neelesh Gupta   rtc/tpo: Driver t...
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
  }
  
  static void tm_to_opal(struct rtc_time *tm, u32 *y_m_d, u64 *h_m_s_ms)
  {
  	*y_m_d |= ((u32)bin2bcd((tm->tm_year + 1900) / 100)) << 24;
  	*y_m_d |= ((u32)bin2bcd((tm->tm_year + 1900) % 100)) << 16;
  	*y_m_d |= ((u32)bin2bcd((tm->tm_mon + 1))) << 8;
  	*y_m_d |= ((u32)bin2bcd(tm->tm_mday));
  
  	*h_m_s_ms |= ((u64)bin2bcd(tm->tm_hour)) << 56;
  	*h_m_s_ms |= ((u64)bin2bcd(tm->tm_min)) << 48;
  	*h_m_s_ms |= ((u64)bin2bcd(tm->tm_sec)) << 40;
  }
  
  static int opal_get_rtc_time(struct device *dev, struct rtc_time *tm)
  {
  	long rc = OPAL_BUSY;
  	u32 y_m_d;
  	u64 h_m_s_ms;
  	__be32 __y_m_d;
  	__be64 __h_m_s_ms;
  
  	while (rc == OPAL_BUSY || rc == OPAL_BUSY_EVENT) {
  		rc = opal_rtc_read(&__y_m_d, &__h_m_s_ms);
  		if (rc == OPAL_BUSY_EVENT)
  			opal_poll_events(NULL);
  		else
  			msleep(10);
  	}
  
  	if (rc != OPAL_SUCCESS)
  		return -EIO;
  
  	y_m_d = be32_to_cpu(__y_m_d);
  	h_m_s_ms = be64_to_cpu(__h_m_s_ms);
  	opal_to_tm(y_m_d, h_m_s_ms, tm);
  
  	return 0;
  }
  
  static int opal_set_rtc_time(struct device *dev, struct rtc_time *tm)
  {
  	long rc = OPAL_BUSY;
  	u32 y_m_d = 0;
  	u64 h_m_s_ms = 0;
  
  	tm_to_opal(tm, &y_m_d, &h_m_s_ms);
  	while (rc == OPAL_BUSY || rc == OPAL_BUSY_EVENT) {
  		rc = opal_rtc_write(y_m_d, h_m_s_ms);
  		if (rc == OPAL_BUSY_EVENT)
  			opal_poll_events(NULL);
  		else
  			msleep(10);
  	}
  
  	return rc == OPAL_SUCCESS ? 0 : -EIO;
  }
  
  /*
   * TPO	Timed Power-On
   *
   * TPO get/set OPAL calls care about the hour and min and to make it consistent
   * with the rtc utility time conversion functions, we use the 'u64' to store
   * its value and perform bit shift by 32 before use..
   */
  static int opal_get_tpo_time(struct device *dev, struct rtc_wkalrm *alarm)
  {
  	__be32 __y_m_d, __h_m;
  	struct opal_msg msg;
  	int rc, token;
  	u64 h_m_s_ms;
  	u32 y_m_d;
  
  	token = opal_async_get_token_interruptible();
  	if (token < 0) {
  		if (token != -ERESTARTSYS)
  			pr_err("Failed to get the async token
  ");
  
  		return token;
  	}
  
  	rc = opal_tpo_read(token, &__y_m_d, &__h_m);
  	if (rc != OPAL_ASYNC_COMPLETION) {
  		rc = -EIO;
  		goto exit;
  	}
  
  	rc = opal_async_wait_response(token, &msg);
  	if (rc) {
  		rc = -EIO;
  		goto exit;
  	}
d0226d315   Suraj Jitindar Singh   powerpc/opal: Add...
134
  	rc = opal_get_async_rc(msg);
16b1d26e7   Neelesh Gupta   rtc/tpo: Driver t...
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
  	if (rc != OPAL_SUCCESS) {
  		rc = -EIO;
  		goto exit;
  	}
  
  	y_m_d = be32_to_cpu(__y_m_d);
  	h_m_s_ms = ((u64)be32_to_cpu(__h_m) << 32);
  	opal_to_tm(y_m_d, h_m_s_ms, &alarm->time);
  
  exit:
  	opal_async_release_token(token);
  	return rc;
  }
  
  /* Set Timed Power-On */
  static int opal_set_tpo_time(struct device *dev, struct rtc_wkalrm *alarm)
  {
c35300941   Andrzej Hajda   rtc: opal: fix ty...
152
  	u64 h_m_s_ms = 0;
16b1d26e7   Neelesh Gupta   rtc/tpo: Driver t...
153
154
  	struct opal_msg msg;
  	u32 y_m_d = 0;
c35300941   Andrzej Hajda   rtc: opal: fix ty...
155
  	int token, rc;
16b1d26e7   Neelesh Gupta   rtc/tpo: Driver t...
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
  
  	tm_to_opal(&alarm->time, &y_m_d, &h_m_s_ms);
  
  	token = opal_async_get_token_interruptible();
  	if (token < 0) {
  		if (token != -ERESTARTSYS)
  			pr_err("Failed to get the async token
  ");
  
  		return token;
  	}
  
  	/* TPO, we care about hour and minute */
  	rc = opal_tpo_write(token, y_m_d,
  			    (u32)((h_m_s_ms >> 32) & 0xffff0000));
  	if (rc != OPAL_ASYNC_COMPLETION) {
  		rc = -EIO;
  		goto exit;
  	}
  
  	rc = opal_async_wait_response(token, &msg);
  	if (rc) {
  		rc = -EIO;
  		goto exit;
  	}
d0226d315   Suraj Jitindar Singh   powerpc/opal: Add...
181
  	rc = opal_get_async_rc(msg);
16b1d26e7   Neelesh Gupta   rtc/tpo: Driver t...
182
183
184
185
186
187
188
  	if (rc != OPAL_SUCCESS)
  		rc = -EIO;
  
  exit:
  	opal_async_release_token(token);
  	return rc;
  }
f4a2eecb3   Vaibhav Jain   rtc: opal: Enable...
189
  static struct rtc_class_ops opal_rtc_ops = {
16b1d26e7   Neelesh Gupta   rtc/tpo: Driver t...
190
191
  	.read_time	= opal_get_rtc_time,
  	.set_time	= opal_set_rtc_time,
16b1d26e7   Neelesh Gupta   rtc/tpo: Driver t...
192
193
194
195
196
  };
  
  static int opal_rtc_probe(struct platform_device *pdev)
  {
  	struct rtc_device *rtc;
347e40f03   Sudeep Holla   rtc: opal: enable...
197
198
199
  	if (pdev->dev.of_node &&
  	    (of_property_read_bool(pdev->dev.of_node, "wakeup-source") ||
  	     of_property_read_bool(pdev->dev.of_node, "has-tpo")/* legacy */)) {
16b1d26e7   Neelesh Gupta   rtc/tpo: Driver t...
200
  		device_set_wakeup_capable(&pdev->dev, true);
f4a2eecb3   Vaibhav Jain   rtc: opal: Enable...
201
202
203
  		opal_rtc_ops.read_alarm	= opal_get_tpo_time;
  		opal_rtc_ops.set_alarm = opal_set_tpo_time;
  	}
16b1d26e7   Neelesh Gupta   rtc/tpo: Driver t...
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
  
  	rtc = devm_rtc_device_register(&pdev->dev, DRVNAME, &opal_rtc_ops,
  				       THIS_MODULE);
  	if (IS_ERR(rtc))
  		return PTR_ERR(rtc);
  
  	rtc->uie_unsupported = 1;
  
  	return 0;
  }
  
  static const struct of_device_id opal_rtc_match[] = {
  	{
  		.compatible	= "ibm,opal-rtc",
  	},
  	{ }
  };
  MODULE_DEVICE_TABLE(of, opal_rtc_match);
  
  static const struct platform_device_id opal_rtc_driver_ids[] = {
  	{
  		.name		= "opal-rtc",
  	},
  	{ }
  };
  MODULE_DEVICE_TABLE(platform, opal_rtc_driver_ids);
  
  static struct platform_driver opal_rtc_driver = {
  	.probe		= opal_rtc_probe,
  	.id_table	= opal_rtc_driver_ids,
  	.driver		= {
  		.name		= DRVNAME,
16b1d26e7   Neelesh Gupta   rtc/tpo: Driver t...
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
  		.of_match_table	= opal_rtc_match,
  	},
  };
  
  static int __init opal_rtc_init(void)
  {
  	if (!firmware_has_feature(FW_FEATURE_OPAL))
  		return -ENODEV;
  
  	return platform_driver_register(&opal_rtc_driver);
  }
  
  static void __exit opal_rtc_exit(void)
  {
  	platform_driver_unregister(&opal_rtc_driver);
  }
  
  MODULE_AUTHOR("Neelesh Gupta <neelegup@linux.vnet.ibm.com>");
  MODULE_DESCRIPTION("IBM OPAL RTC driver");
  MODULE_LICENSE("GPL");
  
  module_init(opal_rtc_init);
  module_exit(opal_rtc_exit);