Mercurial > flash_v2

annotate packages/devs/wallclock/current/src/sh3.cxx @ 78:59d97b6ba612 ecos-sw-2000-03-28

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
Merge from eCos master repository on 2000-03-28-19:50:47-BST
author jlarmour
date Tue, 28 Mar 2000 20:13:29 +0000
parents
children
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
78
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
1 //==========================================================================
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
2 //
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
3 // devs/wallclock/sh3.cxx
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
4 //
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
5 // Wallclock emulation implementation
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
6 //
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
7 //==========================================================================
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
8 //####COPYRIGHTBEGIN####
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
9 //
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
10 // -------------------------------------------
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
11 // The contents of this file are subject to the Red Hat eCos Public License
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
12 // Version 1.1 (the "License"); you may not use this file except in
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
13 // compliance with the License. You may obtain a copy of the License at
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
14 // http://www.redhat.com/
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
15 //
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
16 // Software distributed under the License is distributed on an "AS IS"
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
17 // basis, WITHOUT WARRANTY OF ANY KIND, either express or implied. See the
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
18 // License for the specific language governing rights and limitations under
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
19 // the License.
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
20 //
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
21 // The Original Code is eCos - Embedded Configurable Operating System,
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
22 // released September 30, 1998.
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
23 //
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
24 // The Initial Developer of the Original Code is Red Hat.
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
25 // Portions created by Red Hat are
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
26 // Copyright (C) 1998, 1999, 2000 Red Hat, Inc.
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
27 // All Rights Reserved.
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
28 // -------------------------------------------
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
29 //
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
30 //####COPYRIGHTEND####
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
31 //==========================================================================
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
32 //#####DESCRIPTIONBEGIN####
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
33 //
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
34 // Author(s): jskov
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
35 // Contributors: jskov
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
36 // Date: 2000-03-17
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
37 // Purpose: Wallclock driver for SH3 CPU RTC module
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
38 //
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
39 // Notes: Currently only reads from the RTC. There should be a config
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
40 // option for selecting whether to do init-read or read-write
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
41 // to the clock. This will be useful on targets which have
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
42 // battery backing on the RTC circuitry.
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
43 //
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
44 //####DESCRIPTIONEND####
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
45 //
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
46 //==========================================================================
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
47
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
48 #include <pkgconf/kernel.h> // Kernel config
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
49 #include <pkgconf/wallclock.h> // Wallclock device config
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
50
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
51 #include <cyg/infra/cyg_type.h> // Common type definitions and support
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
52 #include <cyg/kernel/sched.inl>
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
53
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
54 #include <cyg/devs/wallclock.hxx>
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
55
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
56 #include <cyg/hal/sh_regs.h> // RTC register definitions
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
57
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
58 #include <cyg/infra/diag.h> // Common type definitions and support
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
59
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
60
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
61 //-----------------------------------------------------------------------------
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
62 // Local static variables
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
63
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
64 static Cyg_WallClock wallclock_instance CYG_INIT_PRIORITY( CLOCK );
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
65
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
66 static cyg_uint32 hw_epoch_base;
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
67
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
68 static cyg_uint32 epoch_ticks;
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
69 static cyg_uint32 epoch_time_stamp;
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
70
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
71 Cyg_WallClock *Cyg_WallClock::wallclock;
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
72
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
73
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
74 //-----------------------------------------------------------------------------
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
75 // BCD helper macros
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
76 #define TO_BCD(x) (((x/10)<<4) | (x%10))
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
77 #define TO_DEC(x) (((x>>4)*10) + (x&0xf))
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
78
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
79 //-----------------------------------------------------------------------------
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
80 // Functions for setting and getting the hardware clock counters
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
81
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
82 // Year must be last two digits of "western calendar year". Leap year when
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
83 // divisible by four.
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
84 static void
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
85 set_sh3_hwclock(cyg_uint32 year, cyg_uint32 month, cyg_uint32 mday,
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
86 cyg_uint32 hour, cyg_uint32 minute, cyg_uint32 second)
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
87 {
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
88 // Stop RTC
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
89 HAL_WRITE_UINT8(CYGARC_REG_RCR2, CYGARC_REG_RCR2_RESET);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
90
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
91 // Program it
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
92 HAL_WRITE_UINT8(CYGARC_REG_RYRCNT, TO_BCD(year));
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
93 HAL_WRITE_UINT8(CYGARC_REG_RMONCNT, TO_BCD(month));
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
94 HAL_WRITE_UINT8(CYGARC_REG_RDAYCNT, TO_BCD(mday));
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
95 HAL_WRITE_UINT8(CYGARC_REG_RHRCNT, TO_BCD(hour));
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
96 HAL_WRITE_UINT8(CYGARC_REG_RMINCNT, TO_BCD(minute));
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
97 HAL_WRITE_UINT8(CYGARC_REG_RSECCNT, TO_BCD(second));
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
98
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
99 // Start RTC
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
100 HAL_WRITE_UINT8(CYGARC_REG_RCR1, CYGARC_REG_RCR1_CIE);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
101 HAL_WRITE_UINT8(CYGARC_REG_RCR2,
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
102 CYGARC_REG_RCR2_RTCEN | CYGARC_REG_RCR2_START);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
103
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
104 }
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
105
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
106 static void
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
107 get_sh3_hwclock(cyg_uint32* year, cyg_uint32* month, cyg_uint32* mday,
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
108 cyg_uint32* hour, cyg_uint32* minute, cyg_uint32* second)
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
109 {
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
110 cyg_uint8 tmp;
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
111
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
112 do {
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
113 // Clear carry flag
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
114 HAL_WRITE_UINT8(CYGARC_REG_RCR1, 0);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
115
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
116 // Read time
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
117 HAL_READ_UINT8(CYGARC_REG_RYRCNT, tmp);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
118 *year = TO_DEC(tmp);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
119 HAL_READ_UINT8(CYGARC_REG_RMONCNT, tmp);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
120 *month = TO_DEC(tmp);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
121 HAL_READ_UINT8(CYGARC_REG_RDAYCNT, tmp);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
122 *mday = TO_DEC(tmp);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
123 HAL_READ_UINT8(CYGARC_REG_RHRCNT, tmp);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
124 *hour = TO_DEC(tmp);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
125 HAL_READ_UINT8(CYGARC_REG_RMINCNT, tmp);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
126 *minute = TO_DEC(tmp);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
127 HAL_READ_UINT8(CYGARC_REG_RSECCNT, tmp);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
128 *second = TO_DEC(tmp);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
129
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
130 // Read carry flag
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
131 HAL_READ_UINT8(CYGARC_REG_RCR1, tmp);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
132 } while (CYGARC_REG_RCR1_CF & tmp); // loop if carry set
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
133 }
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
134
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
135 //-----------------------------------------------------------------------------
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
136 // Functions providing a simple read-elapsed-seconds interface to the
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
137 // hardware clock
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
138
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
139 // This function is from the Linux kernel.
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
140 //
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
141 // Converts Gregorian date to seconds since 1970-01-01 00:00:00.
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
142 // Assumes input in normal date format, i.e. 1980-12-31 23:59:59
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
143 // => year=1980, mon=12, day=31, hour=23, min=59, sec=59.
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
144 //
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
145 // This algorithm was first published by Gauss (I think).
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
146 //
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
147 // WARNING: this function will overflow on 2106-02-07 06:28:16 on
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
148 // machines were long is 32-bit! (However, as time_t is signed, we
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
149 // will already get problems at other places on 2038-01-19 03:14:08)
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
150 static cyg_uint32
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
151 _simple_mktime(cyg_uint32 year, cyg_uint32 mon,
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
152 cyg_uint32 day, cyg_uint32 hour,
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
153 cyg_uint32 min, cyg_uint32 sec)
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
154 {
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
155 if (0 >= (int) (mon -= 2)) { /* 1..12 -> 11,12,1..10 */
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
156 mon += 12; /* Puts Feb last since it has leap day */
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
157 year -= 1;
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
158 }
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
159 return (((
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
160 (cyg_uint32)(year/4 - year/100 + year/400 + 367*mon/12 + day) +
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
161 year*365 - 719499
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
162 )*24 + hour /* now have hours */
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
163 )*60 + min /* now have minutes */
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
164 )*60 + sec; /* finally seconds */
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
165 }
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
166
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
167 // Returns number of elapsed ticks since the hw_epoch_base
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
168 static inline cyg_uint32
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
169 get_hw_ticks(void)
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
170 {
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
171 cyg_uint32 year, month, mday, hour, minute, second;
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
172
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
173 get_sh3_hwclock(&year, &month, &mday, &hour, &minute, &second);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
174
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
175 #if 0
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
176 // This will cause the test to eventually fail due to these printouts
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
177 // causing timer interrupts to be lost...
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
178 diag_printf("year %02d\n", year);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
179 diag_printf("month %02d\n", month);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
180 diag_printf("mday %02d\n", mday);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
181 diag_printf("hour %02d\n", hour);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
182 diag_printf("minute %02d\n", minute);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
183 diag_printf("second %02d\n", second);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
184 #endif
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
185
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
186 cyg_uint32 now = _simple_mktime(year, month, mday, hour, minute, second);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
187 return now - hw_epoch_base;
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
188 }
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
189
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
190 static inline void
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
191 init_hw_ticks(void)
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
192 {
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
193 // This is our base: 1970-01-01 00:00:00
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
194 // Set the HW clock - if for nothing else, just to be sure it's in a
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
195 // legal range. Any arbitrary base could be used.
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
196 // After this the hardware clock is only read.
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
197 hw_epoch_base = _simple_mktime(1970,1,1,0,0,0);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
198 set_sh3_hwclock(70,1,1,0,0,0);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
199 }
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
200
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
201 //-----------------------------------------------------------------------------
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
202 // Constructor
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
203
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
204 Cyg_WallClock::Cyg_WallClock()
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
205 {
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
206 // install instance pointer
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
207 wallclock = &wallclock_instance;
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
208
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
209 init_hw_ticks();
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
210 }
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
211
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
212 //-----------------------------------------------------------------------------
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
213 // Returns the current timestamp. This may involve reading the
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
214 // hardware, so it may take anything up to a second to complete.
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
215
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
216 cyg_uint32 Cyg_WallClock::get_current_time()
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
217 {
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
218 Cyg_Scheduler::lock();
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
219
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
220 cyg_uint32 diff = get_hw_ticks() - epoch_ticks;
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
221
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
222 Cyg_Scheduler::unlock();
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
223
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
224 return epoch_time_stamp + diff;
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
225 }
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
226
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
227 //-----------------------------------------------------------------------------
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
228 // Sets the value of the timestamp relative to now. This may involve
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
229 // writing to the hardware, so it may take anything up to a second to
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
230 // complete.
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
231 void Cyg_WallClock::set_current_time( cyg_uint32 time_stamp )
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
232 {
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
233 Cyg_Scheduler::lock();
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
234
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
235 epoch_time_stamp = time_stamp;
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
236 epoch_ticks = get_hw_ticks();
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
237
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
238 Cyg_Scheduler::unlock();
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
239 }
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
240
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
241 //-----------------------------------------------------------------------------
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
diff changeset
242 // End of devs/wallclock/sh3.cxx