Mercurial > flash_v2
annotate packages/kernel/current/src/common/clock.cxx @ 1077:e4850e482c80
* src/common/clock.cxx (Cyg_Counter::rem_alarm): Bugfix: call
Cyg_Scheduler::lock() before calculation of index into alarm_list
array to avoid race condition with multi list counters.
| author | jlarmour |
|---|---|
| date | Wed, 25 Jun 2003 17:44:28 +0000 |
| parents | b77e86276ec3 |
| children | 4c13726203c5 |
| rev | line source |
|---|---|
| 0 | 1 //========================================================================== |
| 2 // | |
| 2 | 3 // common/clock.cxx |
| 0 | 4 // |
| 2 | 5 // Clock class implementations |
| 0 | 6 // |
| 7 //========================================================================== | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
8 //####ECOSGPLCOPYRIGHTBEGIN#### |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
9 // ------------------------------------------- |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
10 // This file is part of eCos, the Embedded Configurable Operating System. |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
11 // Copyright (C) 1998, 1999, 2000, 2001, 2002 Red Hat, Inc. |
|
356
b77e86276ec3
* src/common/clock.cxx (add_alarm): Tweak last change to allow
jlarmour
parents:
210
diff
changeset
|
12 // Copyright (C) 2002 Jonathan Larmour |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
13 // |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
14 // eCos is free software; you can redistribute it and/or modify it under |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
15 // the terms of the GNU General Public License as published by the Free |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
16 // Software Foundation; either version 2 or (at your option) any later version. |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
17 // |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
18 // eCos is distributed in the hope that it will be useful, but WITHOUT ANY |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
19 // WARRANTY; without even the implied warranty of MERCHANTABILITY or |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
20 // FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
21 // for more details. |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
22 // |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
23 // You should have received a copy of the GNU General Public License along |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
24 // with eCos; if not, write to the Free Software Foundation, Inc., |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
25 // 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
26 // |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
27 // As a special exception, if other files instantiate templates or use macros |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
28 // or inline functions from this file, or you compile this file and link it |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
29 // with other works to produce a work based on this file, this file does not |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
30 // by itself cause the resulting work to be covered by the GNU General Public |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
31 // License. However the source code for this file must still be made available |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
32 // in accordance with section (3) of the GNU General Public License. |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
33 // |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
34 // This exception does not invalidate any other reasons why a work based on |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
35 // this file might be covered by the GNU General Public License. |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
36 // |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
37 // Alternative licenses for eCos may be arranged by contacting Red Hat, Inc. |
|
210
d2c90368aeef
Merge from eCos master repository on 2002-05-23-21:39:14-BST
jlarmour
parents:
208
diff
changeset
|
38 // at http://sources.redhat.com/ecos/ecos-license/ |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
39 // ------------------------------------------- |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
174
diff
changeset
|
40 //####ECOSGPLCOPYRIGHTEND#### |
| 0 | 41 //========================================================================== |
| 42 //#####DESCRIPTIONBEGIN#### | |
| 43 // | |
| 2 | 44 // Author(s): nickg |
| 45 // Contributors: nickg | |
| 46 // Date: 1997-09-15 | |
| 47 // Purpose: Clock class implementation | |
| 0 | 48 // Description: This file contains the definitions of the counter, |
| 49 // clock and alarm class member functions that are common | |
| 50 // to all clock implementations. | |
| 51 // | |
| 52 //####DESCRIPTIONEND#### | |
| 53 // | |
| 54 //========================================================================== | |
| 55 | |
| 56 #include <pkgconf/kernel.h> | |
| 57 | |
| 58 #include <cyg/kernel/ktypes.h> // base kernel types | |
| 59 #include <cyg/infra/cyg_trac.h> // tracing macros | |
| 60 #include <cyg/infra/cyg_ass.h> // assertion macros | |
| 61 | |
| 62 #include <cyg/kernel/clock.hxx> // our header | |
| 63 | |
| 64 #include <cyg/kernel/sched.hxx> // scheduler definitions | |
| 65 #include <cyg/kernel/thread.hxx> // thread definitions | |
| 66 #include <cyg/kernel/intr.hxx> // interrupt definitions | |
| 67 | |
| 68 #include <cyg/kernel/sched.inl> // scheduler inlines | |
| 69 #include <cyg/kernel/clock.inl> // Clock inlines | |
| 70 | |
| 71 // ------------------------------------------------------------------------- | |
| 72 // Static variables | |
| 73 | |
| 74 #ifdef CYGVAR_KERNEL_COUNTERS_CLOCK | |
| 75 | |
| 76 Cyg_Clock *Cyg_Clock::real_time_clock = NULL; // System real time clock | |
| 77 | |
| 78 #endif | |
| 79 | |
| 80 //========================================================================== | |
| 81 // Constructor for counter object | |
| 82 | |
| 83 Cyg_Counter::Cyg_Counter( | |
| 84 cyg_uint32 incr | |
| 85 ) | |
| 86 { | |
| 87 CYG_REPORT_FUNCTION(); | |
| 88 | |
| 89 counter = 0; | |
| 90 increment = incr; | |
| 91 | |
| 92 } | |
| 93 | |
| 94 // ------------------------------------------------------------------------- | |
| 95 // Destructor for Counter object | |
| 96 | |
| 97 Cyg_Counter::~Cyg_Counter() | |
| 98 { | |
| 99 CYG_REPORT_FUNCTION(); | |
| 100 | |
| 101 | |
| 102 } | |
| 103 | |
| 104 // ------------------------------------------------------------------------- | |
| 105 // | |
| 106 | |
| 107 #ifdef CYGDBG_USE_ASSERTS | |
| 108 | |
|
78
59d97b6ba612
Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
66
diff
changeset
|
109 cyg_bool Cyg_Counter::check_this( cyg_assert_class_zeal zeal) const |
| 0 | 110 { |
| 111 // check that we have a non-NULL pointer first | |
| 112 if( this == NULL ) return false; | |
| 113 | |
| 114 switch( zeal ) | |
| 115 { | |
| 116 case cyg_system_test: | |
| 117 case cyg_extreme: | |
| 118 case cyg_thorough: | |
| 119 case cyg_quick: | |
| 120 case cyg_trivial: | |
| 121 case cyg_none: | |
| 122 default: | |
| 123 break; | |
| 124 }; | |
| 125 | |
| 126 return true; | |
| 127 } | |
| 128 | |
| 129 #endif | |
| 130 | |
| 131 // ------------------------------------------------------------------------- | |
| 132 // Counter tick function | |
| 133 | |
| 134 void Cyg_Counter::tick( cyg_uint32 ticks ) | |
| 135 { | |
| 136 // CYG_REPORT_FUNCTION(); | |
| 137 | |
| 138 CYG_ASSERTCLASS( this, "Bad counter object" ); | |
| 139 | |
| 140 // Increment the counter in a loop so we process | |
| 141 // each tick separately. This is easier than trying | |
| 142 // to cope with a range of increments. | |
| 143 | |
| 144 while( ticks-- ) | |
| 145 { | |
| 146 Cyg_Scheduler::lock(); | |
| 147 | |
| 148 // increment the counter, note that it is | |
| 149 // allowed to wrap. | |
| 150 counter += increment; | |
| 151 | |
| 152 // now check for any expired alarms | |
| 153 | |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
154 Cyg_Alarm_List *alarm_list_ptr; // pointer to list |
| 0 | 155 |
| 156 #if defined(CYGIMP_KERNEL_COUNTERS_SINGLE_LIST) | |
| 157 | |
| 158 alarm_list_ptr = &alarm_list; | |
| 159 | |
| 160 #elif defined(CYGIMP_KERNEL_COUNTERS_MULTI_LIST) | |
| 161 | |
| 162 // With multiple lists, each one contains only the alarms | |
| 163 // that will expire at a given tick modulo the list number. | |
| 164 // So we only have a fraction of the alarms to check here. | |
| 165 | |
| 166 alarm_list_ptr = &(alarm_list[ | |
| 167 (counter/increment) % CYGNUM_KERNEL_COUNTERS_MULTI_LIST_SIZE ] ); | |
| 168 | |
| 169 #else | |
| 170 #error "No CYGIMP_KERNEL_COUNTERS_x_LIST config" | |
| 171 #endif | |
| 172 | |
| 173 // Now that we have the list pointer, we can use common code for | |
|
1077
e4850e482c80
* src/common/clock.cxx (Cyg_Counter::rem_alarm): Bugfix: call
jlarmour
parents:
356
diff
changeset
|
174 // both list organizations. |
| 0 | 175 |
| 2 | 176 #ifdef CYGIMP_KERNEL_COUNTERS_SORT_LIST |
| 177 | |
| 178 // With a sorted alarm list, we can simply pick alarms off the | |
| 179 // front of the list until we find one that is in the future. | |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
180 |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
181 while( !alarm_list_ptr->empty() ) |
| 0 | 182 { |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
183 Cyg_Alarm *alarm = alarm_list_ptr->get_head(); |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
184 |
| 0 | 185 CYG_ASSERTCLASS(alarm, "Bad alarm in counter list" ); |
| 186 | |
| 187 if( alarm->trigger <= counter ) | |
| 188 { | |
| 189 // remove alarm from list | |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
190 alarm_list_ptr->rem_head(); |
| 0 | 191 |
| 192 if( alarm->interval != 0 ) | |
| 193 { | |
| 194 // The alarm has a retrigger interval. | |
| 195 // Reset the trigger time and requeue | |
| 196 // the alarm. | |
| 197 alarm->trigger += alarm->interval; | |
| 198 add_alarm( alarm ); | |
| 199 } | |
| 200 else alarm->enabled = false; | |
| 201 | |
| 202 CYG_INSTRUMENT_ALARM( CALL, this, alarm ); | |
| 203 | |
| 204 // call alarm function | |
| 205 alarm->alarm(alarm, alarm->data); | |
| 206 | |
| 207 // all done, loop | |
| 208 } | |
| 209 else break; | |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
210 |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
211 } |
| 2 | 212 #else |
| 0 | 213 |
| 2 | 214 // With an unsorted list, we must scan the whole list for |
| 215 // candidates. We move the whole list to a temporary location | |
| 216 // before doing this so that we are not disturbed by new | |
| 217 // alarms being added to the list. As we consider and | |
| 218 // eliminate alarms we put them onto the done_list and at the | |
| 219 // end we then move it back to where it belongs. | |
| 220 | |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
221 Cyg_Alarm_List done_list; |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
222 |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
223 Cyg_Alarm_List alarm_list; |
| 2 | 224 |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
225 alarm_list.merge( *alarm_list_ptr ); |
| 2 | 226 |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
227 while( !alarm_list.empty() ) |
| 2 | 228 { |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
229 Cyg_Alarm *alarm = alarm_list.rem_head(); |
| 2 | 230 |
| 231 CYG_ASSERTCLASS(alarm, "Bad alarm in counter list" ); | |
| 232 | |
| 233 if( alarm->trigger <= counter ) | |
| 234 { | |
| 235 if( alarm->interval != 0 ) | |
| 236 { | |
| 237 // The alarm has a retrigger interval. | |
| 238 // Reset the trigger time and requeue | |
| 239 // the alarm. | |
| 240 alarm->trigger += alarm->interval; | |
| 241 add_alarm( alarm ); | |
| 242 } | |
| 243 else alarm->enabled = false; | |
| 244 | |
| 245 CYG_INSTRUMENT_ALARM( CALL, this, alarm ); | |
| 246 | |
| 247 // call alarm function | |
| 248 alarm->alarm(alarm, alarm->data); | |
| 249 | |
| 250 // all done, loop | |
| 251 } | |
| 252 else | |
| 253 { | |
| 254 // add unused alarm to done list. | |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
255 done_list.add_tail(alarm); |
| 2 | 256 } |
| 257 } | |
| 258 | |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
259 // Return done list to real list. If any alarms have been |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
260 // added to the alarm list while we have been scanning then |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
261 // the done list will be added behind them. |
| 2 | 262 |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
263 alarm_list_ptr->merge( done_list ); |
| 2 | 264 |
| 265 #endif | |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
266 Cyg_Scheduler::unlock(); |
| 0 | 267 |
| 268 } | |
| 269 | |
| 270 } | |
| 271 | |
| 272 // ------------------------------------------------------------------------- | |
| 273 // Add an alarm to this counter | |
| 274 | |
| 275 void Cyg_Counter::add_alarm( Cyg_Alarm *alarm ) | |
| 276 { | |
| 277 CYG_REPORT_FUNCTION(); | |
| 278 | |
| 279 CYG_ASSERTCLASS( this, "Bad counter object" ); | |
| 280 CYG_ASSERTCLASS( alarm, "Bad alarm passed" ); | |
| 281 | |
| 282 Cyg_Scheduler::lock(); | |
| 283 | |
| 284 // set this now to allow an immediate handler call to manipulate | |
| 285 // this alarm sensibly. | |
| 286 alarm->enabled = true; | |
| 287 | |
| 288 // Check here for an alarm that triggers now or in the past and | |
| 289 // call its alarm function immediately. | |
| 290 if( alarm->trigger <= counter ) | |
| 291 { | |
| 292 CYG_INSTRUMENT_ALARM( CALL, this, alarm ); | |
| 293 | |
| 294 // call alarm function. Note that this is being | |
| 295 // called here before the add_alarm has returned. | |
| 296 // Note that this function may disable the alarm. | |
| 297 | |
| 298 alarm->alarm(alarm, alarm->data); | |
| 299 | |
| 300 // Note that this extra check on alarm->enabled is in case the | |
| 301 // handler function disables this alarm! | |
| 302 if( alarm->interval != 0 && alarm->enabled ) | |
| 303 { | |
| 304 // The alarm has a retrigger interval. | |
| 305 // Reset the trigger interval and drop | |
| 306 // through to queue it. | |
| 307 alarm->trigger += alarm->interval; | |
| 308 // ensure the next alarm time is in our future, and in phase | |
| 309 // with the original time requested. | |
| 310 alarm->synchronize(); | |
| 311 } | |
| 312 else | |
| 313 { | |
| 314 // The alarm is all done with, disable it | |
| 315 // unlock and return. | |
| 316 alarm->enabled = false; | |
| 317 Cyg_Scheduler::unlock(); | |
| 318 return; | |
| 319 } | |
| 320 } | |
| 321 | |
| 322 CYG_INSTRUMENT_ALARM( ADD, this, alarm ); | |
| 323 | |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
324 // Find the pointer to the relevant list _after_ a retrigger |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
325 // alarm has been given its new trigger time. |
| 0 | 326 |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
327 Cyg_Alarm_List *alarm_list_ptr; // pointer to list |
| 0 | 328 |
| 329 #if defined(CYGIMP_KERNEL_COUNTERS_SINGLE_LIST) | |
| 330 | |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
331 alarm_list_ptr = &alarm_list; |
| 0 | 332 |
| 333 #elif defined(CYGIMP_KERNEL_COUNTERS_MULTI_LIST) | |
| 334 | |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
335 // Each alarm must go into the list that covers the tick that is |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
336 // going to happen _after_ the trigger time (or at it if trigger |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
337 // happens to fall on a tick. |
| 0 | 338 |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
339 alarm_list_ptr = &(alarm_list[ |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
340 ((alarm->trigger+increment-1)/increment) % |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
341 CYGNUM_KERNEL_COUNTERS_MULTI_LIST_SIZE ] ); |
| 0 | 342 |
| 343 #else | |
| 344 #error "No CYGIMP_KERNEL_COUNTERS_x_LIST config" | |
| 345 #endif | |
| 346 | |
| 2 | 347 #ifdef CYGIMP_KERNEL_COUNTERS_SORT_LIST |
| 348 | |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
349 // Now that we have the list pointer, we can use common code for |
|
356
b77e86276ec3
* src/common/clock.cxx (add_alarm): Tweak last change to allow
jlarmour
parents:
210
diff
changeset
|
350 // both list organizations. |
| 0 | 351 |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
352 Cyg_Alarm *list_alarm = alarm_list_ptr->get_head(); |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
353 |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
354 if( list_alarm != NULL ) |
|
356
b77e86276ec3
* src/common/clock.cxx (add_alarm): Tweak last change to allow
jlarmour
parents:
210
diff
changeset
|
355 { |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
356 do |
| 0 | 357 { |
| 358 CYG_ASSERTCLASS(list_alarm, "Bad alarm in counter list" ); | |
| 359 | |
|
356
b77e86276ec3
* src/common/clock.cxx (add_alarm): Tweak last change to allow
jlarmour
parents:
210
diff
changeset
|
360 // The alarms are in ascending trigger order. If we |
|
b77e86276ec3
* src/common/clock.cxx (add_alarm): Tweak last change to allow
jlarmour
parents:
210
diff
changeset
|
361 // find an alarm that triggers later than us, we go |
|
b77e86276ec3
* src/common/clock.cxx (add_alarm): Tweak last change to allow
jlarmour
parents:
210
diff
changeset
|
362 // in front of it. |
| 0 | 363 |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
364 if( list_alarm->trigger > alarm->trigger ) |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
365 { |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
366 alarm_list_ptr->insert( list_alarm, alarm ); |
|
356
b77e86276ec3
* src/common/clock.cxx (add_alarm): Tweak last change to allow
jlarmour
parents:
210
diff
changeset
|
367 goto add_alarm_unlock_return; |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
368 } |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
369 |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
370 list_alarm = list_alarm->get_next(); |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
371 |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
372 } while( list_alarm != alarm_list_ptr->get_head() ); |
|
356
b77e86276ec3
* src/common/clock.cxx (add_alarm): Tweak last change to allow
jlarmour
parents:
210
diff
changeset
|
373 // a lower or equal alarm time was not found, so drop through |
|
b77e86276ec3
* src/common/clock.cxx (add_alarm): Tweak last change to allow
jlarmour
parents:
210
diff
changeset
|
374 // so it is added to the list tail |
|
b77e86276ec3
* src/common/clock.cxx (add_alarm): Tweak last change to allow
jlarmour
parents:
210
diff
changeset
|
375 } |
|
b77e86276ec3
* src/common/clock.cxx (add_alarm): Tweak last change to allow
jlarmour
parents:
210
diff
changeset
|
376 alarm_list_ptr->add_tail( alarm ); |
| 0 | 377 |
|
356
b77e86276ec3
* src/common/clock.cxx (add_alarm): Tweak last change to allow
jlarmour
parents:
210
diff
changeset
|
378 add_alarm_unlock_return: |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
379 #else |
| 0 | 380 |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
381 alarm_list_ptr->add_tail( alarm ); |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
382 |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
383 #endif |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
384 |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
385 Cyg_Scheduler::unlock(); |
| 0 | 386 } |
| 387 | |
| 388 // ------------------------------------------------------------------------- | |
| 389 // Remove an alarm from this counter | |
| 390 | |
| 391 void Cyg_Counter::rem_alarm( Cyg_Alarm *alarm ) | |
| 392 { | |
| 393 CYG_REPORT_FUNCTION(); | |
| 394 | |
| 395 CYG_ASSERTCLASS( this, "Bad counter object" ); | |
| 396 CYG_ASSERTCLASS( alarm, "Bad alarm passed" ); | |
| 397 | |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
398 Cyg_Alarm_List *alarm_list_ptr; // pointer to list |
| 0 | 399 |
| 400 #if defined(CYGIMP_KERNEL_COUNTERS_SINGLE_LIST) | |
| 401 | |
| 402 alarm_list_ptr = &alarm_list; | |
|
1077
e4850e482c80
* src/common/clock.cxx (Cyg_Counter::rem_alarm): Bugfix: call
jlarmour
parents:
356
diff
changeset
|
403 Cyg_Scheduler::lock(); |
| 0 | 404 |
| 405 #elif defined(CYGIMP_KERNEL_COUNTERS_MULTI_LIST) | |
| 406 | |
|
1077
e4850e482c80
* src/common/clock.cxx (Cyg_Counter::rem_alarm): Bugfix: call
jlarmour
parents:
356
diff
changeset
|
407 Cyg_Scheduler::lock(); |
|
e4850e482c80
* src/common/clock.cxx (Cyg_Counter::rem_alarm): Bugfix: call
jlarmour
parents:
356
diff
changeset
|
408 |
| 0 | 409 alarm_list_ptr = &(alarm_list[ |
| 410 ((alarm->trigger+increment-1)/increment) % | |
| 411 CYGNUM_KERNEL_COUNTERS_MULTI_LIST_SIZE ] ); | |
| 412 | |
| 413 #else | |
| 414 #error "No CYGIMP_KERNEL_COUNTERS_x_LIST config" | |
| 415 #endif | |
| 416 | |
| 417 // Now that we have the list pointer, we can use common code for | |
| 418 // both list organizations. | |
| 419 | |
| 420 CYG_INSTRUMENT_ALARM( REM, this, alarm ); | |
|
148
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
421 |
|
8f2f7615e727
Merge from eCos master repository on 2001-01-12-06:43:03-GMT
jlarmour
parents:
132
diff
changeset
|
422 alarm_list_ptr->remove( alarm ); |
| 0 | 423 |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
148
diff
changeset
|
424 alarm->enabled = false; |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
148
diff
changeset
|
425 |
| 0 | 426 Cyg_Scheduler::unlock(); |
| 427 } | |
| 428 | |
| 429 //========================================================================== | |
| 430 // Constructor for clock object | |
| 431 | |
| 432 Cyg_Clock::Cyg_Clock( | |
| 433 cyg_resolution res | |
| 434 ) | |
| 435 { | |
| 436 CYG_REPORT_FUNCTION(); | |
| 437 | |
| 438 resolution = res; | |
| 439 } | |
| 440 | |
| 441 // ------------------------------------------------------------------------- | |
| 442 // Destructor for Clock objects | |
| 443 | |
| 444 Cyg_Clock::~Cyg_Clock() | |
| 445 { | |
| 446 CYG_REPORT_FUNCTION(); | |
| 447 | |
| 448 } | |
| 449 | |
| 450 // ------------------------------------------------------------------------- | |
| 451 // | |
| 452 | |
| 453 #ifdef CYGDBG_USE_ASSERTS | |
| 454 | |
|
78
59d97b6ba612
Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
66
diff
changeset
|
455 cyg_bool Cyg_Clock::check_this( cyg_assert_class_zeal zeal) const |
| 0 | 456 { |
| 457 // check that we have a non-NULL pointer first | |
| 458 if( this == NULL ) return false; | |
| 459 | |
| 460 switch( zeal ) | |
| 461 { | |
| 462 case cyg_system_test: | |
| 463 case cyg_extreme: | |
| 464 case cyg_thorough: | |
| 465 case cyg_quick: | |
| 466 case cyg_trivial: | |
| 467 case cyg_none: | |
| 468 default: | |
| 469 break; | |
| 470 }; | |
| 471 | |
| 472 return true; | |
| 473 } | |
| 474 | |
| 475 #endif | |
| 476 | |
|
64
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
477 // ------------------------------------------------------------------------- |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
478 // |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
479 // Clock Converters: split a rational into 4 factors to try to prevent |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
480 // overflow whilst retaining reasonable accuracy. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
481 // |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
482 // typically we get numbers like 1,000,000 for ns_per and |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
483 // 100 and 1,000,000,000 for the dividend and divisor. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
484 // So we want answers like 1/10 and 10/1 out of these routines. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
485 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
486 static void construct_converter( Cyg_Clock::converter *pcc, |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
487 cyg_uint64 m1, cyg_uint64 d1, |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
488 cyg_uint64 m2, cyg_uint64 d2 ) |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
489 { |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
490 cyg_uint64 upper, lower; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
491 unsigned int i; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
492 static cyg_uint16 primes[] = { |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
493 3,5,7,11,13,17,19,23,29,31,37,41,43,47, |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
494 53,59,61,67,71,73,79,83,89,97, |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
495 101,103,107,109,113,127,131,137,139,149, |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
496 151,157,163,167,173,179,181,191,193,197,199, |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
497 239, // for 1,111,111 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
498 541, // for 10,101,011 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
499 1667, // for 8,333,333 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
500 }; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
501 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
502 int rounding = 0; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
503 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
504 // Here we assume that our workings will fit in a 64; the point is to |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
505 // allow calculations with a number of ticks that may be large. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
506 upper = m1 * m2; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
507 lower = d1 * d2; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
508 #ifdef CYGDBG_USE_ASSERTS |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
509 cyg_uint64 save_upper = upper; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
510 cyg_uint64 save_lower = lower; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
511 #endif |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
512 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
513 retry_rounding: |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
514 // First strip out common powers of 2 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
515 while ( (0 == (1 & upper)) && ( 0 == (1 & lower)) ) { |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
516 upper >>= 1; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
517 lower >>= 1; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
518 } |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
519 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
520 // then common factors - use lazy table above |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
521 for ( i = 0 ; i < (sizeof( primes )/sizeof( primes[0] )); i++ ) { |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
522 cyg_uint64 j, k, p = (cyg_uint64)(primes[i]); |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
523 j = upper / p; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
524 while ( j * p == upper ) { |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
525 k = lower / p; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
526 if ( k * p != lower ) |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
527 break; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
528 upper = j; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
529 lower = k; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
530 j = upper / p; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
531 } |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
532 } |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
533 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
534 m1 = upper; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
535 d1 = lower; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
536 m2 = 1; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
537 d2 = 1; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
538 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
539 if ( m1 > 0x10000 ) { |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
540 // only bother if there are more than 16 bits consumed here |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
541 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
542 // now move powers of 2 from d1 to d2 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
543 // keeping them the same order of magnitude |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
544 while ( (0 == (1 & d1)) && (d2 < d1) ) { |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
545 d1 >>= 1; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
546 d2 <<= 1; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
547 } |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
548 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
549 // and factors from the table - go too far, if anything |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
550 int cont = (d2 < d1); |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
551 for ( i = 0 ; cont && (i < (sizeof( primes )/sizeof( primes[0] ))); i++ ) { |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
552 cyg_uint64 k, p = (cyg_uint64)(primes[i]); |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
553 k = d1 / p; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
554 while ( cont && ((k * p) == d1) ) { |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
555 // we can extract a prime |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
556 d1 = k; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
557 d2 *= p; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
558 k = d1 / p; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
559 cont = (d2 < d1); |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
560 } |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
561 } |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
562 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
563 // move powers of 2 from m1 to m2 so long as we do not go less than d1 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
564 while ( (0 == (1 & m1)) && (m2 < m1) && (m1 > (d1 << 5)) ) { |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
565 m1 >>= 1; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
566 m2 <<= 1; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
567 if ( m1 < 0x10000 ) |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
568 break; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
569 } |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
570 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
571 // and factors from the table - ensure m1 stays well larger than d1 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
572 cont = ((m2 < m1) && (m1 > (d1 << 4)) && (m1 > 0x10000)); |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
573 for ( i = 0 ; cont && (i < (sizeof( primes )/sizeof( primes[0] ))); i++ ) { |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
574 cyg_uint64 k, p = (cyg_uint64)(primes[i]); |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
575 k = m1 / p; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
576 cont = cont && (k > (d1 << 4) && (k > 0x10000)); |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
577 while ( cont && ((k * p) == m1) ) { |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
578 // we can extract a prime |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
579 m1 = k; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
580 m2 *= p; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
581 k = m1 / p; // examine k for getting too small |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
582 cont = ((m2 < m1) && (k > (d1 << 4)) && (k > 0x10000)); |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
583 } |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
584 } |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
585 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
586 // if, after all that, m1 odd and unchanged, and too large, |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
587 // decrement it just the once and try again: then try it |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
588 // incremented once. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
589 if ( (m1 & 1) && (m1 == upper) && (m1 > 0x10000) && (rounding < 2) ) { |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
590 CYG_ASSERT( 1 == m2, "m2 should be 1 to try rounding" ); |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
591 m1--; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
592 upper = m1; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
593 rounding++; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
594 goto retry_rounding; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
595 } |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
596 // likewise for d1 - each of the pair can be odd only once each |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
597 if ( (d1 & 1) && (d1 == lower) && (d1 > 0x10000) && (rounding < 2) ) { |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
598 CYG_ASSERT( 1 == d2, "d2 should be 1 to try rounding" ); |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
599 d1--; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
600 lower = d1; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
601 rounding++; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
602 goto retry_rounding; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
603 } |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
604 } |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
605 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
606 CYG_ASSERT( 0 != m1, "m1 zero" ); |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
607 CYG_ASSERT( 0 != m2, "m2 zero" ); |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
608 CYG_ASSERT( 0 != d1, "d1 zero" ); |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
609 CYG_ASSERT( 0 != d2, "d2 zero" ); |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
610 CYG_ASSERT( rounding || save_upper/save_lower == (m1 * m2)/(d1 * d2), |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
611 "Unequal in forwards direction" ); |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
612 CYG_ASSERT( rounding || save_lower/save_upper == (d1 * d2)/(m1 * m2), |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
613 "Unequal in reverse direction" ); |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
614 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
615 pcc->mul1 = m1; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
616 pcc->div1 = d1; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
617 pcc->mul2 = m2; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
618 pcc->div2 = d2; |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
619 } |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
620 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
621 // other to clocks is (other * ns_per * dividend / divisor) |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
622 void Cyg_Clock::get_other_to_clock_converter( |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
623 cyg_uint64 ns_per_other_tick, |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
624 struct converter *pcc ) |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
625 { |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
626 construct_converter( pcc, |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
627 ns_per_other_tick, 1, |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
628 resolution.divisor, resolution.dividend ); |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
629 } |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
630 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
631 // clocks to other is (ticks * divisor / dividend / ns_per) |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
632 void Cyg_Clock::get_clock_to_other_converter( |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
633 cyg_uint64 ns_per_other_tick, |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
634 struct converter *pcc ) |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
635 { |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
636 construct_converter( pcc, |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
637 1, ns_per_other_tick, |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
638 resolution.dividend, resolution.divisor ); |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
639 } |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
640 |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
34
diff
changeset
|
641 |
| 0 | 642 //========================================================================== |
| 643 // Constructor for alarm object | |
| 644 | |
| 645 Cyg_Alarm::Cyg_Alarm( | |
| 646 Cyg_Counter *c, // Attached to this counter | |
| 647 cyg_alarm_fn *a, // Call-back function | |
| 648 CYG_ADDRWORD d // Call-back data | |
| 649 ) | |
| 650 { | |
| 651 CYG_REPORT_FUNCTION(); | |
| 652 | |
| 653 counter = c; | |
| 654 alarm = a; | |
| 655 data = d; | |
| 656 trigger = 0; | |
| 657 interval = 0; | |
| 658 enabled = false; | |
| 659 | |
| 660 } | |
| 661 | |
| 662 Cyg_Alarm::Cyg_Alarm(){} | |
| 663 | |
| 664 // ------------------------------------------------------------------------- | |
| 665 // Destructor | |
| 666 | |
| 667 Cyg_Alarm::~Cyg_Alarm() | |
| 668 { | |
| 669 CYG_REPORT_FUNCTION(); | |
| 670 | |
| 671 disable(); | |
| 672 } | |
| 673 | |
| 674 // ------------------------------------------------------------------------- | |
| 675 // | |
| 676 | |
| 677 #ifdef CYGDBG_USE_ASSERTS | |
| 678 | |
|
78
59d97b6ba612
Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
66
diff
changeset
|
679 cyg_bool Cyg_Alarm::check_this( cyg_assert_class_zeal zeal) const |
| 0 | 680 { |
| 681 // check that we have a non-NULL pointer first | |
| 682 if( this == NULL ) return false; | |
| 683 | |
| 684 switch( zeal ) | |
| 685 { | |
| 686 case cyg_system_test: | |
| 687 case cyg_extreme: | |
| 688 case cyg_thorough: | |
| 689 if( trigger != 0 && !enabled ) return false; | |
| 690 case cyg_quick: | |
| 691 case cyg_trivial: | |
| 692 case cyg_none: | |
| 693 default: | |
| 694 break; | |
| 695 }; | |
| 696 | |
| 697 return true; | |
| 698 } | |
| 699 | |
| 700 #endif | |
| 701 | |
| 702 // ------------------------------------------------------------------------- | |
| 703 // Initialize Alarm and enable | |
| 704 | |
| 705 void Cyg_Alarm::initialize( | |
| 706 cyg_tick_count t, // Absolute trigger time | |
| 707 cyg_tick_count i // Relative retrigger interval | |
| 708 ) | |
| 709 { | |
| 710 CYG_REPORT_FUNCTION(); | |
| 711 | |
| 712 // If already enabled, remove from counter | |
| 713 | |
| 714 if( enabled ) counter->rem_alarm(this); | |
| 715 | |
| 716 CYG_INSTRUMENT_ALARM( INIT, this, 0 ); | |
| 717 CYG_INSTRUMENT_ALARM( TRIGGER, | |
| 718 ((cyg_uint32 *)&t)[0], | |
| 719 ((cyg_uint32 *)&t)[1] ); | |
| 720 CYG_INSTRUMENT_ALARM( INTERVAL, | |
| 721 ((cyg_uint32 *)&i)[0], | |
| 722 ((cyg_uint32 *)&i)[1] ); | |
| 723 | |
| 724 trigger = t; | |
| 725 interval = i; | |
| 726 | |
| 727 counter->add_alarm(this); | |
| 728 } | |
| 729 | |
| 730 // ------------------------------------------------------------------------- | |
| 731 // Synchronize with a past alarm stream that had been disabled, | |
| 732 // bring past times into synch, and the like. | |
| 733 | |
| 734 void | |
| 735 Cyg_Alarm::synchronize( void ) | |
| 736 { | |
| 737 if( interval != 0 ) { | |
| 738 // This expression sets the trigger to the next whole interval | |
| 739 // at or after the current time. This means that alarms will | |
| 740 // continue at the same intervals as if they had never been | |
| 741 // disabled. The alternative would be to just set trigger to | |
| 742 // (counter->counter + interval), but this is less satisfying | |
| 743 // than preserving the original intervals. That behaviour can | |
| 744 // always be obtained by using initialize() rather than | |
| 745 // enable(), while the current behaviour would be more | |
| 746 // difficult to achieve that way. | |
| 747 cyg_tick_count d; | |
| 748 d = counter->current_value() + interval - trigger; | |
| 749 if ( d > interval ) { | |
| 750 // then trigger was in the past, so resynchronize | |
| 751 trigger += interval * ((d - 1) / interval ); | |
| 752 } | |
| 753 // otherwise, we were just set up, so no worries. | |
| 754 } | |
| 755 } | |
| 756 | |
| 757 // ------------------------------------------------------------------------- | |
| 758 // Ensure alarm enabled | |
| 759 | |
| 760 void Cyg_Alarm::enable() | |
| 761 { | |
| 762 if( !enabled ) | |
| 763 { | |
| 764 // ensure the alarm time is in our future: | |
| 765 synchronize(); | |
| 766 enabled = true; | |
| 767 counter->add_alarm(this); | |
| 768 } | |
| 769 } | |
| 770 | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
78
diff
changeset
|
771 // ------------------------------------------------------------------------- |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
78
diff
changeset
|
772 // Get the current time values from the alarm |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
78
diff
changeset
|
773 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
78
diff
changeset
|
774 void Cyg_Alarm::get_times( |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
78
diff
changeset
|
775 cyg_tick_count *t, // Next trigger time |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
78
diff
changeset
|
776 cyg_tick_count *i // Current interval |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
78
diff
changeset
|
777 ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
78
diff
changeset
|
778 { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
78
diff
changeset
|
779 // Lock the scheduler while we do this to avoid |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
78
diff
changeset
|
780 // race conditions. |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
78
diff
changeset
|
781 Cyg_Scheduler::lock(); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
78
diff
changeset
|
782 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
78
diff
changeset
|
783 if( t != NULL ) *t = trigger; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
78
diff
changeset
|
784 if( i != NULL ) *i = interval; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
78
diff
changeset
|
785 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
78
diff
changeset
|
786 Cyg_Scheduler::unlock(); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
78
diff
changeset
|
787 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
78
diff
changeset
|
788 |
| 0 | 789 //========================================================================== |
| 790 // System clock object | |
| 791 | |
| 792 #ifdef CYGVAR_KERNEL_COUNTERS_CLOCK | |
| 793 | |
| 794 class Cyg_RealTimeClock | |
| 795 : public Cyg_Clock | |
| 796 { | |
| 797 Cyg_Interrupt interrupt; | |
| 798 | |
| 799 static cyg_uint32 isr(cyg_vector vector, CYG_ADDRWORD data); | |
| 800 | |
| 801 static void dsr(cyg_vector vector, cyg_ucount32 count, CYG_ADDRWORD data); | |
| 802 | |
| 803 Cyg_RealTimeClock(); | |
| 804 | |
| 805 static Cyg_RealTimeClock rtc; | |
| 806 }; | |
| 807 | |
| 808 Cyg_Clock::cyg_resolution rtc_resolution = CYGNUM_KERNEL_COUNTERS_RTC_RESOLUTION; | |
| 809 | |
| 810 //Cyg_RealTimeClock Cyg_RealTimeClock::rtc __attribute__((init_priority (1))); | |
| 811 | |
| 812 Cyg_RealTimeClock Cyg_RealTimeClock::rtc CYG_INIT_PRIORITY( CLOCK ); | |
| 813 | |
| 814 // ------------------------------------------------------------------------- | |
| 815 | |
| 816 Cyg_RealTimeClock::Cyg_RealTimeClock() | |
| 817 : Cyg_Clock(rtc_resolution), | |
| 2 | 818 interrupt(CYGNUM_HAL_INTERRUPT_RTC, 1, (CYG_ADDRWORD)this, isr, dsr) |
| 0 | 819 { |
| 820 CYG_REPORT_FUNCTION(); | |
| 821 | |
| 822 HAL_CLOCK_INITIALIZE( CYGNUM_KERNEL_COUNTERS_RTC_PERIOD ); | |
| 823 | |
| 824 interrupt.attach(); | |
| 825 | |
| 2 | 826 interrupt.unmask_interrupt(CYGNUM_HAL_INTERRUPT_RTC); |
| 0 | 827 |
| 828 Cyg_Clock::real_time_clock = this; | |
| 829 } | |
| 830 | |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
831 #if defined(CYGVAR_KERNEL_COUNTERS_CLOCK_LATENCY) && defined(HAL_CLOCK_LATENCY) |
| 2 | 832 cyg_tick_count total_clock_latency, total_clock_interrupts; |
| 833 cyg_int32 min_clock_latency = 0x7FFFFFFF; | |
| 834 cyg_int32 max_clock_latency = 0; | |
| 835 bool measure_clock_latency = false; | |
| 836 #endif | |
| 837 | |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
838 #if defined(CYGVAR_KERNEL_COUNTERS_CLOCK_DSR_LATENCY) |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
839 cyg_tick_count total_clock_dsr_latency, total_clock_dsr_calls; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
840 cyg_int32 min_clock_dsr_latency = 0x7FFFFFFF; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
841 cyg_int32 max_clock_dsr_latency = 0; |
|
66
bf00f99aec69
Merge from eCos master repository on 2000-02-02-19:16:44-GMT
jlarmour
parents:
64
diff
changeset
|
842 cyg_uint32 clock_dsr_start = 0; |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
843 #endif |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
844 |
| 0 | 845 // ------------------------------------------------------------------------- |
| 846 | |
| 847 cyg_uint32 Cyg_RealTimeClock::isr(cyg_vector vector, CYG_ADDRWORD data) | |
| 848 { | |
| 849 // CYG_REPORT_FUNCTION(); | |
| 850 | |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
851 #if defined(CYGVAR_KERNEL_COUNTERS_CLOCK_LATENCY) && defined(HAL_CLOCK_LATENCY) |
| 2 | 852 if (measure_clock_latency) { |
| 853 cyg_int32 delta; | |
| 854 HAL_CLOCK_LATENCY(&delta); | |
| 855 // Note: Ignore a latency of 0 when finding min_clock_latency. | |
| 856 if (delta > 0) { | |
| 857 // Valid delta measured | |
| 858 total_clock_latency += delta; | |
| 859 total_clock_interrupts++; | |
| 860 if (min_clock_latency > delta) min_clock_latency = delta; | |
| 861 if (max_clock_latency < delta) max_clock_latency = delta; | |
| 862 } | |
| 863 } | |
| 864 #endif | |
| 865 | |
| 0 | 866 CYG_INSTRUMENT_CLOCK( ISR, 0, 0); |
| 867 | |
| 2 | 868 HAL_CLOCK_RESET( CYGNUM_HAL_INTERRUPT_RTC, CYGNUM_KERNEL_COUNTERS_RTC_PERIOD ); |
| 0 | 869 |
| 2 | 870 Cyg_Interrupt::acknowledge_interrupt(CYGNUM_HAL_INTERRUPT_RTC); |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
871 |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
872 #if defined(CYGVAR_KERNEL_COUNTERS_CLOCK_DSR_LATENCY) |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
873 HAL_CLOCK_READ(&clock_dsr_start); |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
874 #endif |
|
18
7253dcc42a09
Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents:
2
diff
changeset
|
875 return Cyg_Interrupt::CALL_DSR|Cyg_Interrupt::HANDLED; |
| 0 | 876 } |
| 877 | |
| 878 // ------------------------------------------------------------------------- | |
| 879 | |
| 880 void Cyg_RealTimeClock::dsr(cyg_vector vector, cyg_ucount32 count, CYG_ADDRWORD data) | |
| 881 { | |
| 882 // CYG_REPORT_FUNCTION(); | |
| 883 | |
|
210
d2c90368aeef
Merge from eCos master repository on 2002-05-23-21:39:14-BST
jlarmour
parents:
208
diff
changeset
|
884 #if defined(CYGVAR_KERNEL_COUNTERS_CLOCK_DSR_LATENCY) && defined(HAL_CLOCK_LATENCY) |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
885 if (measure_clock_latency) { |
|
174
38892b97b685
Merge from eCos master repository on 2001-07-28-00:17:32-BST
jlarmour
parents:
151
diff
changeset
|
886 cyg_int32 delta; |
|
38892b97b685
Merge from eCos master repository on 2001-07-28-00:17:32-BST
jlarmour
parents:
151
diff
changeset
|
887 HAL_CLOCK_READ((cyg_uint32 *)&delta); |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
888 delta -= clock_dsr_start; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
889 // Note: Ignore a latency of <= 0 when finding min_clock_latency. |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
890 if (delta > 0 ) { |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
891 // Valid delta measured |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
892 total_clock_dsr_latency += delta; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
893 total_clock_dsr_calls++; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
894 if (min_clock_dsr_latency > delta) min_clock_dsr_latency = delta; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
895 if (max_clock_dsr_latency < delta) max_clock_dsr_latency = delta; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
896 } |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
897 } |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
898 #endif |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
18
diff
changeset
|
899 |
| 0 | 900 Cyg_RealTimeClock *rtc = (Cyg_RealTimeClock *)data; |
| 901 | |
| 902 CYG_INSTRUMENT_CLOCK( TICK_START, | |
| 903 rtc->current_value_lo(), | |
| 904 rtc->current_value_hi()); | |
| 905 | |
| 906 rtc->tick( count ); | |
| 907 | |
| 908 #ifdef CYGSEM_KERNEL_SCHED_TIMESLICE | |
|
132
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
115
diff
changeset
|
909 #if 0 == CYGINT_KERNEL_SCHEDULER_UNIQUE_PRIORITIES |
| 0 | 910 |
| 911 // If timeslicing is enabled, call the scheduler to | |
| 912 // handle it. But not if we have unique priorities. | |
| 913 | |
| 914 Cyg_Scheduler::scheduler.timeslice(); | |
| 915 | |
| 916 #endif | |
| 917 #endif | |
| 918 | |
| 919 CYG_INSTRUMENT_CLOCK( TICK_END, | |
| 920 rtc->current_value_lo(), | |
| 921 rtc->current_value_hi()); | |
| 922 | |
| 923 } | |
| 924 | |
| 925 #endif | |
| 926 | |
| 927 // ------------------------------------------------------------------------- | |
| 928 // EOF common/clock.cxx |