blob: be9ffac1ea703dafb1f5a99f5e361e2c96c2b5e2 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
|
/* Copyright (c) 2013 The Chromium OS Authors. All rights reserved.
* Use of this source code is governed by a BSD-style license that can be
* found in the LICENSE file.
*/
/* Hardware timers driver */
#include "clock.h"
#include "common.h"
#include "hooks.h"
#include "hwtimer.h"
#include "registers.h"
#include "task.h"
#include "timer.h"
void __hw_clock_event_set(uint32_t deadline)
{
MEC1322_TMR32_CNT(1) = MEC1322_TMR32_CNT(0) -
(0xffffffff - deadline);
MEC1322_TMR32_CTL(1) |= (1 << 5);
}
uint32_t __hw_clock_event_get(void)
{
return MEC1322_TMR32_CNT(1) - MEC1322_TMR32_CNT(0) + 0xffffffff;
}
void __hw_clock_event_clear(void)
{
MEC1322_TMR32_CTL(1) &= ~(1 << 5);
}
uint32_t __hw_clock_source_read(void)
{
return 0xffffffff - MEC1322_TMR32_CNT(0);
}
void __hw_clock_source_set(uint32_t ts)
{
MEC1322_TMR32_CTL(0) &= ~(1 << 5);
MEC1322_TMR32_CNT(0) = 0xffffffff - ts;
MEC1322_TMR32_CTL(0) |= (1 << 5);
}
static void __hw_clock_source_irq(int timer_id)
{
if (timer_id == 1)
MEC1322_TMR32_STS(1) |= 1;
/* If IRQ is from timer 0, 32-bit timer overflowed */
process_timers(timer_id == 0);
}
void __hw_clock_source_irq_0(void) { __hw_clock_source_irq(0); }
DECLARE_IRQ(MEC1322_IRQ_TIMER32_0, __hw_clock_source_irq_0, 1);
void __hw_clock_source_irq_1(void) { __hw_clock_source_irq(1); }
DECLARE_IRQ(MEC1322_IRQ_TIMER32_1, __hw_clock_source_irq_1, 1);
static void configure_timer(int timer_id)
{
uint32_t val;
/* Ensure timer is not running */
MEC1322_TMR32_CTL(timer_id) &= ~(1 << 5);
/* Enable timer */
MEC1322_TMR32_CTL(timer_id) |= (1 << 0);
val = MEC1322_TMR32_CTL(timer_id);
/* Pre-scale = 48 -> 1MHz -> Period = 1us */
val = (val & 0xffff) | (47 << 16);
MEC1322_TMR32_CTL(timer_id) = val;
/* Set preload to use the full 32 bits of the timer */
MEC1322_TMR32_PRE(timer_id) = 0xffffffff;
/* Enable interrupt */
MEC1322_TMR32_IEN(timer_id) |= 1;
}
int __hw_clock_source_init(uint32_t start_t)
{
/*
* The timer can only fire interrupt when its value reaches zero.
* Therefore we need two timers:
* - Timer 0 as free running timer
* - Timer 1 as event timer
*/
configure_timer(0);
configure_timer(1);
/* Override the count */
MEC1322_TMR32_CNT(0) = 0xffffffff - start_t;
/* Auto restart */
MEC1322_TMR32_CTL(0) |= (1 << 3);
/* Start counting in timer 0 */
MEC1322_TMR32_CTL(0) |= (1 << 5);
/* Enable interrupt */
task_enable_irq(MEC1322_IRQ_TIMER32_0);
task_enable_irq(MEC1322_IRQ_TIMER32_1);
MEC1322_INT_ENABLE(23) |= (1 << 4) | (1 << 5);
MEC1322_INT_BLK_EN |= (1 << 23);
return MEC1322_IRQ_TIMER32_1;
}
|
