tegra_timer.c revision 1.6 1 1.6 jmcneill /* $NetBSD: tegra_timer.c,v 1.6 2017/05/25 23:54:45 jmcneill Exp $ */
2 1.1 jmcneill
3 1.1 jmcneill /*-
4 1.1 jmcneill * Copyright (c) 2015 Jared D. McNeill <jmcneill (at) invisible.ca>
5 1.1 jmcneill * All rights reserved.
6 1.1 jmcneill *
7 1.1 jmcneill * Redistribution and use in source and binary forms, with or without
8 1.1 jmcneill * modification, are permitted provided that the following conditions
9 1.1 jmcneill * are met:
10 1.1 jmcneill * 1. Redistributions of source code must retain the above copyright
11 1.1 jmcneill * notice, this list of conditions and the following disclaimer.
12 1.1 jmcneill * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 jmcneill * notice, this list of conditions and the following disclaimer in the
14 1.1 jmcneill * documentation and/or other materials provided with the distribution.
15 1.1 jmcneill *
16 1.1 jmcneill * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 1.1 jmcneill * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 1.1 jmcneill * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 1.1 jmcneill * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 1.1 jmcneill * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
21 1.1 jmcneill * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
22 1.1 jmcneill * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
23 1.1 jmcneill * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
24 1.1 jmcneill * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 1.1 jmcneill * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 1.1 jmcneill * SUCH DAMAGE.
27 1.1 jmcneill */
28 1.1 jmcneill
29 1.1 jmcneill #include <sys/cdefs.h>
30 1.6 jmcneill __KERNEL_RCSID(0, "$NetBSD: tegra_timer.c,v 1.6 2017/05/25 23:54:45 jmcneill Exp $");
31 1.1 jmcneill
32 1.1 jmcneill #include <sys/param.h>
33 1.1 jmcneill #include <sys/bus.h>
34 1.1 jmcneill #include <sys/device.h>
35 1.1 jmcneill #include <sys/intr.h>
36 1.1 jmcneill #include <sys/systm.h>
37 1.1 jmcneill #include <sys/kernel.h>
38 1.1 jmcneill #include <sys/wdog.h>
39 1.1 jmcneill
40 1.1 jmcneill #include <dev/sysmon/sysmonvar.h>
41 1.1 jmcneill
42 1.1 jmcneill #include <arm/nvidia/tegra_reg.h>
43 1.1 jmcneill #include <arm/nvidia/tegra_timerreg.h>
44 1.1 jmcneill #include <arm/nvidia/tegra_var.h>
45 1.1 jmcneill
46 1.2 jmcneill #include <dev/fdt/fdtvar.h>
47 1.2 jmcneill
48 1.1 jmcneill #define TEGRA_TIMER_WDOG_PERIOD_DEFAULT 10
49 1.1 jmcneill
50 1.1 jmcneill static int tegra_timer_match(device_t, cfdata_t, void *);
51 1.1 jmcneill static void tegra_timer_attach(device_t, device_t, void *);
52 1.1 jmcneill
53 1.1 jmcneill struct tegra_timer_softc {
54 1.1 jmcneill device_t sc_dev;
55 1.1 jmcneill bus_space_tag_t sc_bst;
56 1.1 jmcneill bus_space_handle_t sc_bsh;
57 1.1 jmcneill
58 1.1 jmcneill struct sysmon_wdog sc_smw;
59 1.1 jmcneill };
60 1.1 jmcneill
61 1.1 jmcneill static int tegra_timer_wdt_setmode(struct sysmon_wdog *);
62 1.1 jmcneill static int tegra_timer_wdt_tickle(struct sysmon_wdog *);
63 1.1 jmcneill
64 1.1 jmcneill CFATTACH_DECL_NEW(tegra_timer, sizeof(struct tegra_timer_softc),
65 1.1 jmcneill tegra_timer_match, tegra_timer_attach, NULL, NULL);
66 1.1 jmcneill
67 1.1 jmcneill #define TIMER_READ(sc, reg) \
68 1.1 jmcneill bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg))
69 1.1 jmcneill #define TIMER_WRITE(sc, reg, val) \
70 1.1 jmcneill bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val))
71 1.1 jmcneill #define TIMER_SET_CLEAR(sc, reg, set, clr) \
72 1.1 jmcneill tegra_reg_set_clear((sc)->sc_bst, (sc)->sc_bsh, (reg), (set), (clr))
73 1.1 jmcneill
74 1.1 jmcneill static int
75 1.1 jmcneill tegra_timer_match(device_t parent, cfdata_t cf, void *aux)
76 1.1 jmcneill {
77 1.6 jmcneill const char * const compatible[] = {
78 1.6 jmcneill "nvidia,tegra210-timer",
79 1.6 jmcneill "nvidia,tegra124-timer",
80 1.6 jmcneill "nvidia,tegra20-timer",
81 1.6 jmcneill NULL
82 1.6 jmcneill };
83 1.2 jmcneill struct fdt_attach_args * const faa = aux;
84 1.2 jmcneill
85 1.2 jmcneill return of_match_compatible(faa->faa_phandle, compatible);
86 1.1 jmcneill }
87 1.1 jmcneill
88 1.1 jmcneill static void
89 1.1 jmcneill tegra_timer_attach(device_t parent, device_t self, void *aux)
90 1.1 jmcneill {
91 1.1 jmcneill struct tegra_timer_softc * const sc = device_private(self);
92 1.2 jmcneill struct fdt_attach_args * const faa = aux;
93 1.2 jmcneill bus_addr_t addr;
94 1.2 jmcneill bus_size_t size;
95 1.2 jmcneill int error;
96 1.2 jmcneill
97 1.2 jmcneill if (fdtbus_get_reg(faa->faa_phandle, 0, &addr, &size) != 0) {
98 1.2 jmcneill aprint_error(": couldn't get registers\n");
99 1.2 jmcneill return;
100 1.2 jmcneill }
101 1.1 jmcneill
102 1.1 jmcneill sc->sc_dev = self;
103 1.2 jmcneill sc->sc_bst = faa->faa_bst;
104 1.2 jmcneill error = bus_space_map(sc->sc_bst, addr, size, 0, &sc->sc_bsh);
105 1.2 jmcneill if (error) {
106 1.2 jmcneill aprint_error(": couldn't map %#llx: %d", (uint64_t)addr, error);
107 1.2 jmcneill return;
108 1.2 jmcneill }
109 1.1 jmcneill
110 1.1 jmcneill aprint_naive("\n");
111 1.1 jmcneill aprint_normal(": Timers\n");
112 1.1 jmcneill
113 1.5 jmcneill sc->sc_smw.smw_name = device_xname(self);
114 1.5 jmcneill sc->sc_smw.smw_cookie = sc;
115 1.5 jmcneill sc->sc_smw.smw_setmode = tegra_timer_wdt_setmode;
116 1.5 jmcneill sc->sc_smw.smw_tickle = tegra_timer_wdt_tickle;
117 1.5 jmcneill sc->sc_smw.smw_period = TEGRA_TIMER_WDOG_PERIOD_DEFAULT;
118 1.5 jmcneill
119 1.5 jmcneill aprint_normal_dev(self,
120 1.5 jmcneill "default watchdog period is %u seconds\n",
121 1.5 jmcneill sc->sc_smw.smw_period);
122 1.5 jmcneill
123 1.5 jmcneill if (sysmon_wdog_register(&sc->sc_smw) != 0) {
124 1.5 jmcneill aprint_error_dev(self,
125 1.5 jmcneill "couldn't register with sysmon\n");
126 1.3 jmcneill }
127 1.1 jmcneill }
128 1.1 jmcneill
129 1.1 jmcneill static int
130 1.1 jmcneill tegra_timer_wdt_setmode(struct sysmon_wdog *smw)
131 1.1 jmcneill {
132 1.1 jmcneill struct tegra_timer_softc * const sc = smw->smw_cookie;
133 1.1 jmcneill
134 1.1 jmcneill if ((smw->smw_mode & WDOG_MODE_MASK) == WDOG_MODE_DISARMED) {
135 1.1 jmcneill TIMER_SET_CLEAR(sc, TMR1_PTV_REG, 0, TMR_PTV_EN);
136 1.1 jmcneill } else {
137 1.1 jmcneill if (smw->smw_period == WDOG_PERIOD_DEFAULT) {
138 1.1 jmcneill sc->sc_smw.smw_period = TEGRA_TIMER_WDOG_PERIOD_DEFAULT;
139 1.1 jmcneill } else if (smw->smw_period == 0 || smw->smw_period > 1000) {
140 1.1 jmcneill return EINVAL;
141 1.1 jmcneill } else {
142 1.1 jmcneill sc->sc_smw.smw_period = smw->smw_period;
143 1.1 jmcneill }
144 1.1 jmcneill u_int tval = (sc->sc_smw.smw_period * 1000000) / 2;
145 1.1 jmcneill TIMER_WRITE(sc, TMR1_PTV_REG,
146 1.1 jmcneill TMR_PTV_EN | TMR_PTV_PER | __SHIFTIN(tval, TMR_PTV_VAL));
147 1.1 jmcneill TIMER_WRITE(sc, TMR1_PCR_REG, TMR_PCR_INTR_CLR);
148 1.1 jmcneill }
149 1.5 jmcneill
150 1.5 jmcneill return 0;
151 1.1 jmcneill }
152 1.1 jmcneill
153 1.1 jmcneill static int
154 1.1 jmcneill tegra_timer_wdt_tickle(struct sysmon_wdog *smw)
155 1.1 jmcneill {
156 1.1 jmcneill struct tegra_timer_softc * const sc = smw->smw_cookie;
157 1.1 jmcneill
158 1.1 jmcneill TIMER_WRITE(sc, TMR1_PCR_REG, TMR_PCR_INTR_CLR);
159 1.1 jmcneill
160 1.1 jmcneill return 0;
161 1.1 jmcneill }
162 1.3 jmcneill
163 1.3 jmcneill void
164 1.3 jmcneill delay(u_int us)
165 1.3 jmcneill {
166 1.3 jmcneill static bool timerus_configured = false;
167 1.3 jmcneill bus_space_tag_t bst = &armv7_generic_bs_tag;
168 1.3 jmcneill bus_space_handle_t bsh;
169 1.3 jmcneill
170 1.3 jmcneill bus_space_subregion(bst, tegra_ppsb_bsh, TEGRA_TIMER_OFFSET,
171 1.3 jmcneill TEGRA_TIMER_SIZE, &bsh);
172 1.3 jmcneill
173 1.3 jmcneill if (__predict_false(timerus_configured == false)) {
174 1.3 jmcneill /* clk_m frequency 12 MHz */
175 1.3 jmcneill bus_space_write_4(bst, bsh, TMRUS_USEC_CFG_REG, 0xb);
176 1.3 jmcneill timerus_configured = true;
177 1.3 jmcneill }
178 1.3 jmcneill
179 1.3 jmcneill u_int nus = 0;
180 1.3 jmcneill u_int us_prev = bus_space_read_4(bst, bsh, TMRUS_CNTR_1US_REG);
181 1.3 jmcneill
182 1.3 jmcneill while (nus < us) {
183 1.3 jmcneill const u_int us_cur = bus_space_read_4(bst, bsh,
184 1.3 jmcneill TMRUS_CNTR_1US_REG);
185 1.3 jmcneill if (us_cur < us_prev) {
186 1.3 jmcneill nus += (0xffffffff - us_prev) + us_cur;
187 1.3 jmcneill } else {
188 1.3 jmcneill nus += (us_cur - us_prev);
189 1.3 jmcneill }
190 1.3 jmcneill us_prev = us_cur;
191 1.3 jmcneill }
192 1.3 jmcneill }
193