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