Orange Pi5 kernel

^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) 2018 Socionext Inc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6) #include <linux/clk.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7) #include <linux/interrupt.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) #include <linux/irq.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) #include <linux/irqreturn.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <linux/sched_clock.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include "timer-of.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #define MLB_TMR_TMCSR_OFS	0x0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #define MLB_TMR_TMR_OFS		0x4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #define MLB_TMR_TMRLR1_OFS	0x8
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #define MLB_TMR_TMRLR2_OFS	0xc
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #define MLB_TMR_REGSZPCH	0x10
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #define MLB_TMR_TMCSR_OUTL	BIT(5)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #define MLB_TMR_TMCSR_RELD	BIT(4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) #define MLB_TMR_TMCSR_INTE	BIT(3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) #define MLB_TMR_TMCSR_UF	BIT(2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) #define MLB_TMR_TMCSR_CNTE	BIT(1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) #define MLB_TMR_TMCSR_TRG	BIT(0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) #define MLB_TMR_TMCSR_CSL_DIV2	0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) #define MLB_TMR_DIV_CNT		2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) #define MLB_TMR_SRC_CH		1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) #define MLB_TMR_EVT_CH		0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) #define MLB_TMR_SRC_CH_OFS	(MLB_TMR_REGSZPCH * MLB_TMR_SRC_CH)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) #define MLB_TMR_EVT_CH_OFS	(MLB_TMR_REGSZPCH * MLB_TMR_EVT_CH)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) #define MLB_TMR_SRC_TMCSR_OFS	(MLB_TMR_SRC_CH_OFS + MLB_TMR_TMCSR_OFS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) #define MLB_TMR_SRC_TMR_OFS	(MLB_TMR_SRC_CH_OFS + MLB_TMR_TMR_OFS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) #define MLB_TMR_SRC_TMRLR1_OFS	(MLB_TMR_SRC_CH_OFS + MLB_TMR_TMRLR1_OFS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) #define MLB_TMR_SRC_TMRLR2_OFS	(MLB_TMR_SRC_CH_OFS + MLB_TMR_TMRLR2_OFS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) #define MLB_TMR_EVT_TMCSR_OFS	(MLB_TMR_EVT_CH_OFS + MLB_TMR_TMCSR_OFS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) #define MLB_TMR_EVT_TMR_OFS	(MLB_TMR_EVT_CH_OFS + MLB_TMR_TMR_OFS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) #define MLB_TMR_EVT_TMRLR1_OFS	(MLB_TMR_EVT_CH_OFS + MLB_TMR_TMRLR1_OFS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) #define MLB_TMR_EVT_TMRLR2_OFS	(MLB_TMR_EVT_CH_OFS + MLB_TMR_TMRLR2_OFS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) #define MLB_TIMER_RATING	500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) #define MLB_TIMER_ONESHOT	0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) #define MLB_TIMER_PERIODIC	1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) static irqreturn_t mlb_timer_interrupt(int irq, void *dev_id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 	struct clock_event_device *clk = dev_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 	struct timer_of *to = to_timer_of(clk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 	u32 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 	val = readl_relaxed(timer_of_base(to) + MLB_TMR_EVT_TMCSR_OFS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 	val &= ~MLB_TMR_TMCSR_UF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 	writel_relaxed(val, timer_of_base(to) + MLB_TMR_EVT_TMCSR_OFS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 	clk->event_handler(clk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 	return IRQ_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) static void mlb_evt_timer_start(struct timer_of *to, bool periodic)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 	u32 val = MLB_TMR_TMCSR_CSL_DIV2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 	val |= MLB_TMR_TMCSR_CNTE | MLB_TMR_TMCSR_TRG | MLB_TMR_TMCSR_INTE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 	if (periodic)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 		val |= MLB_TMR_TMCSR_RELD;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 	writel_relaxed(val, timer_of_base(to) + MLB_TMR_EVT_TMCSR_OFS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) static void mlb_evt_timer_stop(struct timer_of *to)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 	u32 val = readl_relaxed(timer_of_base(to) + MLB_TMR_EVT_TMCSR_OFS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 	val &= ~MLB_TMR_TMCSR_CNTE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 	writel_relaxed(val, timer_of_base(to) + MLB_TMR_EVT_TMCSR_OFS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) static void mlb_evt_timer_register_count(struct timer_of *to, unsigned long cnt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	writel_relaxed(cnt, timer_of_base(to) + MLB_TMR_EVT_TMRLR1_OFS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) static int mlb_set_state_periodic(struct clock_event_device *clk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 	struct timer_of *to = to_timer_of(clk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 	mlb_evt_timer_stop(to);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 	mlb_evt_timer_register_count(to, to->of_clk.period);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 	mlb_evt_timer_start(to, MLB_TIMER_PERIODIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) static int mlb_set_state_oneshot(struct clock_event_device *clk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 	struct timer_of *to = to_timer_of(clk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 	mlb_evt_timer_stop(to);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 	mlb_evt_timer_start(to, MLB_TIMER_ONESHOT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) static int mlb_set_state_shutdown(struct clock_event_device *clk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 	struct timer_of *to = to_timer_of(clk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 	mlb_evt_timer_stop(to);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 	return 0;
^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) static int mlb_clkevt_next_event(unsigned long event,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 				   struct clock_event_device *clk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 	struct timer_of *to = to_timer_of(clk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 	mlb_evt_timer_stop(to);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 	mlb_evt_timer_register_count(to, event);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 	mlb_evt_timer_start(to, MLB_TIMER_ONESHOT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) static int mlb_config_clock_source(struct timer_of *to)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 	u32 val = MLB_TMR_TMCSR_CSL_DIV2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 	writel_relaxed(val, timer_of_base(to) + MLB_TMR_SRC_TMCSR_OFS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 	writel_relaxed(~0, timer_of_base(to) + MLB_TMR_SRC_TMRLR1_OFS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 	writel_relaxed(~0, timer_of_base(to) + MLB_TMR_SRC_TMRLR2_OFS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 	val |= MLB_TMR_TMCSR_RELD | MLB_TMR_TMCSR_CNTE | MLB_TMR_TMCSR_TRG;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 	writel_relaxed(val, timer_of_base(to) + MLB_TMR_SRC_TMCSR_OFS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) static int mlb_config_clock_event(struct timer_of *to)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 	writel_relaxed(0, timer_of_base(to) + MLB_TMR_EVT_TMCSR_OFS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) static struct timer_of to = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 	.flags = TIMER_OF_IRQ | TIMER_OF_BASE | TIMER_OF_CLOCK,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 	.clkevt = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 		.name = "mlb-clkevt",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 		.rating = MLB_TIMER_RATING,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 		.cpumask = cpu_possible_mask,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 		.features = CLOCK_EVT_FEAT_DYNIRQ | CLOCK_EVT_FEAT_ONESHOT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 		.set_state_oneshot = mlb_set_state_oneshot,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 		.set_state_periodic = mlb_set_state_periodic,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 		.set_state_shutdown = mlb_set_state_shutdown,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 		.set_next_event = mlb_clkevt_next_event,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 	.of_irq = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 		.flags = IRQF_TIMER | IRQF_IRQPOLL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 		.handler = mlb_timer_interrupt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) static u64 notrace mlb_timer_sched_read(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 	return ~readl_relaxed(timer_of_base(&to) + MLB_TMR_SRC_TMR_OFS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) static int __init mlb_timer_init(struct device_node *node)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 	unsigned long rate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 	ret = timer_of_init(node, &to);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 	rate = timer_of_rate(&to) / MLB_TMR_DIV_CNT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 	mlb_config_clock_source(&to);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 	clocksource_mmio_init(timer_of_base(&to) + MLB_TMR_SRC_TMR_OFS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 		node->name, rate, MLB_TIMER_RATING, 32,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 		clocksource_mmio_readl_down);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 	sched_clock_register(mlb_timer_sched_read, 32, rate);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 	mlb_config_clock_event(&to);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 	clockevents_config_and_register(&to.clkevt, timer_of_rate(&to), 15,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 		0xffffffff);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) TIMER_OF_DECLARE(mlb_peritimer, "socionext,milbeaut-timer",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 		mlb_timer_init);