1373bbe25SRafal Jaworowski /*- 2373bbe25SRafal Jaworowski * Copyright (c) 2006 Benno Rice. 3373bbe25SRafal Jaworowski * Copyright (C) 2007-2008 MARVELL INTERNATIONAL LTD. 4373bbe25SRafal Jaworowski * All rights reserved. 5373bbe25SRafal Jaworowski * 6373bbe25SRafal Jaworowski * Adapted to Marvell SoC by Semihalf. 7373bbe25SRafal Jaworowski * 8373bbe25SRafal Jaworowski * Redistribution and use in source and binary forms, with or without 9373bbe25SRafal Jaworowski * modification, are permitted provided that the following conditions 10373bbe25SRafal Jaworowski * are met: 11373bbe25SRafal Jaworowski * 1. Redistributions of source code must retain the above copyright 12373bbe25SRafal Jaworowski * notice, this list of conditions and the following disclaimer. 13373bbe25SRafal Jaworowski * 2. Redistributions in binary form must reproduce the above copyright 14373bbe25SRafal Jaworowski * notice, this list of conditions and the following disclaimer in the 15373bbe25SRafal Jaworowski * documentation and/or other materials provided with the distribution. 16373bbe25SRafal Jaworowski * 17373bbe25SRafal Jaworowski * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 18373bbe25SRafal Jaworowski * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 19373bbe25SRafal Jaworowski * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 20373bbe25SRafal Jaworowski * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 21373bbe25SRafal Jaworowski * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 22373bbe25SRafal Jaworowski * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 23373bbe25SRafal Jaworowski * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 24373bbe25SRafal Jaworowski * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 25373bbe25SRafal Jaworowski * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 26373bbe25SRafal Jaworowski * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 27373bbe25SRafal Jaworowski * 28373bbe25SRafal Jaworowski * from: FreeBSD: //depot/projects/arm/src/sys/arm/xscale/pxa2x0/pxa2x0_timer.c, rev 1 29373bbe25SRafal Jaworowski */ 30373bbe25SRafal Jaworowski 31373bbe25SRafal Jaworowski #include <sys/cdefs.h> 32373bbe25SRafal Jaworowski __FBSDID("$FreeBSD$"); 33373bbe25SRafal Jaworowski 34373bbe25SRafal Jaworowski #include <sys/param.h> 35373bbe25SRafal Jaworowski #include <sys/systm.h> 36373bbe25SRafal Jaworowski #include <sys/bus.h> 37373bbe25SRafal Jaworowski #include <sys/kernel.h> 38373bbe25SRafal Jaworowski #include <sys/module.h> 39373bbe25SRafal Jaworowski #include <sys/malloc.h> 40373bbe25SRafal Jaworowski #include <sys/rman.h> 41e9f0d565SAlexander Motin #include <sys/timeet.h> 42373bbe25SRafal Jaworowski #include <sys/timetc.h> 43373bbe25SRafal Jaworowski #include <sys/watchdog.h> 44373bbe25SRafal Jaworowski #include <machine/bus.h> 45373bbe25SRafal Jaworowski #include <machine/cpu.h> 46373bbe25SRafal Jaworowski #include <machine/frame.h> 47373bbe25SRafal Jaworowski #include <machine/intr.h> 48373bbe25SRafal Jaworowski 49373bbe25SRafal Jaworowski #include <arm/mv/mvreg.h> 50373bbe25SRafal Jaworowski #include <arm/mv/mvvar.h> 51373bbe25SRafal Jaworowski 52db5ef4fcSRafal Jaworowski #include <dev/ofw/ofw_bus.h> 53db5ef4fcSRafal Jaworowski #include <dev/ofw/ofw_bus_subr.h> 54db5ef4fcSRafal Jaworowski 55373bbe25SRafal Jaworowski #define INITIAL_TIMECOUNTER (0xffffffff) 56373bbe25SRafal Jaworowski #define MAX_WATCHDOG_TICKS (0xffffffff) 57373bbe25SRafal Jaworowski 5816694521SOleksandr Tymoshenko #if defined(SOC_MV_ARMADAXP) 5916694521SOleksandr Tymoshenko #define MV_CLOCK_SRC get_l2clk() 6016694521SOleksandr Tymoshenko #else 6116694521SOleksandr Tymoshenko #define MV_CLOCK_SRC get_tclk() 6216694521SOleksandr Tymoshenko #endif 6316694521SOleksandr Tymoshenko 64373bbe25SRafal Jaworowski struct mv_timer_softc { 65373bbe25SRafal Jaworowski struct resource * timer_res[2]; 66373bbe25SRafal Jaworowski bus_space_tag_t timer_bst; 67373bbe25SRafal Jaworowski bus_space_handle_t timer_bsh; 68373bbe25SRafal Jaworowski struct mtx timer_mtx; 69e9f0d565SAlexander Motin struct eventtimer et; 70373bbe25SRafal Jaworowski }; 71373bbe25SRafal Jaworowski 72373bbe25SRafal Jaworowski static struct resource_spec mv_timer_spec[] = { 73373bbe25SRafal Jaworowski { SYS_RES_MEMORY, 0, RF_ACTIVE }, 74373bbe25SRafal Jaworowski { SYS_RES_IRQ, 0, RF_ACTIVE }, 75373bbe25SRafal Jaworowski { -1, 0 } 76373bbe25SRafal Jaworowski }; 77373bbe25SRafal Jaworowski 78373bbe25SRafal Jaworowski static struct mv_timer_softc *timer_softc = NULL; 79373bbe25SRafal Jaworowski static int timers_initialized = 0; 80373bbe25SRafal Jaworowski 81373bbe25SRafal Jaworowski static int mv_timer_probe(device_t); 82373bbe25SRafal Jaworowski static int mv_timer_attach(device_t); 83373bbe25SRafal Jaworowski 84373bbe25SRafal Jaworowski static int mv_hardclock(void *); 85373bbe25SRafal Jaworowski static unsigned mv_timer_get_timecount(struct timecounter *); 86373bbe25SRafal Jaworowski 87373bbe25SRafal Jaworowski static uint32_t mv_get_timer_control(void); 88373bbe25SRafal Jaworowski static void mv_set_timer_control(uint32_t); 89373bbe25SRafal Jaworowski static uint32_t mv_get_timer(uint32_t); 90373bbe25SRafal Jaworowski static void mv_set_timer(uint32_t, uint32_t); 91373bbe25SRafal Jaworowski static void mv_set_timer_rel(uint32_t, uint32_t); 92373bbe25SRafal Jaworowski static void mv_watchdog_enable(void); 93373bbe25SRafal Jaworowski static void mv_watchdog_disable(void); 94373bbe25SRafal Jaworowski static void mv_watchdog_event(void *, unsigned int, int *); 95e9f0d565SAlexander Motin static int mv_timer_start(struct eventtimer *et, 96e9f0d565SAlexander Motin struct bintime *first, struct bintime *period); 97e9f0d565SAlexander Motin static int mv_timer_stop(struct eventtimer *et); 98e9f0d565SAlexander Motin static void mv_setup_timers(void); 99373bbe25SRafal Jaworowski 100373bbe25SRafal Jaworowski static struct timecounter mv_timer_timecounter = { 101373bbe25SRafal Jaworowski .tc_get_timecount = mv_timer_get_timecount, 102e9f0d565SAlexander Motin .tc_name = "CPUTimer1", 103373bbe25SRafal Jaworowski .tc_frequency = 0, /* This is assigned on the fly in the init sequence */ 104373bbe25SRafal Jaworowski .tc_counter_mask = ~0u, 105373bbe25SRafal Jaworowski .tc_quality = 1000, 106373bbe25SRafal Jaworowski }; 107373bbe25SRafal Jaworowski 108373bbe25SRafal Jaworowski static int 109373bbe25SRafal Jaworowski mv_timer_probe(device_t dev) 110373bbe25SRafal Jaworowski { 111373bbe25SRafal Jaworowski 112db5ef4fcSRafal Jaworowski if (!ofw_bus_is_compatible(dev, "mrvl,timer")) 113db5ef4fcSRafal Jaworowski return (ENXIO); 114db5ef4fcSRafal Jaworowski 115373bbe25SRafal Jaworowski device_set_desc(dev, "Marvell CPU Timer"); 116373bbe25SRafal Jaworowski return (0); 117373bbe25SRafal Jaworowski } 118373bbe25SRafal Jaworowski 119373bbe25SRafal Jaworowski static int 120373bbe25SRafal Jaworowski mv_timer_attach(device_t dev) 121373bbe25SRafal Jaworowski { 122373bbe25SRafal Jaworowski int error; 123373bbe25SRafal Jaworowski void *ihl; 124373bbe25SRafal Jaworowski struct mv_timer_softc *sc; 12516694521SOleksandr Tymoshenko #if !defined(SOC_MV_ARMADAXP) 126e9f0d565SAlexander Motin uint32_t irq_cause, irq_mask; 12716694521SOleksandr Tymoshenko #endif 128373bbe25SRafal Jaworowski 129373bbe25SRafal Jaworowski if (timer_softc != NULL) 130373bbe25SRafal Jaworowski return (ENXIO); 131373bbe25SRafal Jaworowski 132373bbe25SRafal Jaworowski sc = (struct mv_timer_softc *)device_get_softc(dev); 133373bbe25SRafal Jaworowski timer_softc = sc; 134373bbe25SRafal Jaworowski 135373bbe25SRafal Jaworowski error = bus_alloc_resources(dev, mv_timer_spec, sc->timer_res); 136373bbe25SRafal Jaworowski if (error) { 137373bbe25SRafal Jaworowski device_printf(dev, "could not allocate resources\n"); 138373bbe25SRafal Jaworowski return (ENXIO); 139373bbe25SRafal Jaworowski } 140373bbe25SRafal Jaworowski 141373bbe25SRafal Jaworowski sc->timer_bst = rman_get_bustag(sc->timer_res[0]); 142373bbe25SRafal Jaworowski sc->timer_bsh = rman_get_bushandle(sc->timer_res[0]); 143373bbe25SRafal Jaworowski 144373bbe25SRafal Jaworowski mtx_init(&timer_softc->timer_mtx, "watchdog", NULL, MTX_DEF); 145373bbe25SRafal Jaworowski mv_watchdog_disable(); 146373bbe25SRafal Jaworowski EVENTHANDLER_REGISTER(watchdog_list, mv_watchdog_event, sc, 0); 147373bbe25SRafal Jaworowski 148373bbe25SRafal Jaworowski if (bus_setup_intr(dev, sc->timer_res[1], INTR_TYPE_CLK, 149e9f0d565SAlexander Motin mv_hardclock, NULL, sc, &ihl) != 0) { 150373bbe25SRafal Jaworowski bus_release_resources(dev, mv_timer_spec, sc->timer_res); 151e9f0d565SAlexander Motin device_printf(dev, "Could not setup interrupt.\n"); 152373bbe25SRafal Jaworowski return (ENXIO); 153373bbe25SRafal Jaworowski } 154373bbe25SRafal Jaworowski 155e9f0d565SAlexander Motin mv_setup_timers(); 15616694521SOleksandr Tymoshenko #if !defined(SOC_MV_ARMADAXP) 157e9f0d565SAlexander Motin irq_cause = read_cpu_ctrl(BRIDGE_IRQ_CAUSE); 15816694521SOleksandr Tymoshenko irq_cause &= IRQ_TIMER0_CLR; 15916694521SOleksandr Tymoshenko 160e9f0d565SAlexander Motin write_cpu_ctrl(BRIDGE_IRQ_CAUSE, irq_cause); 161e9f0d565SAlexander Motin irq_mask = read_cpu_ctrl(BRIDGE_IRQ_MASK); 162e9f0d565SAlexander Motin irq_mask |= IRQ_TIMER0_MASK; 163292e1140SMarcel Moolenaar irq_mask &= ~IRQ_TIMER1_MASK; 164e9f0d565SAlexander Motin write_cpu_ctrl(BRIDGE_IRQ_MASK, irq_mask); 16516694521SOleksandr Tymoshenko #endif 166e9f0d565SAlexander Motin sc->et.et_name = "CPUTimer0"; 167e9f0d565SAlexander Motin sc->et.et_flags = ET_FLAGS_PERIODIC | ET_FLAGS_ONESHOT; 168e9f0d565SAlexander Motin sc->et.et_quality = 1000; 16916694521SOleksandr Tymoshenko 17016694521SOleksandr Tymoshenko sc->et.et_frequency = MV_CLOCK_SRC; 171e9f0d565SAlexander Motin sc->et.et_min_period.sec = 0; 172e9f0d565SAlexander Motin sc->et.et_min_period.frac = 173599cf0f1SAlexander Motin ((0x00000002LLU << 32) / sc->et.et_frequency) << 32; 174599cf0f1SAlexander Motin sc->et.et_max_period.sec = 0xfffffff0U / sc->et.et_frequency; 175e9f0d565SAlexander Motin sc->et.et_max_period.frac = 176599cf0f1SAlexander Motin ((0xfffffffeLLU << 32) / sc->et.et_frequency) << 32; 177e9f0d565SAlexander Motin sc->et.et_start = mv_timer_start; 178e9f0d565SAlexander Motin sc->et.et_stop = mv_timer_stop; 179e9f0d565SAlexander Motin sc->et.et_priv = sc; 180e9f0d565SAlexander Motin et_register(&sc->et); 18116694521SOleksandr Tymoshenko mv_timer_timecounter.tc_frequency = MV_CLOCK_SRC; 182e9f0d565SAlexander Motin tc_init(&mv_timer_timecounter); 183373bbe25SRafal Jaworowski 184373bbe25SRafal Jaworowski return (0); 185373bbe25SRafal Jaworowski } 186373bbe25SRafal Jaworowski 187373bbe25SRafal Jaworowski static int 188373bbe25SRafal Jaworowski mv_hardclock(void *arg) 189373bbe25SRafal Jaworowski { 190e9f0d565SAlexander Motin struct mv_timer_softc *sc; 191373bbe25SRafal Jaworowski uint32_t irq_cause; 192373bbe25SRafal Jaworowski 193373bbe25SRafal Jaworowski irq_cause = read_cpu_ctrl(BRIDGE_IRQ_CAUSE); 19416694521SOleksandr Tymoshenko irq_cause &= IRQ_TIMER0_CLR; 195373bbe25SRafal Jaworowski write_cpu_ctrl(BRIDGE_IRQ_CAUSE, irq_cause); 196373bbe25SRafal Jaworowski 197afc1cdb9SAlexander Motin sc = (struct mv_timer_softc *)arg; 198afc1cdb9SAlexander Motin if (sc->et.et_active) 199afc1cdb9SAlexander Motin sc->et.et_event_cb(&sc->et, sc->et.et_arg); 200afc1cdb9SAlexander Motin 201373bbe25SRafal Jaworowski return (FILTER_HANDLED); 202373bbe25SRafal Jaworowski } 203373bbe25SRafal Jaworowski 204373bbe25SRafal Jaworowski static device_method_t mv_timer_methods[] = { 205373bbe25SRafal Jaworowski DEVMETHOD(device_probe, mv_timer_probe), 206373bbe25SRafal Jaworowski DEVMETHOD(device_attach, mv_timer_attach), 207373bbe25SRafal Jaworowski 208373bbe25SRafal Jaworowski { 0, 0 } 209373bbe25SRafal Jaworowski }; 210373bbe25SRafal Jaworowski 211373bbe25SRafal Jaworowski static driver_t mv_timer_driver = { 212373bbe25SRafal Jaworowski "timer", 213373bbe25SRafal Jaworowski mv_timer_methods, 214373bbe25SRafal Jaworowski sizeof(struct mv_timer_softc), 215373bbe25SRafal Jaworowski }; 216373bbe25SRafal Jaworowski 217373bbe25SRafal Jaworowski static devclass_t mv_timer_devclass; 218373bbe25SRafal Jaworowski 219db5ef4fcSRafal Jaworowski DRIVER_MODULE(timer, simplebus, mv_timer_driver, mv_timer_devclass, 0, 0); 220373bbe25SRafal Jaworowski 221373bbe25SRafal Jaworowski static unsigned 222373bbe25SRafal Jaworowski mv_timer_get_timecount(struct timecounter *tc) 223373bbe25SRafal Jaworowski { 224373bbe25SRafal Jaworowski 225373bbe25SRafal Jaworowski return (INITIAL_TIMECOUNTER - mv_get_timer(1)); 226373bbe25SRafal Jaworowski } 227373bbe25SRafal Jaworowski 228373bbe25SRafal Jaworowski void 229373bbe25SRafal Jaworowski cpu_initclocks(void) 230373bbe25SRafal Jaworowski { 231373bbe25SRafal Jaworowski 232e9f0d565SAlexander Motin cpu_initclocks_bsp(); 233373bbe25SRafal Jaworowski } 234373bbe25SRafal Jaworowski 235373bbe25SRafal Jaworowski void 236373bbe25SRafal Jaworowski DELAY(int usec) 237373bbe25SRafal Jaworowski { 238373bbe25SRafal Jaworowski uint32_t val, val_temp; 239373bbe25SRafal Jaworowski int32_t nticks; 240373bbe25SRafal Jaworowski 241373bbe25SRafal Jaworowski if (!timers_initialized) { 242373bbe25SRafal Jaworowski for (; usec > 0; usec--) 243373bbe25SRafal Jaworowski for (val = 100; val > 0; val--) 244292e1140SMarcel Moolenaar __asm __volatile("nop" ::: "memory"); 245373bbe25SRafal Jaworowski return; 246373bbe25SRafal Jaworowski } 247373bbe25SRafal Jaworowski 248373bbe25SRafal Jaworowski val = mv_get_timer(1); 24916694521SOleksandr Tymoshenko nticks = ((MV_CLOCK_SRC / 1000000 + 1) * usec); 250373bbe25SRafal Jaworowski 251373bbe25SRafal Jaworowski while (nticks > 0) { 252373bbe25SRafal Jaworowski val_temp = mv_get_timer(1); 253373bbe25SRafal Jaworowski if (val > val_temp) 254373bbe25SRafal Jaworowski nticks -= (val - val_temp); 255373bbe25SRafal Jaworowski else 256373bbe25SRafal Jaworowski nticks -= (val + (INITIAL_TIMECOUNTER - val_temp)); 257373bbe25SRafal Jaworowski 258373bbe25SRafal Jaworowski val = val_temp; 259373bbe25SRafal Jaworowski } 260373bbe25SRafal Jaworowski } 261373bbe25SRafal Jaworowski 262373bbe25SRafal Jaworowski static uint32_t 263373bbe25SRafal Jaworowski mv_get_timer_control(void) 264373bbe25SRafal Jaworowski { 265373bbe25SRafal Jaworowski 266373bbe25SRafal Jaworowski return (bus_space_read_4(timer_softc->timer_bst, 267373bbe25SRafal Jaworowski timer_softc->timer_bsh, CPU_TIMER_CONTROL)); 268373bbe25SRafal Jaworowski } 269373bbe25SRafal Jaworowski 270373bbe25SRafal Jaworowski static void 271373bbe25SRafal Jaworowski mv_set_timer_control(uint32_t val) 272373bbe25SRafal Jaworowski { 273373bbe25SRafal Jaworowski 274373bbe25SRafal Jaworowski bus_space_write_4(timer_softc->timer_bst, 275373bbe25SRafal Jaworowski timer_softc->timer_bsh, CPU_TIMER_CONTROL, val); 276373bbe25SRafal Jaworowski } 277373bbe25SRafal Jaworowski 278373bbe25SRafal Jaworowski static uint32_t 279373bbe25SRafal Jaworowski mv_get_timer(uint32_t timer) 280373bbe25SRafal Jaworowski { 281373bbe25SRafal Jaworowski 282373bbe25SRafal Jaworowski return (bus_space_read_4(timer_softc->timer_bst, 283373bbe25SRafal Jaworowski timer_softc->timer_bsh, CPU_TIMER0 + timer * 0x8)); 284373bbe25SRafal Jaworowski } 285373bbe25SRafal Jaworowski 286373bbe25SRafal Jaworowski static void 287373bbe25SRafal Jaworowski mv_set_timer(uint32_t timer, uint32_t val) 288373bbe25SRafal Jaworowski { 289373bbe25SRafal Jaworowski 290373bbe25SRafal Jaworowski bus_space_write_4(timer_softc->timer_bst, 291373bbe25SRafal Jaworowski timer_softc->timer_bsh, CPU_TIMER0 + timer * 0x8, val); 292373bbe25SRafal Jaworowski } 293373bbe25SRafal Jaworowski 294373bbe25SRafal Jaworowski static void 295373bbe25SRafal Jaworowski mv_set_timer_rel(uint32_t timer, uint32_t val) 296373bbe25SRafal Jaworowski { 297373bbe25SRafal Jaworowski 298373bbe25SRafal Jaworowski bus_space_write_4(timer_softc->timer_bst, 299373bbe25SRafal Jaworowski timer_softc->timer_bsh, CPU_TIMER0_REL + timer * 0x8, val); 300373bbe25SRafal Jaworowski } 301373bbe25SRafal Jaworowski 302373bbe25SRafal Jaworowski static void 303373bbe25SRafal Jaworowski mv_watchdog_enable(void) 304373bbe25SRafal Jaworowski { 30516694521SOleksandr Tymoshenko uint32_t val, irq_cause; 30616694521SOleksandr Tymoshenko #if !defined(SOC_MV_ARMADAXP) 30716694521SOleksandr Tymoshenko uint32_t irq_mask; 30816694521SOleksandr Tymoshenko #endif 309373bbe25SRafal Jaworowski 310373bbe25SRafal Jaworowski irq_cause = read_cpu_ctrl(BRIDGE_IRQ_CAUSE); 31116694521SOleksandr Tymoshenko irq_cause &= IRQ_TIMER_WD_CLR; 312373bbe25SRafal Jaworowski write_cpu_ctrl(BRIDGE_IRQ_CAUSE, irq_cause); 313373bbe25SRafal Jaworowski 314d65cdf4bSGrzegorz Bernacki #if defined(SOC_MV_ARMADAXP) 315d65cdf4bSGrzegorz Bernacki val = read_cpu_mp_clocks(WD_RSTOUTn_MASK); 316d65cdf4bSGrzegorz Bernacki val |= (WD_GLOBAL_MASK | WD_CPU0_MASK); 317d65cdf4bSGrzegorz Bernacki write_cpu_mp_clocks(WD_RSTOUTn_MASK, val); 318d65cdf4bSGrzegorz Bernacki #else 319373bbe25SRafal Jaworowski irq_mask = read_cpu_ctrl(BRIDGE_IRQ_MASK); 320373bbe25SRafal Jaworowski irq_mask |= IRQ_TIMER_WD_MASK; 321373bbe25SRafal Jaworowski write_cpu_ctrl(BRIDGE_IRQ_MASK, irq_mask); 322373bbe25SRafal Jaworowski 323373bbe25SRafal Jaworowski val = read_cpu_ctrl(RSTOUTn_MASK); 324373bbe25SRafal Jaworowski val |= WD_RST_OUT_EN; 325373bbe25SRafal Jaworowski write_cpu_ctrl(RSTOUTn_MASK, val); 326d65cdf4bSGrzegorz Bernacki #endif 327373bbe25SRafal Jaworowski 328373bbe25SRafal Jaworowski val = mv_get_timer_control(); 329373bbe25SRafal Jaworowski val |= CPU_TIMER_WD_EN | CPU_TIMER_WD_AUTO; 330373bbe25SRafal Jaworowski mv_set_timer_control(val); 331373bbe25SRafal Jaworowski } 332373bbe25SRafal Jaworowski 333373bbe25SRafal Jaworowski static void 334373bbe25SRafal Jaworowski mv_watchdog_disable(void) 335373bbe25SRafal Jaworowski { 33616694521SOleksandr Tymoshenko uint32_t val, irq_cause; 33716694521SOleksandr Tymoshenko #if !defined(SOC_MV_ARMADAXP) 33816694521SOleksandr Tymoshenko uint32_t irq_mask; 33916694521SOleksandr Tymoshenko #endif 340373bbe25SRafal Jaworowski 341373bbe25SRafal Jaworowski val = mv_get_timer_control(); 342373bbe25SRafal Jaworowski val &= ~(CPU_TIMER_WD_EN | CPU_TIMER_WD_AUTO); 343373bbe25SRafal Jaworowski mv_set_timer_control(val); 344373bbe25SRafal Jaworowski 345d65cdf4bSGrzegorz Bernacki #if defined(SOC_MV_ARMADAXP) 346d65cdf4bSGrzegorz Bernacki val = read_cpu_mp_clocks(WD_RSTOUTn_MASK); 347d65cdf4bSGrzegorz Bernacki val &= ~(WD_GLOBAL_MASK | WD_CPU0_MASK); 348d65cdf4bSGrzegorz Bernacki write_cpu_mp_clocks(WD_RSTOUTn_MASK, val); 349d65cdf4bSGrzegorz Bernacki #else 350373bbe25SRafal Jaworowski val = read_cpu_ctrl(RSTOUTn_MASK); 351373bbe25SRafal Jaworowski val &= ~WD_RST_OUT_EN; 352373bbe25SRafal Jaworowski write_cpu_ctrl(RSTOUTn_MASK, val); 353373bbe25SRafal Jaworowski 354373bbe25SRafal Jaworowski irq_mask = read_cpu_ctrl(BRIDGE_IRQ_MASK); 355373bbe25SRafal Jaworowski irq_mask &= ~(IRQ_TIMER_WD_MASK); 356373bbe25SRafal Jaworowski write_cpu_ctrl(BRIDGE_IRQ_MASK, irq_mask); 35716694521SOleksandr Tymoshenko #endif 358373bbe25SRafal Jaworowski 359373bbe25SRafal Jaworowski irq_cause = read_cpu_ctrl(BRIDGE_IRQ_CAUSE); 36016694521SOleksandr Tymoshenko irq_cause &= IRQ_TIMER_WD_CLR; 361373bbe25SRafal Jaworowski write_cpu_ctrl(BRIDGE_IRQ_CAUSE, irq_cause); 362373bbe25SRafal Jaworowski } 363373bbe25SRafal Jaworowski 364373bbe25SRafal Jaworowski 365373bbe25SRafal Jaworowski /* 366373bbe25SRafal Jaworowski * Watchdog event handler. 367373bbe25SRafal Jaworowski */ 368373bbe25SRafal Jaworowski static void 369373bbe25SRafal Jaworowski mv_watchdog_event(void *arg, unsigned int cmd, int *error) 370373bbe25SRafal Jaworowski { 371373bbe25SRafal Jaworowski uint64_t ns; 372373bbe25SRafal Jaworowski uint64_t ticks; 373373bbe25SRafal Jaworowski 374373bbe25SRafal Jaworowski mtx_lock(&timer_softc->timer_mtx); 375373bbe25SRafal Jaworowski if (cmd == 0) 376373bbe25SRafal Jaworowski mv_watchdog_disable(); 377373bbe25SRafal Jaworowski else { 378373bbe25SRafal Jaworowski /* 379373bbe25SRafal Jaworowski * Watchdog timeout is in nanosecs, calculation according to 380373bbe25SRafal Jaworowski * watchdog(9) 381373bbe25SRafal Jaworowski */ 382373bbe25SRafal Jaworowski ns = (uint64_t)1 << (cmd & WD_INTERVAL); 38316694521SOleksandr Tymoshenko ticks = (uint64_t)(ns * MV_CLOCK_SRC) / 1000000000; 384373bbe25SRafal Jaworowski if (ticks > MAX_WATCHDOG_TICKS) 385373bbe25SRafal Jaworowski mv_watchdog_disable(); 386373bbe25SRafal Jaworowski else { 387373bbe25SRafal Jaworowski /* Timer 2 is the watchdog */ 388373bbe25SRafal Jaworowski mv_set_timer(2, ticks); 389373bbe25SRafal Jaworowski mv_watchdog_enable(); 390373bbe25SRafal Jaworowski *error = 0; 391373bbe25SRafal Jaworowski } 392373bbe25SRafal Jaworowski } 393373bbe25SRafal Jaworowski mtx_unlock(&timer_softc->timer_mtx); 394373bbe25SRafal Jaworowski } 395373bbe25SRafal Jaworowski 396e9f0d565SAlexander Motin static int 397e9f0d565SAlexander Motin mv_timer_start(struct eventtimer *et, 398e9f0d565SAlexander Motin struct bintime *first, struct bintime *period) 399e9f0d565SAlexander Motin { 400e9f0d565SAlexander Motin struct mv_timer_softc *sc; 401e9f0d565SAlexander Motin uint32_t val, val1; 402e9f0d565SAlexander Motin 403e9f0d565SAlexander Motin /* Calculate dividers. */ 404e9f0d565SAlexander Motin sc = (struct mv_timer_softc *)et->et_priv; 405e9f0d565SAlexander Motin if (period != NULL) { 406e9f0d565SAlexander Motin val = (sc->et.et_frequency * (period->frac >> 32)) >> 32; 407e9f0d565SAlexander Motin if (period->sec != 0) 408e9f0d565SAlexander Motin val += sc->et.et_frequency * period->sec; 409e9f0d565SAlexander Motin } else 410e9f0d565SAlexander Motin val = 0; 411e9f0d565SAlexander Motin if (first != NULL) { 412e9f0d565SAlexander Motin val1 = (sc->et.et_frequency * (first->frac >> 32)) >> 32; 413e9f0d565SAlexander Motin if (first->sec != 0) 414e9f0d565SAlexander Motin val1 += sc->et.et_frequency * first->sec; 415e9f0d565SAlexander Motin } else 416e9f0d565SAlexander Motin val1 = val; 417e9f0d565SAlexander Motin 418e9f0d565SAlexander Motin /* Apply configuration. */ 419e9f0d565SAlexander Motin mv_set_timer_rel(0, val); 420e9f0d565SAlexander Motin mv_set_timer(0, val1); 421e9f0d565SAlexander Motin val = mv_get_timer_control(); 422e9f0d565SAlexander Motin val |= CPU_TIMER0_EN; 423e9f0d565SAlexander Motin if (period != NULL) 424e9f0d565SAlexander Motin val |= CPU_TIMER0_AUTO; 425afc1cdb9SAlexander Motin else 426afc1cdb9SAlexander Motin val &= ~CPU_TIMER0_AUTO; 427e9f0d565SAlexander Motin mv_set_timer_control(val); 428e9f0d565SAlexander Motin return (0); 429e9f0d565SAlexander Motin } 430e9f0d565SAlexander Motin 431e9f0d565SAlexander Motin static int 432e9f0d565SAlexander Motin mv_timer_stop(struct eventtimer *et) 433373bbe25SRafal Jaworowski { 434373bbe25SRafal Jaworowski uint32_t val; 435373bbe25SRafal Jaworowski 436373bbe25SRafal Jaworowski val = mv_get_timer_control(); 437e9f0d565SAlexander Motin val &= ~(CPU_TIMER0_EN | CPU_TIMER0_AUTO); 438373bbe25SRafal Jaworowski mv_set_timer_control(val); 439e9f0d565SAlexander Motin return (0); 440373bbe25SRafal Jaworowski } 441373bbe25SRafal Jaworowski 442373bbe25SRafal Jaworowski static void 443e9f0d565SAlexander Motin mv_setup_timers(void) 444373bbe25SRafal Jaworowski { 445373bbe25SRafal Jaworowski uint32_t val; 446373bbe25SRafal Jaworowski 447373bbe25SRafal Jaworowski mv_set_timer_rel(1, INITIAL_TIMECOUNTER); 448373bbe25SRafal Jaworowski mv_set_timer(1, INITIAL_TIMECOUNTER); 449373bbe25SRafal Jaworowski val = mv_get_timer_control(); 450e9f0d565SAlexander Motin val &= ~(CPU_TIMER0_EN | CPU_TIMER0_AUTO); 451373bbe25SRafal Jaworowski val |= CPU_TIMER1_EN | CPU_TIMER1_AUTO; 452373bbe25SRafal Jaworowski mv_set_timer_control(val); 453e9f0d565SAlexander Motin timers_initialized = 1; 454373bbe25SRafal Jaworowski } 455