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-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  *  DS1287 clockevent driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  *  Copyright (C) 2008	Yoichi Yuasa <yuasa@linux-mips.org>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7) #include <linux/clockchips.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) #include <linux/interrupt.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <linux/mc146818rtc.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include <linux/irq.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include <asm/time.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) int ds1287_timer_state(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) 	return (CMOS_READ(RTC_REG_C) & RTC_PF) != 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) int ds1287_set_base_clock(unsigned int hz)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) 	u8 rate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) 	switch (hz) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) 	case 128:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) 		rate = 0x9;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 	case 256:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) 		rate = 0x8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) 	case 1024:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) 		rate = 0x6;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 		return -EINVAL;
^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) 	CMOS_WRITE(RTC_REF_CLCK_32KHZ | rate, RTC_REG_A);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) static int ds1287_set_next_event(unsigned long delta,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 				 struct clock_event_device *evt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 	return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) static int ds1287_shutdown(struct clock_event_device *evt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 	u8 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 	spin_lock(&rtc_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 	val = CMOS_READ(RTC_REG_B);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 	val &= ~RTC_PIE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 	CMOS_WRITE(val, RTC_REG_B);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 	spin_unlock(&rtc_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) static int ds1287_set_periodic(struct clock_event_device *evt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 	u8 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 	spin_lock(&rtc_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 	val = CMOS_READ(RTC_REG_B);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 	val |= RTC_PIE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 	CMOS_WRITE(val, RTC_REG_B);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	spin_unlock(&rtc_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) static void ds1287_event_handler(struct clock_event_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) static struct clock_event_device ds1287_clockevent = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 	.name			= "ds1287",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 	.features		= CLOCK_EVT_FEAT_PERIODIC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	.set_next_event		= ds1287_set_next_event,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 	.set_state_shutdown	= ds1287_shutdown,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 	.set_state_periodic	= ds1287_set_periodic,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 	.tick_resume		= ds1287_shutdown,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 	.event_handler		= ds1287_event_handler,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) static irqreturn_t ds1287_interrupt(int irq, void *dev_id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 	struct clock_event_device *cd = &ds1287_clockevent;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 	/* Ack the RTC interrupt. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 	CMOS_READ(RTC_REG_C);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 	cd->event_handler(cd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 	return IRQ_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) int __init ds1287_clockevent_init(int irq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 	unsigned long flags = IRQF_PERCPU | IRQF_TIMER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 	struct clock_event_device *cd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 	cd = &ds1287_clockevent;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 	cd->rating = 100;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 	cd->irq = irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 	clockevent_set_clock(cd, 32768);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 	cd->max_delta_ns = clockevent_delta2ns(0x7fffffff, cd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 	cd->max_delta_ticks = 0x7fffffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 	cd->min_delta_ns = clockevent_delta2ns(0x300, cd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 	cd->min_delta_ticks = 0x300;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 	cd->cpumask = cpumask_of(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 	clockevents_register_device(&ds1287_clockevent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 	return request_irq(irq, ds1287_interrupt, flags, "ds1287", NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) }