Tom Rini | 83d290c | 2018-05-06 17:58:06 -0400 | [diff] [blame^] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
Michal Simek | 76316a3 | 2007-03-11 13:42:58 +0100 | [diff] [blame] | 2 | /* |
| 3 | * (C) Copyright 2007 Michal Simek |
| 4 | * |
| 5 | * Michal SIMEK <monstr@monstr.eu> |
Michal Simek | 76316a3 | 2007-03-11 13:42:58 +0100 | [diff] [blame] | 6 | */ |
| 7 | |
| 8 | #include <common.h> |
Michal Simek | 9aa65ca | 2016-02-15 12:10:32 +0100 | [diff] [blame] | 9 | #include <fdtdec.h> |
Michal Simek | 76316a3 | 2007-03-11 13:42:58 +0100 | [diff] [blame] | 10 | #include <asm/microblaze_timer.h> |
Michal Simek | 42efed6 | 2007-05-07 17:22:25 +0200 | [diff] [blame] | 11 | #include <asm/microblaze_intc.h> |
Michal Simek | 76316a3 | 2007-03-11 13:42:58 +0100 | [diff] [blame] | 12 | |
Michal Simek | 9aa65ca | 2016-02-15 12:10:32 +0100 | [diff] [blame] | 13 | DECLARE_GLOBAL_DATA_PTR; |
| 14 | |
Michal Simek | 76316a3 | 2007-03-11 13:42:58 +0100 | [diff] [blame] | 15 | volatile int timestamp = 0; |
Michal Simek | bcbb046 | 2012-06-29 13:46:54 +0200 | [diff] [blame] | 16 | microblaze_timer_t *tmr; |
Michal Simek | 76316a3 | 2007-03-11 13:42:58 +0100 | [diff] [blame] | 17 | |
Michal Simek | 76316a3 | 2007-03-11 13:42:58 +0100 | [diff] [blame] | 18 | ulong get_timer (ulong base) |
| 19 | { |
Michal Simek | bcbb046 | 2012-06-29 13:46:54 +0200 | [diff] [blame] | 20 | if (tmr) |
| 21 | return timestamp - base; |
| 22 | return timestamp++ - base; |
Michal Simek | 76316a3 | 2007-03-11 13:42:58 +0100 | [diff] [blame] | 23 | } |
| 24 | |
Michal Simek | 779bf42 | 2012-06-29 13:42:28 +0200 | [diff] [blame] | 25 | void __udelay(unsigned long usec) |
| 26 | { |
Michal Simek | bcbb046 | 2012-06-29 13:46:54 +0200 | [diff] [blame] | 27 | u32 i; |
Michal Simek | 779bf42 | 2012-06-29 13:42:28 +0200 | [diff] [blame] | 28 | |
Michal Simek | bcbb046 | 2012-06-29 13:46:54 +0200 | [diff] [blame] | 29 | if (tmr) { |
| 30 | i = get_timer(0); |
| 31 | while ((get_timer(0) - i) < (usec / 1000)) |
| 32 | ; |
Michal Simek | bcbb046 | 2012-06-29 13:46:54 +0200 | [diff] [blame] | 33 | } |
Michal Simek | 779bf42 | 2012-06-29 13:42:28 +0200 | [diff] [blame] | 34 | } |
Michal Simek | 779bf42 | 2012-06-29 13:42:28 +0200 | [diff] [blame] | 35 | |
Michal Simek | 9d24274 | 2014-01-21 07:30:37 +0100 | [diff] [blame] | 36 | #ifndef CONFIG_SPL_BUILD |
Michal Simek | bcbb046 | 2012-06-29 13:46:54 +0200 | [diff] [blame] | 37 | static void timer_isr(void *arg) |
Michal Simek | 76316a3 | 2007-03-11 13:42:58 +0100 | [diff] [blame] | 38 | { |
| 39 | timestamp++; |
| 40 | tmr->control = tmr->control | TIMER_INTERRUPT; |
| 41 | } |
| 42 | |
Michal Simek | 5bbcb6c | 2010-04-16 11:37:41 +0200 | [diff] [blame] | 43 | int timer_init (void) |
Michal Simek | 76316a3 | 2007-03-11 13:42:58 +0100 | [diff] [blame] | 44 | { |
Michal Simek | bcbb046 | 2012-06-29 13:46:54 +0200 | [diff] [blame] | 45 | int irq = -1; |
| 46 | u32 preload = 0; |
| 47 | u32 ret = 0; |
Michal Simek | 9aa65ca | 2016-02-15 12:10:32 +0100 | [diff] [blame] | 48 | const void *blob = gd->fdt_blob; |
| 49 | int node = 0; |
| 50 | u32 cell[2]; |
| 51 | |
| 52 | debug("TIMER: Initialization\n"); |
| 53 | |
| 54 | node = fdt_node_offset_by_compatible(blob, node, |
| 55 | "xlnx,xps-timer-1.00.a"); |
| 56 | if (node != -1) { |
| 57 | fdt_addr_t base = fdtdec_get_addr(blob, node, "reg"); |
| 58 | if (base == FDT_ADDR_T_NONE) |
| 59 | return -1; |
| 60 | |
| 61 | debug("TIMER: Base addr %lx\n", base); |
| 62 | tmr = (microblaze_timer_t *)base; |
| 63 | |
| 64 | ret = fdtdec_get_int_array(blob, node, "interrupts", |
| 65 | cell, ARRAY_SIZE(cell)); |
| 66 | if (ret) |
| 67 | return ret; |
| 68 | |
| 69 | irq = cell[0]; |
| 70 | debug("TIMER: IRQ %x\n", irq); |
| 71 | |
| 72 | preload = fdtdec_get_int(blob, node, "clock-frequency", 0); |
| 73 | preload /= CONFIG_SYS_HZ; |
| 74 | } else { |
| 75 | return node; |
| 76 | } |
| 77 | |
Michal Simek | bcbb046 | 2012-06-29 13:46:54 +0200 | [diff] [blame] | 78 | if (tmr && preload && irq >= 0) { |
| 79 | tmr->loadreg = preload; |
| 80 | tmr->control = TIMER_INTERRUPT | TIMER_RESET; |
| 81 | tmr->control = TIMER_ENABLE | TIMER_ENABLE_INTR |\ |
| 82 | TIMER_RELOAD | TIMER_DOWN_COUNT; |
| 83 | timestamp = 0; |
| 84 | ret = install_interrupt_handler (irq, timer_isr, (void *)tmr); |
| 85 | if (ret) |
| 86 | tmr = NULL; |
| 87 | } |
Michal Simek | bcbb046 | 2012-06-29 13:46:54 +0200 | [diff] [blame] | 88 | /* No problem if timer is not found/initialized */ |
Michal Simek | 5bbcb6c | 2010-04-16 11:37:41 +0200 | [diff] [blame] | 89 | return 0; |
Michal Simek | 76316a3 | 2007-03-11 13:42:58 +0100 | [diff] [blame] | 90 | } |
Michal Simek | 9d24274 | 2014-01-21 07:30:37 +0100 | [diff] [blame] | 91 | #else |
| 92 | int timer_init(void) |
| 93 | { |
| 94 | return 0; |
| 95 | } |
| 96 | #endif |
Stephan Linz | b9f0b73 | 2012-02-22 22:39:57 +0100 | [diff] [blame] | 97 | |
| 98 | /* |
| 99 | * This function is derived from PowerPC code (read timebase as long long). |
| 100 | * On Microblaze it just returns the timer value. |
| 101 | */ |
| 102 | unsigned long long get_ticks(void) |
| 103 | { |
| 104 | return get_timer(0); |
| 105 | } |
| 106 | |
| 107 | /* |
| 108 | * This function is derived from PowerPC code (timebase clock frequency). |
| 109 | * On Microblaze it returns the number of timer ticks per second. |
| 110 | */ |
| 111 | ulong get_tbclk(void) |
| 112 | { |
| 113 | return CONFIG_SYS_HZ; |
| 114 | } |