Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  * Copyright (C) 2019 BayLibre, SAS
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  * Author: Neil Armstrong <narmstrong@baylibre.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  * Copyright (C) 2015 Amlogic, Inc. All rights reserved.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) #include <linux/rtc.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <linux/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include <linux/of.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #include <linux/time64.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) struct meson_vrtc_data {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) 	void __iomem *io_alarm;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) 	struct rtc_device *rtc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) 	unsigned long alarm_time;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) 	bool enabled;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) static int meson_vrtc_read_time(struct device *dev, struct rtc_time *tm)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) 	struct timespec64 time;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) 	dev_dbg(dev, "%s\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) 	ktime_get_raw_ts64(&time);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) 	rtc_time64_to_tm(time.tv_sec, tm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) static void meson_vrtc_set_wakeup_time(struct meson_vrtc_data *vrtc,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) 				       unsigned long time)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 	writel_relaxed(time, vrtc->io_alarm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) static int meson_vrtc_set_alarm(struct device *dev, struct rtc_wkalrm *alarm)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 	struct meson_vrtc_data *vrtc = dev_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) 	dev_dbg(dev, "%s: alarm->enabled=%d\n", __func__, alarm->enabled);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 	if (alarm->enabled)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 		vrtc->alarm_time = rtc_tm_to_time64(&alarm->time);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 		vrtc->alarm_time = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) static int meson_vrtc_alarm_irq_enable(struct device *dev, unsigned int enabled)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 	struct meson_vrtc_data *vrtc = dev_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 	vrtc->enabled = enabled;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) static const struct rtc_class_ops meson_vrtc_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 	.read_time = meson_vrtc_read_time,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 	.set_alarm = meson_vrtc_set_alarm,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 	.alarm_irq_enable = meson_vrtc_alarm_irq_enable,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) static int meson_vrtc_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 	struct meson_vrtc_data *vrtc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 	vrtc = devm_kzalloc(&pdev->dev, sizeof(*vrtc), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 	if (!vrtc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	vrtc->io_alarm = devm_platform_ioremap_resource(pdev, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 	if (IS_ERR(vrtc->io_alarm))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 		return PTR_ERR(vrtc->io_alarm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 	device_init_wakeup(&pdev->dev, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 	platform_set_drvdata(pdev, vrtc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 	vrtc->rtc = devm_rtc_allocate_device(&pdev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 	if (IS_ERR(vrtc->rtc))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 		return PTR_ERR(vrtc->rtc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 	vrtc->rtc->ops = &meson_vrtc_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 	return rtc_register_device(vrtc->rtc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) static int __maybe_unused meson_vrtc_suspend(struct device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 	struct meson_vrtc_data *vrtc = dev_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 	dev_dbg(dev, "%s\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 	if (vrtc->alarm_time) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 		unsigned long local_time;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 		long alarm_secs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 		struct timespec64 time;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 		ktime_get_raw_ts64(&time);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 		local_time = time.tv_sec;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 		dev_dbg(dev, "alarm_time = %lus, local_time=%lus\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 			vrtc->alarm_time, local_time);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 		alarm_secs = vrtc->alarm_time - local_time;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 		if (alarm_secs > 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 			meson_vrtc_set_wakeup_time(vrtc, alarm_secs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 			dev_dbg(dev, "system will wakeup in %lds.\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 				alarm_secs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 		} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 			dev_err(dev, "alarm time already passed: %lds.\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 				alarm_secs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) static int __maybe_unused meson_vrtc_resume(struct device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 	struct meson_vrtc_data *vrtc = dev_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 	dev_dbg(dev, "%s\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 	vrtc->alarm_time = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 	meson_vrtc_set_wakeup_time(vrtc, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) static SIMPLE_DEV_PM_OPS(meson_vrtc_pm_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 			 meson_vrtc_suspend, meson_vrtc_resume);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) static const struct of_device_id meson_vrtc_dt_match[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 	{ .compatible = "amlogic,meson-vrtc"},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 	{},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) MODULE_DEVICE_TABLE(of, meson_vrtc_dt_match);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) static struct platform_driver meson_vrtc_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 	.probe = meson_vrtc_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 	.driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 		.name = "meson-vrtc",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 		.of_match_table = meson_vrtc_dt_match,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 		.pm = &meson_vrtc_pm_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) module_platform_driver(meson_vrtc_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) MODULE_DESCRIPTION("Amlogic Virtual Wakeup RTC Timer driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) MODULE_LICENSE("GPL");