1/* $Id: fasttimer.c,v 1.1.1.1 2007-08-03 18:51:41 $ 2 * linux/arch/cris/kernel/fasttimer.c 3 * 4 * Fast timers for ETRAX FS 5 * This may be useful in other OS than Linux so use 2 space indentation... 6 * 7 * $Log: not supported by cvs2svn $ 8 * Revision 1.11 2005/01/04 11:15:46 starvik 9 * Don't share timer IRQ. 10 * 11 * Revision 1.10 2004/12/07 09:19:38 starvik 12 * Corrected includes. 13 * Use correct interrupt macros. 14 * 15 * Revision 1.9 2004/05/14 10:18:58 starvik 16 * Export fast_timer_list 17 * 18 * Revision 1.8 2004/05/14 07:58:03 starvik 19 * Merge of changes from 2.4 20 * 21 * Revision 1.7 2003/07/10 12:06:14 starvik 22 * Return IRQ_NONE if irq wasn't handled 23 * 24 * Revision 1.6 2003/07/04 08:27:49 starvik 25 * Merge of Linux 2.5.74 26 * 27 * Revision 1.5 2003/06/05 10:16:22 johana 28 * New INTR_VECT macros. 29 * 30 * Revision 1.4 2003/06/03 08:49:45 johana 31 * Fixed typo. 32 * 33 * Revision 1.3 2003/06/02 12:51:27 johana 34 * Now compiles. 35 * Commented some include files that probably can be removed. 36 * 37 * Revision 1.2 2003/06/02 12:09:41 johana 38 * Ported to ETRAX FS using the trig interrupt instead of timer1. 39 * 40 * Revision 1.3 2002/12/12 08:26:32 starvik 41 * Don't use C-comments inside CVS comments 42 * 43 * Revision 1.2 2002/12/11 15:42:02 starvik 44 * Extracted v10 (ETRAX 100LX) specific stuff from arch/cris/kernel/ 45 * 46 * Revision 1.1 2002/11/18 07:58:06 starvik 47 * Fast timers (from Linux 2.4) 48 * 49 * Revision 1.5 2002/10/15 06:21:39 starvik 50 * Added call to init_waitqueue_head 51 * 52 * Revision 1.4 2002/05/28 17:47:59 johana 53 * Added del_fast_timer() 54 * 55 * Revision 1.3 2002/05/28 16:16:07 johana 56 * Handle empty fast_timer_list 57 * 58 * Revision 1.2 2002/05/27 15:38:42 johana 59 * Made it compile without warnings on Linux 2.4. 60 * (includes, wait_queue, PROC_FS and snprintf) 61 * 62 * Revision 1.1 2002/05/27 15:32:25 johana 63 * arch/etrax100/kernel/fasttimer.c v1.8 from the elinux tree. 64 * 65 * Revision 1.8 2001/11/27 13:50:40 pkj 66 * Disable interrupts while stopping the timer and while modifying the 67 * list of active timers in timer1_handler() as it may be interrupted 68 * by other interrupts (e.g., the serial interrupt) which may add fast 69 * timers. 70 * 71 * Revision 1.7 2001/11/22 11:50:32 pkj 72 * * Only store information about the last 16 timers. 73 * * proc_fasttimer_read() now uses an allocated buffer, since it 74 * requires more space than just a page even for only writing the 75 * last 16 timers. The buffer is only allocated on request, so 76 * unless /proc/fasttimer is read, it is never allocated. 77 * * Renamed fast_timer_started to fast_timers_started to match 78 * fast_timers_added and fast_timers_expired. 79 * * Some clean-up. 80 * 81 * Revision 1.6 2000/12/13 14:02:08 johana 82 * Removed volatile for fast_timer_list 83 * 84 * Revision 1.5 2000/12/13 13:55:35 johana 85 * Added DEBUG_LOG, added som cli() and cleanup 86 * 87 * Revision 1.4 2000/12/05 13:48:50 johana 88 * Added range check when writing proc file, modified timer int handling 89 * 90 * Revision 1.3 2000/11/23 10:10:20 johana 91 * More debug/logging possibilities. 92 * Moved GET_JIFFIES_USEC() to timex.h and time.c 93 * 94 * Revision 1.2 2000/11/01 13:41:04 johana 95 * Clean up and bugfixes. 96 * Created new do_gettimeofday_fast() that gets a timeval struct 97 * with time based on jiffies and *R_TIMER0_DATA, uses a table 98 * for fast conversion of timer value to microseconds. 99 * (Much faster the standard do_gettimeofday() and we don't really 100 * wan't to use the true time - we wan't the "uptime" so timers don't screw up 101 * when we change the time. 102 * TODO: Add efficient support for continuous timers as well. 103 * 104 * Revision 1.1 2000/10/26 15:49:16 johana 105 * Added fasttimer, highresolution timers. 106 * 107 * Copyright (C) 2000,2001 2002, 2003 Axis Communications AB, Lund, Sweden 108 */ 109 110#include <linux/errno.h> 111#include <linux/sched.h> 112#include <linux/kernel.h> 113#include <linux/param.h> 114#include <linux/string.h> 115#include <linux/vmalloc.h> 116#include <linux/interrupt.h> 117#include <linux/time.h> 118#include <linux/delay.h> 119 120#include <asm/irq.h> 121#include <asm/system.h> 122 123#include <linux/version.h> 124 125#include <asm/arch/hwregs/reg_map.h> 126#include <asm/arch/hwregs/reg_rdwr.h> 127#include <asm/arch/hwregs/timer_defs.h> 128#include <asm/fasttimer.h> 129#include <linux/proc_fs.h> 130 131/* 132 * timer0 is running at 100MHz and generating jiffies timer ticks 133 * at 100 or 1000 HZ. 134 * fasttimer gives an API that gives timers that expire "between" the jiffies 135 * giving microsecond resolution (10 ns). 136 * fasttimer uses reg_timer_rw_trig register to get interrupt when 137 * r_time reaches a certain value. 138 */ 139 140 141#define DEBUG_LOG_INCLUDED 142#define FAST_TIMER_LOG 143//#define FAST_TIMER_TEST 144 145#define FAST_TIMER_SANITY_CHECKS 146 147#ifdef FAST_TIMER_SANITY_CHECKS 148#define SANITYCHECK(x) x 149static int sanity_failed = 0; 150#else 151#define SANITYCHECK(x) 152#endif 153 154#define D1(x) 155#define D2(x) 156#define DP(x) 157 158#define __INLINE__ inline 159 160static int fast_timer_running = 0; 161static int fast_timers_added = 0; 162static int fast_timers_started = 0; 163static int fast_timers_expired = 0; 164static int fast_timers_deleted = 0; 165static int fast_timer_is_init = 0; 166static int fast_timer_ints = 0; 167 168struct fast_timer *fast_timer_list = NULL; 169 170#ifdef DEBUG_LOG_INCLUDED 171#define DEBUG_LOG_MAX 128 172static const char * debug_log_string[DEBUG_LOG_MAX]; 173static unsigned long debug_log_value[DEBUG_LOG_MAX]; 174static int debug_log_cnt = 0; 175static int debug_log_cnt_wrapped = 0; 176 177#define DEBUG_LOG(string, value) \ 178{ \ 179 unsigned long log_flags; \ 180 local_irq_save(log_flags); \ 181 debug_log_string[debug_log_cnt] = (string); \ 182 debug_log_value[debug_log_cnt] = (unsigned long)(value); \ 183 if (++debug_log_cnt >= DEBUG_LOG_MAX) \ 184 { \ 185 debug_log_cnt = debug_log_cnt % DEBUG_LOG_MAX; \ 186 debug_log_cnt_wrapped = 1; \ 187 } \ 188 local_irq_restore(log_flags); \ 189} 190#else 191#define DEBUG_LOG(string, value) 192#endif 193 194 195#define NUM_TIMER_STATS 16 196#ifdef FAST_TIMER_LOG 197struct fast_timer timer_added_log[NUM_TIMER_STATS]; 198struct fast_timer timer_started_log[NUM_TIMER_STATS]; 199struct fast_timer timer_expired_log[NUM_TIMER_STATS]; 200#endif 201 202int timer_div_settings[NUM_TIMER_STATS]; 203int timer_delay_settings[NUM_TIMER_STATS]; 204 205 206static void 207timer_trig_handler(void); 208 209 210 211/* Not true gettimeofday, only checks the jiffies (uptime) + useconds */ 212void __INLINE__ do_gettimeofday_fast(struct timeval *tv) 213{ 214 unsigned long sec = jiffies; 215 unsigned long usec = GET_JIFFIES_USEC(); 216 217 usec += (sec % HZ) * (1000000 / HZ); 218 sec = sec / HZ; 219 220 if (usec > 1000000) 221 { 222 usec -= 1000000; 223 sec++; 224 } 225 tv->tv_sec = sec; 226 tv->tv_usec = usec; 227} 228 229int __INLINE__ timeval_cmp(struct timeval *t0, struct timeval *t1) 230{ 231 if (t0->tv_sec < t1->tv_sec) 232 { 233 return -1; 234 } 235 else if (t0->tv_sec > t1->tv_sec) 236 { 237 return 1; 238 } 239 if (t0->tv_usec < t1->tv_usec) 240 { 241 return -1; 242 } 243 else if (t0->tv_usec > t1->tv_usec) 244 { 245 return 1; 246 } 247 return 0; 248} 249 250/* Called with ints off */ 251void __INLINE__ start_timer_trig(unsigned long delay_us) 252{ 253 reg_timer_rw_ack_intr ack_intr = { 0 }; 254 reg_timer_rw_intr_mask intr_mask; 255 reg_timer_rw_trig trig; 256 reg_timer_rw_trig_cfg trig_cfg = { 0 }; 257 reg_timer_r_time r_time; 258 259 r_time = REG_RD(timer, regi_timer, r_time); 260 261 D1(printk("start_timer_trig : %d us freq: %i div: %i\n", 262 delay_us, freq_index, div)); 263 /* Clear trig irq */ 264 intr_mask = REG_RD(timer, regi_timer, rw_intr_mask); 265 intr_mask.trig = 0; 266 REG_WR(timer, regi_timer, rw_intr_mask, intr_mask); 267 268 /* Set timer values */ 269 /* r_time is 100MHz (10 ns resolution) */ 270 trig = r_time + delay_us*(1000/10); 271 272 timer_div_settings[fast_timers_started % NUM_TIMER_STATS] = trig; 273 timer_delay_settings[fast_timers_started % NUM_TIMER_STATS] = delay_us; 274 275 /* Ack interrupt */ 276 ack_intr.trig = 1; 277 REG_WR(timer, regi_timer, rw_ack_intr, ack_intr); 278 279 /* Start timer */ 280 REG_WR(timer, regi_timer, rw_trig, trig); 281 trig_cfg.tmr = regk_timer_time; 282 REG_WR(timer, regi_timer, rw_trig_cfg, trig_cfg); 283 284 /* Check if we have already passed the trig time */ 285 r_time = REG_RD(timer, regi_timer, r_time); 286 if (r_time < trig) { 287 /* No, Enable trig irq */ 288 intr_mask = REG_RD(timer, regi_timer, rw_intr_mask); 289 intr_mask.trig = 1; 290 REG_WR(timer, regi_timer, rw_intr_mask, intr_mask); 291 fast_timers_started++; 292 fast_timer_running = 1; 293 } 294 else 295 { 296 /* We have passed the time, disable trig point, ack intr */ 297 trig_cfg.tmr = regk_timer_off; 298 REG_WR(timer, regi_timer, rw_trig_cfg, trig_cfg); 299 REG_WR(timer, regi_timer, rw_ack_intr, ack_intr); 300 /* call the int routine directly */ 301 timer_trig_handler(); 302 } 303 304} 305 306/* In version 1.4 this function takes 27 - 50 us */ 307void start_one_shot_timer(struct fast_timer *t, 308 fast_timer_function_type *function, 309 unsigned long data, 310 unsigned long delay_us, 311 const char *name) 312{ 313 unsigned long flags; 314 struct fast_timer *tmp; 315 316 D1(printk("sft %s %d us\n", name, delay_us)); 317 318 local_irq_save(flags); 319 320 do_gettimeofday_fast(&t->tv_set); 321 tmp = fast_timer_list; 322 323 SANITYCHECK({ /* Check so this is not in the list already... */ 324 while (tmp != NULL) 325 { 326 if (tmp == t) 327 { 328 printk("timer name: %s data: 0x%08lX already in list!\n", name, data); 329 sanity_failed++; 330 return; 331 } 332 else 333 { 334 tmp = tmp->next; 335 } 336 } 337 tmp = fast_timer_list; 338 }); 339 340 t->delay_us = delay_us; 341 t->function = function; 342 t->data = data; 343 t->name = name; 344 345 t->tv_expires.tv_usec = t->tv_set.tv_usec + delay_us % 1000000; 346 t->tv_expires.tv_sec = t->tv_set.tv_sec + delay_us / 1000000; 347 if (t->tv_expires.tv_usec > 1000000) 348 { 349 t->tv_expires.tv_usec -= 1000000; 350 t->tv_expires.tv_sec++; 351 } 352#ifdef FAST_TIMER_LOG 353 timer_added_log[fast_timers_added % NUM_TIMER_STATS] = *t; 354#endif 355 fast_timers_added++; 356 357 /* Check if this should timeout before anything else */ 358 if (tmp == NULL || timeval_cmp(&t->tv_expires, &tmp->tv_expires) < 0) 359 { 360 /* Put first in list and modify the timer value */ 361 t->prev = NULL; 362 t->next = fast_timer_list; 363 if (fast_timer_list) 364 { 365 fast_timer_list->prev = t; 366 } 367 fast_timer_list = t; 368#ifdef FAST_TIMER_LOG 369 timer_started_log[fast_timers_started % NUM_TIMER_STATS] = *t; 370#endif 371 start_timer_trig(delay_us); 372 } else { 373 /* Put in correct place in list */ 374 while (tmp->next && 375 timeval_cmp(&t->tv_expires, &tmp->next->tv_expires) > 0) 376 { 377 tmp = tmp->next; 378 } 379 /* Insert t after tmp */ 380 t->prev = tmp; 381 t->next = tmp->next; 382 if (tmp->next) 383 { 384 tmp->next->prev = t; 385 } 386 tmp->next = t; 387 } 388 389 D2(printk("start_one_shot_timer: %d us done\n", delay_us)); 390 391 local_irq_restore(flags); 392} /* start_one_shot_timer */ 393 394static inline int fast_timer_pending (const struct fast_timer * t) 395{ 396 return (t->next != NULL) || (t->prev != NULL) || (t == fast_timer_list); 397} 398 399static inline int detach_fast_timer (struct fast_timer *t) 400{ 401 struct fast_timer *next, *prev; 402 if (!fast_timer_pending(t)) 403 return 0; 404 next = t->next; 405 prev = t->prev; 406 if (next) 407 next->prev = prev; 408 if (prev) 409 prev->next = next; 410 else 411 fast_timer_list = next; 412 fast_timers_deleted++; 413 return 1; 414} 415 416int del_fast_timer(struct fast_timer * t) 417{ 418 unsigned long flags; 419 int ret; 420 421 local_irq_save(flags); 422 ret = detach_fast_timer(t); 423 t->next = t->prev = NULL; 424 local_irq_restore(flags); 425 return ret; 426} /* del_fast_timer */ 427 428 429/* Interrupt routines or functions called in interrupt context */ 430 431/* Timer interrupt handler for trig interrupts */ 432 433static irqreturn_t 434timer_trig_interrupt(int irq, void *dev_id, struct pt_regs *regs) 435{ 436 reg_timer_r_masked_intr masked_intr; 437 438 /* Check if the timer interrupt is for us (a trig int) */ 439 masked_intr = REG_RD(timer, regi_timer, r_masked_intr); 440 if (!masked_intr.trig) 441 return IRQ_NONE; 442 timer_trig_handler(); 443 return IRQ_HANDLED; 444} 445 446static void timer_trig_handler(void) 447{ 448 reg_timer_rw_ack_intr ack_intr = { 0 }; 449 reg_timer_rw_intr_mask intr_mask; 450 reg_timer_rw_trig_cfg trig_cfg = { 0 }; 451 struct fast_timer *t; 452 unsigned long flags; 453 454 local_irq_save(flags); 455 456 /* Clear timer trig interrupt */ 457 intr_mask = REG_RD(timer, regi_timer, rw_intr_mask); 458 intr_mask.trig = 0; 459 REG_WR(timer, regi_timer, rw_intr_mask, intr_mask); 460 461 /* First stop timer, then ack interrupt */ 462 /* Stop timer */ 463 trig_cfg.tmr = regk_timer_off; 464 REG_WR(timer, regi_timer, rw_trig_cfg, trig_cfg); 465 466 /* Ack interrupt */ 467 ack_intr.trig = 1; 468 REG_WR(timer, regi_timer, rw_ack_intr, ack_intr); 469 470 fast_timer_running = 0; 471 fast_timer_ints++; 472 473 local_irq_restore(flags); 474 475 t = fast_timer_list; 476 while (t) 477 { 478 struct timeval tv; 479 480 /* Has it really expired? */ 481 do_gettimeofday_fast(&tv); 482 D1(printk("t: %is %06ius\n", tv.tv_sec, tv.tv_usec)); 483 484 if (timeval_cmp(&t->tv_expires, &tv) <= 0) 485 { 486 /* Yes it has expired */ 487#ifdef FAST_TIMER_LOG 488 timer_expired_log[fast_timers_expired % NUM_TIMER_STATS] = *t; 489#endif 490 fast_timers_expired++; 491 492 /* Remove this timer before call, since it may reuse the timer */ 493 local_irq_save(flags); 494 if (t->prev) 495 { 496 t->prev->next = t->next; 497 } 498 else 499 { 500 fast_timer_list = t->next; 501 } 502 if (t->next) 503 { 504 t->next->prev = t->prev; 505 } 506 t->prev = NULL; 507 t->next = NULL; 508 local_irq_restore(flags); 509 510 if (t->function != NULL) 511 { 512 t->function(t->data); 513 } 514 else 515 { 516 DEBUG_LOG("!trimertrig %i function==NULL!\n", fast_timer_ints); 517 } 518 } 519 else 520 { 521 /* Timer is to early, let's set it again using the normal routines */ 522 D1(printk(".\n")); 523 } 524 525 local_irq_save(flags); 526 if ((t = fast_timer_list) != NULL) 527 { 528 /* Start next timer.. */ 529 long us; 530 struct timeval tv; 531 532 do_gettimeofday_fast(&tv); 533 us = ((t->tv_expires.tv_sec - tv.tv_sec) * 1000000 + 534 t->tv_expires.tv_usec - tv.tv_usec); 535 if (us > 0) 536 { 537 if (!fast_timer_running) 538 { 539#ifdef FAST_TIMER_LOG 540 timer_started_log[fast_timers_started % NUM_TIMER_STATS] = *t; 541#endif 542 start_timer_trig(us); 543 } 544 local_irq_restore(flags); 545 break; 546 } 547 else 548 { 549 /* Timer already expired, let's handle it better late than never. 550 * The normal loop handles it 551 */ 552 D1(printk("e! %d\n", us)); 553 } 554 } 555 local_irq_restore(flags); 556 } 557 558 if (!t) 559 { 560 D1(printk("ttrig stop!\n")); 561 } 562} 563 564static void wake_up_func(unsigned long data) 565{ 566#ifdef DECLARE_WAITQUEUE 567 wait_queue_head_t *sleep_wait_p = (wait_queue_head_t*)data; 568#else 569 struct wait_queue **sleep_wait_p = (struct wait_queue **)data; 570#endif 571 wake_up(sleep_wait_p); 572} 573 574 575/* Useful API */ 576 577void schedule_usleep(unsigned long us) 578{ 579 struct fast_timer t; 580#ifdef DECLARE_WAITQUEUE 581 wait_queue_head_t sleep_wait; 582 init_waitqueue_head(&sleep_wait); 583 { 584 DECLARE_WAITQUEUE(wait, current); 585#else 586 struct wait_queue *sleep_wait = NULL; 587 struct wait_queue wait = { current, NULL }; 588#endif 589 590 D1(printk("schedule_usleep(%d)\n", us)); 591 add_wait_queue(&sleep_wait, &wait); 592 set_current_state(TASK_INTERRUPTIBLE); 593 start_one_shot_timer(&t, wake_up_func, (unsigned long)&sleep_wait, us, 594 "usleep"); 595 schedule(); 596 set_current_state(TASK_RUNNING); 597 remove_wait_queue(&sleep_wait, &wait); 598 D1(printk("done schedule_usleep(%d)\n", us)); 599#ifdef DECLARE_WAITQUEUE 600 } 601#endif 602} 603 604#ifdef CONFIG_PROC_FS 605static int proc_fasttimer_read(char *buf, char **start, off_t offset, int len 606 ,int *eof, void *data_unused); 607static struct proc_dir_entry *fasttimer_proc_entry; 608#endif /* CONFIG_PROC_FS */ 609 610#ifdef CONFIG_PROC_FS 611 612/* This value is very much based on testing */ 613#define BIG_BUF_SIZE (500 + NUM_TIMER_STATS * 300) 614 615static int proc_fasttimer_read(char *buf, char **start, off_t offset, int len 616 ,int *eof, void *data_unused) 617{ 618 unsigned long flags; 619 int i = 0; 620 int num_to_show; 621 struct timeval tv; 622 struct fast_timer *t, *nextt; 623 static char *bigbuf = NULL; 624 static unsigned long used; 625 626 if (!bigbuf && !(bigbuf = vmalloc(BIG_BUF_SIZE))) 627 { 628 used = 0; 629 bigbuf[0] = '\0'; 630 return 0; 631 } 632 633 if (!offset || !used) 634 { 635 do_gettimeofday_fast(&tv); 636 637 used = 0; 638 used += sprintf(bigbuf + used, "Fast timers added: %i\n", 639 fast_timers_added); 640 used += sprintf(bigbuf + used, "Fast timers started: %i\n", 641 fast_timers_started); 642 used += sprintf(bigbuf + used, "Fast timer interrupts: %i\n", 643 fast_timer_ints); 644 used += sprintf(bigbuf + used, "Fast timers expired: %i\n", 645 fast_timers_expired); 646 used += sprintf(bigbuf + used, "Fast timers deleted: %i\n", 647 fast_timers_deleted); 648 used += sprintf(bigbuf + used, "Fast timer running: %s\n", 649 fast_timer_running ? "yes" : "no"); 650 used += sprintf(bigbuf + used, "Current time: %lu.%06lu\n", 651 (unsigned long)tv.tv_sec, 652 (unsigned long)tv.tv_usec); 653#ifdef FAST_TIMER_SANITY_CHECKS 654 used += sprintf(bigbuf + used, "Sanity failed: %i\n", 655 sanity_failed); 656#endif 657 used += sprintf(bigbuf + used, "\n"); 658 659#ifdef DEBUG_LOG_INCLUDED 660 { 661 int end_i = debug_log_cnt; 662 i = 0; 663 664 if (debug_log_cnt_wrapped) 665 { 666 i = debug_log_cnt; 667 } 668 669 while ((i != end_i || (debug_log_cnt_wrapped && !used)) && 670 used+100 < BIG_BUF_SIZE) 671 { 672 used += sprintf(bigbuf + used, debug_log_string[i], 673 debug_log_value[i]); 674 i = (i+1) % DEBUG_LOG_MAX; 675 } 676 } 677 used += sprintf(bigbuf + used, "\n"); 678#endif 679 680 num_to_show = (fast_timers_started < NUM_TIMER_STATS ? fast_timers_started: 681 NUM_TIMER_STATS); 682 used += sprintf(bigbuf + used, "Timers started: %i\n", fast_timers_started); 683 for (i = 0; i < num_to_show && (used+100 < BIG_BUF_SIZE) ; i++) 684 { 685 int cur = (fast_timers_started - i - 1) % NUM_TIMER_STATS; 686 687 used += sprintf(bigbuf + used, "div: %i delay: %i" 688 "\n", 689 timer_div_settings[cur], 690 timer_delay_settings[cur] 691 ); 692#ifdef FAST_TIMER_LOG 693 t = &timer_started_log[cur]; 694 used += sprintf(bigbuf + used, "%-14s s: %6lu.%06lu e: %6lu.%06lu " 695 "d: %6li us data: 0x%08lX" 696 "\n", 697 t->name, 698 (unsigned long)t->tv_set.tv_sec, 699 (unsigned long)t->tv_set.tv_usec, 700 (unsigned long)t->tv_expires.tv_sec, 701 (unsigned long)t->tv_expires.tv_usec, 702 t->delay_us, 703 t->data 704 ); 705#endif 706 } 707 used += sprintf(bigbuf + used, "\n"); 708 709#ifdef FAST_TIMER_LOG 710 num_to_show = (fast_timers_added < NUM_TIMER_STATS ? fast_timers_added: 711 NUM_TIMER_STATS); 712 used += sprintf(bigbuf + used, "Timers added: %i\n", fast_timers_added); 713 for (i = 0; i < num_to_show && (used+100 < BIG_BUF_SIZE); i++) 714 { 715 t = &timer_added_log[(fast_timers_added - i - 1) % NUM_TIMER_STATS]; 716 used += sprintf(bigbuf + used, "%-14s s: %6lu.%06lu e: %6lu.%06lu " 717 "d: %6li us data: 0x%08lX" 718 "\n", 719 t->name, 720 (unsigned long)t->tv_set.tv_sec, 721 (unsigned long)t->tv_set.tv_usec, 722 (unsigned long)t->tv_expires.tv_sec, 723 (unsigned long)t->tv_expires.tv_usec, 724 t->delay_us, 725 t->data 726 ); 727 } 728 used += sprintf(bigbuf + used, "\n"); 729 730 num_to_show = (fast_timers_expired < NUM_TIMER_STATS ? fast_timers_expired: 731 NUM_TIMER_STATS); 732 used += sprintf(bigbuf + used, "Timers expired: %i\n", fast_timers_expired); 733 for (i = 0; i < num_to_show && (used+100 < BIG_BUF_SIZE); i++) 734 { 735 t = &timer_expired_log[(fast_timers_expired - i - 1) % NUM_TIMER_STATS]; 736 used += sprintf(bigbuf + used, "%-14s s: %6lu.%06lu e: %6lu.%06lu " 737 "d: %6li us data: 0x%08lX" 738 "\n", 739 t->name, 740 (unsigned long)t->tv_set.tv_sec, 741 (unsigned long)t->tv_set.tv_usec, 742 (unsigned long)t->tv_expires.tv_sec, 743 (unsigned long)t->tv_expires.tv_usec, 744 t->delay_us, 745 t->data 746 ); 747 } 748 used += sprintf(bigbuf + used, "\n"); 749#endif 750 751 used += sprintf(bigbuf + used, "Active timers:\n"); 752 local_irq_save(flags); 753 local_irq_save(flags); 754 t = fast_timer_list; 755 while (t != NULL && (used+100 < BIG_BUF_SIZE)) 756 { 757 nextt = t->next; 758 local_irq_restore(flags); 759 used += sprintf(bigbuf + used, "%-14s s: %6lu.%06lu e: %6lu.%06lu " 760 "d: %6li us data: 0x%08lX" 761/* " func: 0x%08lX" */ 762 "\n", 763 t->name, 764 (unsigned long)t->tv_set.tv_sec, 765 (unsigned long)t->tv_set.tv_usec, 766 (unsigned long)t->tv_expires.tv_sec, 767 (unsigned long)t->tv_expires.tv_usec, 768 t->delay_us, 769 t->data 770/* , t->function */ 771 ); 772 local_irq_disable(); 773 if (t->next != nextt) 774 { 775 printk("timer removed!\n"); 776 } 777 t = nextt; 778 } 779 local_irq_restore(flags); 780 } 781 782 if (used - offset < len) 783 { 784 len = used - offset; 785 } 786 787 memcpy(buf, bigbuf + offset, len); 788 *start = buf; 789 *eof = 1; 790 791 return len; 792} 793#endif /* PROC_FS */ 794 795#ifdef FAST_TIMER_TEST 796static volatile unsigned long i = 0; 797static volatile int num_test_timeout = 0; 798static struct fast_timer tr[10]; 799static int exp_num[10]; 800 801static struct timeval tv_exp[100]; 802 803static void test_timeout(unsigned long data) 804{ 805 do_gettimeofday_fast(&tv_exp[data]); 806 exp_num[data] = num_test_timeout; 807 808 num_test_timeout++; 809} 810 811static void test_timeout1(unsigned long data) 812{ 813 do_gettimeofday_fast(&tv_exp[data]); 814 exp_num[data] = num_test_timeout; 815 if (data < 7) 816 { 817 start_one_shot_timer(&tr[i], test_timeout1, i, 1000, "timeout1"); 818 i++; 819 } 820 num_test_timeout++; 821} 822 823DP( 824static char buf0[2000]; 825static char buf1[2000]; 826static char buf2[2000]; 827static char buf3[2000]; 828static char buf4[2000]; 829); 830 831static char buf5[6000]; 832static int j_u[1000]; 833 834static void fast_timer_test(void) 835{ 836 int prev_num; 837 int j; 838 839 struct timeval tv, tv0, tv1, tv2; 840 841 printk("fast_timer_test() start\n"); 842 do_gettimeofday_fast(&tv); 843 844 for (j = 0; j < 1000; j++) 845 { 846 j_u[j] = GET_JIFFIES_USEC(); 847 } 848 for (j = 0; j < 100; j++) 849 { 850 do_gettimeofday_fast(&tv_exp[j]); 851 } 852 printk("fast_timer_test() %is %06i\n", tv.tv_sec, tv.tv_usec); 853 854 for (j = 0; j < 1000; j++) 855 { 856 printk("%i %i %i %i %i\n",j_u[j], j_u[j+1], j_u[j+2], j_u[j+3], j_u[j+4]); 857 j += 4; 858 } 859 for (j = 0; j < 100; j++) 860 { 861 printk("%i.%i %i.%i %i.%i %i.%i %i.%i\n", 862 tv_exp[j].tv_sec,tv_exp[j].tv_usec, 863 tv_exp[j+1].tv_sec,tv_exp[j+1].tv_usec, 864 tv_exp[j+2].tv_sec,tv_exp[j+2].tv_usec, 865 tv_exp[j+3].tv_sec,tv_exp[j+3].tv_usec, 866 tv_exp[j+4].tv_sec,tv_exp[j+4].tv_usec); 867 j += 4; 868 } 869 do_gettimeofday_fast(&tv0); 870 start_one_shot_timer(&tr[i], test_timeout, i, 50000, "test0"); 871 DP(proc_fasttimer_read(buf0, NULL, 0, 0, 0)); 872 i++; 873 start_one_shot_timer(&tr[i], test_timeout, i, 70000, "test1"); 874 DP(proc_fasttimer_read(buf1, NULL, 0, 0, 0)); 875 i++; 876 start_one_shot_timer(&tr[i], test_timeout, i, 40000, "test2"); 877 DP(proc_fasttimer_read(buf2, NULL, 0, 0, 0)); 878 i++; 879 start_one_shot_timer(&tr[i], test_timeout, i, 60000, "test3"); 880 DP(proc_fasttimer_read(buf3, NULL, 0, 0, 0)); 881 i++; 882 start_one_shot_timer(&tr[i], test_timeout1, i, 55000, "test4xx"); 883 DP(proc_fasttimer_read(buf4, NULL, 0, 0, 0)); 884 i++; 885 do_gettimeofday_fast(&tv1); 886 887 proc_fasttimer_read(buf5, NULL, 0, 0, 0); 888 889 prev_num = num_test_timeout; 890 while (num_test_timeout < i) 891 { 892 if (num_test_timeout != prev_num) 893 { 894 prev_num = num_test_timeout; 895 } 896 } 897 do_gettimeofday_fast(&tv2); 898 printk("Timers started %is %06i\n", tv0.tv_sec, tv0.tv_usec); 899 printk("Timers started at %is %06i\n", tv1.tv_sec, tv1.tv_usec); 900 printk("Timers done %is %06i\n", tv2.tv_sec, tv2.tv_usec); 901 DP(printk("buf0:\n"); 902 printk(buf0); 903 printk("buf1:\n"); 904 printk(buf1); 905 printk("buf2:\n"); 906 printk(buf2); 907 printk("buf3:\n"); 908 printk(buf3); 909 printk("buf4:\n"); 910 printk(buf4); 911 ); 912 printk("buf5:\n"); 913 printk(buf5); 914 915 printk("timers set:\n"); 916 for(j = 0; j<i; j++) 917 { 918 struct fast_timer *t = &tr[j]; 919 printk("%-10s set: %6is %06ius exp: %6is %06ius " 920 "data: 0x%08X func: 0x%08X\n", 921 t->name, 922 t->tv_set.tv_sec, 923 t->tv_set.tv_usec, 924 t->tv_expires.tv_sec, 925 t->tv_expires.tv_usec, 926 t->data, 927 t->function 928 ); 929 930 printk(" del: %6ius did exp: %6is %06ius as #%i error: %6li\n", 931 t->delay_us, 932 tv_exp[j].tv_sec, 933 tv_exp[j].tv_usec, 934 exp_num[j], 935 (tv_exp[j].tv_sec - t->tv_expires.tv_sec)*1000000 + tv_exp[j].tv_usec - t->tv_expires.tv_usec); 936 } 937 proc_fasttimer_read(buf5, NULL, 0, 0, 0); 938 printk("buf5 after all done:\n"); 939 printk(buf5); 940 printk("fast_timer_test() done\n"); 941} 942#endif 943 944 945void fast_timer_init(void) 946{ 947 /* For some reason, request_irq() hangs when called froom time_init() */ 948 if (!fast_timer_is_init) 949 { 950 printk("fast_timer_init()\n"); 951 952#ifdef CONFIG_PROC_FS 953 if ((fasttimer_proc_entry = create_proc_entry( "fasttimer", 0, 0 ))) 954 fasttimer_proc_entry->read_proc = proc_fasttimer_read; 955#endif /* PROC_FS */ 956 if(request_irq(TIMER_INTR_VECT, timer_trig_interrupt, IRQF_DISABLED, 957 "fast timer int", NULL)) 958 { 959 printk("err: timer1 irq\n"); 960 } 961 fast_timer_is_init = 1; 962#ifdef FAST_TIMER_TEST 963 printk("do test\n"); 964 fast_timer_test(); 965#endif 966 } 967} 968