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