Loading...
1// SPDX-License-Identifier: GPL-2.0
2/*
3 * H8S TPU Driver
4 *
5 * Copyright 2015 Yoshinori Sato <ysato@users.sourcefoge.jp>
6 *
7 */
8
9#include <linux/errno.h>
10#include <linux/kernel.h>
11#include <linux/init.h>
12#include <linux/clocksource.h>
13#include <linux/clk.h>
14#include <linux/io.h>
15#include <linux/of.h>
16#include <linux/of_address.h>
17#include <linux/of_irq.h>
18
19#define TCR 0x0
20#define TSR 0x5
21#define TCNT 0x6
22
23#define TCFV 0x10
24
25struct tpu_priv {
26 struct clocksource cs;
27 void __iomem *mapbase1;
28 void __iomem *mapbase2;
29 raw_spinlock_t lock;
30 unsigned int cs_enabled;
31};
32
33static inline unsigned long read_tcnt32(struct tpu_priv *p)
34{
35 unsigned long tcnt;
36
37 tcnt = ioread16be(p->mapbase1 + TCNT) << 16;
38 tcnt |= ioread16be(p->mapbase2 + TCNT);
39 return tcnt;
40}
41
42static int tpu_get_counter(struct tpu_priv *p, unsigned long long *val)
43{
44 unsigned long v1, v2, v3;
45 int o1, o2;
46
47 o1 = ioread8(p->mapbase1 + TSR) & TCFV;
48
49 /* Make sure the timer value is stable. Stolen from acpi_pm.c */
50 do {
51 o2 = o1;
52 v1 = read_tcnt32(p);
53 v2 = read_tcnt32(p);
54 v3 = read_tcnt32(p);
55 o1 = ioread8(p->mapbase1 + TSR) & TCFV;
56 } while (unlikely((o1 != o2) || (v1 > v2 && v1 < v3)
57 || (v2 > v3 && v2 < v1) || (v3 > v1 && v3 < v2)));
58
59 *val = v2;
60 return o1;
61}
62
63static inline struct tpu_priv *cs_to_priv(struct clocksource *cs)
64{
65 return container_of(cs, struct tpu_priv, cs);
66}
67
68static u64 tpu_clocksource_read(struct clocksource *cs)
69{
70 struct tpu_priv *p = cs_to_priv(cs);
71 unsigned long flags;
72 unsigned long long value;
73
74 raw_spin_lock_irqsave(&p->lock, flags);
75 if (tpu_get_counter(p, &value))
76 value += 0x100000000;
77 raw_spin_unlock_irqrestore(&p->lock, flags);
78
79 return value;
80}
81
82static int tpu_clocksource_enable(struct clocksource *cs)
83{
84 struct tpu_priv *p = cs_to_priv(cs);
85
86 WARN_ON(p->cs_enabled);
87
88 iowrite16be(0, p->mapbase1 + TCNT);
89 iowrite16be(0, p->mapbase2 + TCNT);
90 iowrite8(0x0f, p->mapbase1 + TCR);
91 iowrite8(0x03, p->mapbase2 + TCR);
92
93 p->cs_enabled = true;
94 return 0;
95}
96
97static void tpu_clocksource_disable(struct clocksource *cs)
98{
99 struct tpu_priv *p = cs_to_priv(cs);
100
101 WARN_ON(!p->cs_enabled);
102
103 iowrite8(0, p->mapbase1 + TCR);
104 iowrite8(0, p->mapbase2 + TCR);
105 p->cs_enabled = false;
106}
107
108static struct tpu_priv tpu_priv = {
109 .cs = {
110 .name = "H8S_TPU",
111 .rating = 200,
112 .read = tpu_clocksource_read,
113 .enable = tpu_clocksource_enable,
114 .disable = tpu_clocksource_disable,
115 .mask = CLOCKSOURCE_MASK(sizeof(unsigned long) * 8),
116 .flags = CLOCK_SOURCE_IS_CONTINUOUS,
117 },
118};
119
120#define CH_L 0
121#define CH_H 1
122
123static int __init h8300_tpu_init(struct device_node *node)
124{
125 void __iomem *base[2];
126 struct clk *clk;
127 int ret = -ENXIO;
128
129 clk = of_clk_get(node, 0);
130 if (IS_ERR(clk)) {
131 pr_err("failed to get clock for clocksource\n");
132 return PTR_ERR(clk);
133 }
134
135 base[CH_L] = of_iomap(node, CH_L);
136 if (!base[CH_L]) {
137 pr_err("failed to map registers for clocksource\n");
138 goto free_clk;
139 }
140 base[CH_H] = of_iomap(node, CH_H);
141 if (!base[CH_H]) {
142 pr_err("failed to map registers for clocksource\n");
143 goto unmap_L;
144 }
145
146 tpu_priv.mapbase1 = base[CH_L];
147 tpu_priv.mapbase2 = base[CH_H];
148
149 return clocksource_register_hz(&tpu_priv.cs, clk_get_rate(clk) / 64);
150
151unmap_L:
152 iounmap(base[CH_H]);
153free_clk:
154 clk_put(clk);
155 return ret;
156}
157
158TIMER_OF_DECLARE(h8300_tpu, "renesas,tpu", h8300_tpu_init);
1/*
2 * H8S TPU Driver
3 *
4 * Copyright 2015 Yoshinori Sato <ysato@users.sourcefoge.jp>
5 *
6 */
7
8#include <linux/errno.h>
9#include <linux/kernel.h>
10#include <linux/init.h>
11#include <linux/clocksource.h>
12#include <linux/clk.h>
13#include <linux/io.h>
14#include <linux/of.h>
15#include <linux/of_address.h>
16#include <linux/of_irq.h>
17
18#define TCR 0x0
19#define TSR 0x5
20#define TCNT 0x6
21
22#define TCFV 0x10
23
24struct tpu_priv {
25 struct clocksource cs;
26 void __iomem *mapbase1;
27 void __iomem *mapbase2;
28 raw_spinlock_t lock;
29 unsigned int cs_enabled;
30};
31
32static inline unsigned long read_tcnt32(struct tpu_priv *p)
33{
34 unsigned long tcnt;
35
36 tcnt = ioread16be(p->mapbase1 + TCNT) << 16;
37 tcnt |= ioread16be(p->mapbase2 + TCNT);
38 return tcnt;
39}
40
41static int tpu_get_counter(struct tpu_priv *p, unsigned long long *val)
42{
43 unsigned long v1, v2, v3;
44 int o1, o2;
45
46 o1 = ioread8(p->mapbase1 + TSR) & TCFV;
47
48 /* Make sure the timer value is stable. Stolen from acpi_pm.c */
49 do {
50 o2 = o1;
51 v1 = read_tcnt32(p);
52 v2 = read_tcnt32(p);
53 v3 = read_tcnt32(p);
54 o1 = ioread8(p->mapbase1 + TSR) & TCFV;
55 } while (unlikely((o1 != o2) || (v1 > v2 && v1 < v3)
56 || (v2 > v3 && v2 < v1) || (v3 > v1 && v3 < v2)));
57
58 *val = v2;
59 return o1;
60}
61
62static inline struct tpu_priv *cs_to_priv(struct clocksource *cs)
63{
64 return container_of(cs, struct tpu_priv, cs);
65}
66
67static cycle_t tpu_clocksource_read(struct clocksource *cs)
68{
69 struct tpu_priv *p = cs_to_priv(cs);
70 unsigned long flags;
71 unsigned long long value;
72
73 raw_spin_lock_irqsave(&p->lock, flags);
74 if (tpu_get_counter(p, &value))
75 value += 0x100000000;
76 raw_spin_unlock_irqrestore(&p->lock, flags);
77
78 return value;
79}
80
81static int tpu_clocksource_enable(struct clocksource *cs)
82{
83 struct tpu_priv *p = cs_to_priv(cs);
84
85 WARN_ON(p->cs_enabled);
86
87 iowrite16be(0, p->mapbase1 + TCNT);
88 iowrite16be(0, p->mapbase2 + TCNT);
89 iowrite8(0x0f, p->mapbase1 + TCR);
90 iowrite8(0x03, p->mapbase2 + TCR);
91
92 p->cs_enabled = true;
93 return 0;
94}
95
96static void tpu_clocksource_disable(struct clocksource *cs)
97{
98 struct tpu_priv *p = cs_to_priv(cs);
99
100 WARN_ON(!p->cs_enabled);
101
102 iowrite8(0, p->mapbase1 + TCR);
103 iowrite8(0, p->mapbase2 + TCR);
104 p->cs_enabled = false;
105}
106
107static struct tpu_priv tpu_priv = {
108 .cs = {
109 .name = "H8S_TPU",
110 .rating = 200,
111 .read = tpu_clocksource_read,
112 .enable = tpu_clocksource_enable,
113 .disable = tpu_clocksource_disable,
114 .mask = CLOCKSOURCE_MASK(sizeof(unsigned long) * 8),
115 .flags = CLOCK_SOURCE_IS_CONTINUOUS,
116 },
117};
118
119#define CH_L 0
120#define CH_H 1
121
122static void __init h8300_tpu_init(struct device_node *node)
123{
124 void __iomem *base[2];
125 struct clk *clk;
126
127 clk = of_clk_get(node, 0);
128 if (IS_ERR(clk)) {
129 pr_err("failed to get clock for clocksource\n");
130 return;
131 }
132
133 base[CH_L] = of_iomap(node, CH_L);
134 if (!base[CH_L]) {
135 pr_err("failed to map registers for clocksource\n");
136 goto free_clk;
137 }
138 base[CH_H] = of_iomap(node, CH_H);
139 if (!base[CH_H]) {
140 pr_err("failed to map registers for clocksource\n");
141 goto unmap_L;
142 }
143
144 tpu_priv.mapbase1 = base[CH_L];
145 tpu_priv.mapbase2 = base[CH_H];
146
147 clocksource_register_hz(&tpu_priv.cs, clk_get_rate(clk) / 64);
148
149 return;
150
151unmap_L:
152 iounmap(base[CH_H]);
153free_clk:
154 clk_put(clk);
155}
156
157CLOCKSOURCE_OF_DECLARE(h8300_tpu, "renesas,tpu", h8300_tpu_init);