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
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
|
/**
* @file
*
* @ingroup beagle
*
* @brief RTC configuration.
*/
/*
* Copyright (c) 2012 Claas Ziemke. All rights reserved.
*
* Claas Ziemke
* Kernerstrasse 11
* 70182 Stuttgart
* Germany
* <claas.ziemke@gmx.net>
*
* The license and distribution terms for this file may be
* found in the file LICENSE in this distribution or at
* http://www.rtems.com/license/LICENSE.
*/
#include <libchip/rtc.h>
#include <bsp.h>
#include <bsp/beagle.h>
#define BEAGLE_RTC_COUNT 1U
#define BEAGLE_RTC_COUNTER_DELTA 0xfffffffeU
#define BEAGLE_RTC_KEY 0xb5c13f27U
#define BEAGLE_RTC_CTRL_FORCE_ONSW (1U << 7)
#define BEAGLE_RTC_CTRL_STOP (1U << 6)
#define BEAGLE_RTC_CTRL_RESET (1U << 4)
#define BEAGLE_RTC_CTRL_MATCH_1_ONSW (1U << 3)
#define BEAGLE_RTC_CTRL_MATCH_0_ONSW (1U << 2)
#define BEAGLE_RTC_CTRL_MATCH_1_INTR (1U << 1)
#define BEAGLE_RTC_CTRL_MATCH_0_INTR (1U << 0)
static void beagle_rtc_set( uint32_t val ) {
unsigned i = beagle_arm_clk() / BEAGLE_OSCILLATOR_RTC;
//beagle.rtc.ctrl |= BEAGLE_RTC_CTRL_STOP;
//beagle.rtc.ucount = val;
//beagle.rtc.dcount = BEAGLE_RTC_COUNTER_DELTA - val;
//beagle.rtc.ctrl &= ~BEAGLE_RTC_CTRL_STOP;
/* It needs some time before we can read the values back */
while( i != 0 ) {
__asm__ volatile( "nop" );
--i;
}
}
static void beagle_rtc_reset( void ) {
//beagle.rtc.ctrl = BEAGLE_RTC_CTRL_RESET;
//beagle.rtc.ctrl = 0;
//beagle.rtc.key = BEAGLE_RTC_KEY;
beagle_rtc_set( 0 );
}
static void beagle_rtc_initialize( int minor ) {
uint32_t up_first = 0;
uint32_t up_second = 0;
uint32_t down_first = 0;
uint32_t down_second = 0;
//if( beagle.rtc.key != BEAGLE_RTC_KEY ) {
// beagle_rtc_reset();
//}
do {
//up_first = beagle.rtc.ucount;
//down_first = beagle.rtc.dcount;
//up_second = beagle.rtc.ucount;
//down_second = beagle.rtc.dcount;
} while( up_first != up_second || down_first != down_second );
if( up_first + down_first != BEAGLE_RTC_COUNTER_DELTA ) {
beagle_rtc_reset();
}
}
static int beagle_rtc_get_time( int minor, rtems_time_of_day *tod ) {
struct timeval now = {
//.tv_sec = beagle.rtc.ucount,
.tv_usec = 0
};
struct tm time;
gmtime_r( &now.tv_sec, &time );
tod->year = time.tm_year + 1900;
tod->month = time.tm_mon + 1;
tod->day = time.tm_mday;
tod->hour = time.tm_hour;
tod->minute = time.tm_min;
tod->second = time.tm_sec;
tod->ticks = 0;
return RTEMS_SUCCESSFUL;
}
static int beagle_rtc_set_time( int minor, const rtems_time_of_day *tod ) {
beagle_rtc_set( _TOD_To_seconds( tod ) );
return 0;
}
static bool beagle_rtc_probe( int minor ) {
return true;
}
const rtc_fns beagle_rtc_ops = {
.deviceInitialize = beagle_rtc_initialize,
.deviceGetTime = beagle_rtc_get_time,
.deviceSetTime = beagle_rtc_set_time
};
size_t RTC_Count = BEAGLE_RTC_COUNT;
rtems_device_minor_number RTC_Minor = 0;
rtc_tbl RTC_Table [BEAGLE_RTC_COUNT] = {
{
.sDeviceName = "/dev/rtc",
.deviceType = RTC_CUSTOM,
.pDeviceFns = &beagle_rtc_ops,
.deviceProbe = beagle_rtc_probe,
.pDeviceParams = NULL,
.ulCtrlPort1 = 0,
.ulDataPort = 0,
.getRegister = NULL,
.setRegister = NULL
}
};
|
