1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889 |
- /*
- * PowerNV Real Time Clock.
- *
- * Copyright 2011 IBM Corp.
- *
- * 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 <linux/kernel.h>
- #include <linux/time.h>
- #include <linux/bcd.h>
- #include <linux/rtc.h>
- #include <linux/delay.h>
- #include <linux/platform_device.h>
- #include <linux/of_platform.h>
- #include <asm/opal.h>
- #include <asm/firmware.h>
- #include <asm/machdep.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);
- tm->tm_wday = -1;
- }
- unsigned long __init opal_get_boot_time(void)
- {
- struct rtc_time tm;
- u32 y_m_d;
- u64 h_m_s_ms;
- __be32 __y_m_d;
- __be64 __h_m_s_ms;
- long rc = OPAL_BUSY;
- if (!opal_check_token(OPAL_RTC_READ))
- return 0;
- while (rc == OPAL_BUSY || rc == OPAL_BUSY_EVENT) {
- rc = opal_rtc_read(&__y_m_d, &__h_m_s_ms);
- if (rc == OPAL_BUSY_EVENT) {
- mdelay(OPAL_BUSY_DELAY_MS);
- opal_poll_events(NULL);
- } else if (rc == OPAL_BUSY) {
- mdelay(OPAL_BUSY_DELAY_MS);
- }
- }
- if (rc != OPAL_SUCCESS)
- return 0;
- 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 mktime(tm.tm_year + 1900, tm.tm_mon + 1, tm.tm_mday,
- tm.tm_hour, tm.tm_min, tm.tm_sec);
- }
- static __init int opal_time_init(void)
- {
- struct platform_device *pdev;
- struct device_node *rtc;
- rtc = of_find_node_by_path("/ibm,opal/rtc");
- if (rtc) {
- pdev = of_platform_device_create(rtc, "opal-rtc", NULL);
- of_node_put(rtc);
- } else {
- if (opal_check_token(OPAL_RTC_READ) ||
- opal_check_token(OPAL_READ_TPO))
- pdev = platform_device_register_simple("opal-rtc", -1,
- NULL, 0);
- else
- return -ENODEV;
- }
- return PTR_ERR_OR_ZERO(pdev);
- }
- machine_subsys_initcall(powernv, opal_time_init);
|