1 /* $Id: fasttimer.c,v 1.4 2003/07/04 08:27:41 starvik Exp $
2 * linux/arch/cris/kernel/fasttimer.c
4 * Fast timers for ETRAX100/ETRAX100LX
5 * This may be useful in other OS than Linux so use 2 space indentation...
7 * $Log: fasttimer.c,v $
8 * Revision 1.4 2003/07/04 08:27:41 starvik
9 * Merge of Linux 2.5.74
11 * Revision 1.3 2002/12/12 08:26:32 starvik
12 * Don't use C-comments inside CVS comments
14 * Revision 1.2 2002/12/11 15:42:02 starvik
15 * Extracted v10 (ETRAX 100LX) specific stuff from arch/cris/kernel/
17 * Revision 1.1 2002/11/18 07:58:06 starvik
18 * Fast timers (from Linux 2.4)
20 * Revision 1.5 2002/10/15 06:21:39 starvik
21 * Added call to init_waitqueue_head
23 * Revision 1.4 2002/05/28 17:47:59 johana
24 * Added del_fast_timer()
26 * Revision 1.3 2002/05/28 16:16:07 johana
27 * Handle empty fast_timer_list
29 * Revision 1.2 2002/05/27 15:38:42 johana
30 * Made it compile without warnings on Linux 2.4.
31 * (includes, wait_queue, PROC_FS and snprintf)
33 * Revision 1.1 2002/05/27 15:32:25 johana
34 * arch/etrax100/kernel/fasttimer.c v1.8 from the elinux tree.
36 * Revision 1.8 2001/11/27 13:50:40 pkj
37 * Disable interrupts while stopping the timer and while modifying the
38 * list of active timers in timer1_handler() as it may be interrupted
39 * by other interrupts (e.g., the serial interrupt) which may add fast
42 * Revision 1.7 2001/11/22 11:50:32 pkj
43 * * Only store information about the last 16 timers.
44 * * proc_fasttimer_read() now uses an allocated buffer, since it
45 * requires more space than just a page even for only writing the
46 * last 16 timers. The buffer is only allocated on request, so
47 * unless /proc/fasttimer is read, it is never allocated.
48 * * Renamed fast_timer_started to fast_timers_started to match
49 * fast_timers_added and fast_timers_expired.
52 * Revision 1.6 2000/12/13 14:02:08 johana
53 * Removed volatile for fast_timer_list
55 * Revision 1.5 2000/12/13 13:55:35 johana
56 * Added DEBUG_LOG, added som cli() and cleanup
58 * Revision 1.4 2000/12/05 13:48:50 johana
59 * Added range check when writing proc file, modified timer int handling
61 * Revision 1.3 2000/11/23 10:10:20 johana
62 * More debug/logging possibilities.
63 * Moved GET_JIFFIES_USEC() to timex.h and time.c
65 * Revision 1.2 2000/11/01 13:41:04 johana
66 * Clean up and bugfixes.
67 * Created new do_gettimeofday_fast() that gets a timeval struct
68 * with time based on jiffies and *R_TIMER0_DATA, uses a table
69 * for fast conversion of timer value to microseconds.
70 * (Much faster the standard do_gettimeofday() and we don't really
71 * wan't to use the true time - we wan't the "uptime" so timers don't screw up
72 * when we change the time.
73 * TODO: Add efficient support for continuous timers as well.
75 * Revision 1.1 2000/10/26 15:49:16 johana
76 * Added fasttimer, highresolution timers.
78 * Copyright (C) 2000,2001 2002 Axis Communications AB, Lund, Sweden
81 #include <linux/errno.h>
82 #include <linux/sched.h>
83 #include <linux/kernel.h>
84 #include <linux/param.h>
85 #include <linux/string.h>
87 #include <linux/vmalloc.h>
88 #include <linux/interrupt.h>
89 #include <linux/time.h>
90 #include <linux/delay.h>
92 #include <asm/segment.h>
95 #include <asm/delay.h>
98 #include <linux/config.h>
99 #include <linux/version.h>
101 #include <asm/arch/svinto.h>
102 #include <asm/fasttimer.h>
103 #include <linux/proc_fs.h>
106 #define DEBUG_LOG_INCLUDED
107 #define FAST_TIMER_LOG
108 //#define FAST_TIMER_TEST
110 #define FAST_TIMER_SANITY_CHECKS
112 #ifdef FAST_TIMER_SANITY_CHECKS
113 #define SANITYCHECK(x) x
114 static int sanity_failed
= 0;
116 #define SANITYCHECK(x)
123 #define __INLINE__ inline
125 static int fast_timer_running
= 0;
126 static int fast_timers_added
= 0;
127 static int fast_timers_started
= 0;
128 static int fast_timers_expired
= 0;
129 static int fast_timers_deleted
= 0;
130 static int fast_timer_is_init
= 0;
131 static int fast_timer_ints
= 0;
133 static struct fast_timer
*fast_timer_list
= NULL
;
135 #ifdef DEBUG_LOG_INCLUDED
136 #define DEBUG_LOG_MAX 128
137 static const char * debug_log_string
[DEBUG_LOG_MAX
];
138 static unsigned long debug_log_value
[DEBUG_LOG_MAX
];
139 static int debug_log_cnt
= 0;
140 static int debug_log_cnt_wrapped
= 0;
142 #define DEBUG_LOG(string, value) \
144 unsigned long log_flags; \
145 save_flags(log_flags); \
147 debug_log_string[debug_log_cnt] = (string); \
148 debug_log_value[debug_log_cnt] = (unsigned long)(value); \
149 if (++debug_log_cnt >= DEBUG_LOG_MAX) \
151 debug_log_cnt = debug_log_cnt % DEBUG_LOG_MAX; \
152 debug_log_cnt_wrapped = 1; \
154 restore_flags(log_flags); \
157 #define DEBUG_LOG(string, value)
161 /* The frequencies for index = clkselx number in R_TIMER_CTRL */
162 #define NUM_TIMER_FREQ 15
163 #define MAX_USABLE_TIMER_FREQ 7
164 #define MAX_DELAY_US 853333L
165 const unsigned long timer_freq_100
[NUM_TIMER_FREQ
] =
167 3, /* 0 3333 - 853333 us */
168 6, /* 1 1666 - 426666 us */
169 12, /* 2 833 - 213333 us */
170 24, /* 3 416 - 106666 us */
171 48, /* 4 208 - 53333 us */
172 96, /* 5 104 - 26666 us */
173 192, /* 6 52 - 13333 us */
174 384, /* 7 26 - 6666 us */
184 #define NUM_TIMER_STATS 16
185 #ifdef FAST_TIMER_LOG
186 struct fast_timer timer_added_log
[NUM_TIMER_STATS
];
187 struct fast_timer timer_started_log
[NUM_TIMER_STATS
];
188 struct fast_timer timer_expired_log
[NUM_TIMER_STATS
];
191 int timer_div_settings
[NUM_TIMER_STATS
];
192 int timer_freq_settings
[NUM_TIMER_STATS
];
193 int timer_delay_settings
[NUM_TIMER_STATS
];
195 /* Not true gettimeofday, only checks the jiffies (uptime) + useconds */
196 void __INLINE__
do_gettimeofday_fast(struct timeval
*tv
)
198 unsigned long sec
= jiffies
;
199 unsigned long usec
= GET_JIFFIES_USEC();
201 usec
+= (sec
% HZ
) * (1000000 / HZ
);
213 int __INLINE__
timeval_cmp(struct timeval
*t0
, struct timeval
*t1
)
215 if (t0
->tv_sec
< t1
->tv_sec
)
219 else if (t0
->tv_sec
> t1
->tv_sec
)
223 if (t0
->tv_usec
< t1
->tv_usec
)
227 else if (t0
->tv_usec
> t1
->tv_usec
)
234 void __INLINE__
start_timer1(unsigned long delay_us
)
236 int freq_index
= 0; /* This is the lowest resolution */
237 unsigned long upper_limit
= MAX_DELAY_US
;
240 /* Start/Restart the timer to the new shorter value */
241 /* t = 1/freq = 1/19200 = 53us
242 * T=div*t, div = T/t = delay_us*freq/1000000
244 #if 1 /* Adaptive timer settings */
245 while (delay_us
< upper_limit
&& freq_index
< MAX_USABLE_TIMER_FREQ
)
248 upper_limit
>>= 1; /* Divide by 2 using shift */
257 div
= delay_us
* timer_freq_100
[freq_index
]/10000;
260 /* Maybe increase timer freq? */
265 div
= 0; /* This means 256, the max the timer takes */
266 /* If a longer timeout than the timer can handle is used,
267 * then we must restart it when it goes off.
271 timer_div_settings
[fast_timers_started
% NUM_TIMER_STATS
] = div
;
272 timer_freq_settings
[fast_timers_started
% NUM_TIMER_STATS
] = freq_index
;
273 timer_delay_settings
[fast_timers_started
% NUM_TIMER_STATS
] = delay_us
;
275 D1(printk("start_timer1 : %d us freq: %i div: %i\n",
276 delay_us
, freq_index
, div
));
277 /* Clear timer1 irq */
278 *R_IRQ_MASK0_CLR
= IO_STATE(R_IRQ_MASK0_CLR
, timer1
, clr
);
280 /* Set timer values */
281 *R_TIMER_CTRL
= r_timer_ctrl_shadow
=
282 (r_timer_ctrl_shadow
&
283 ~IO_MASK(R_TIMER_CTRL
, timerdiv1
) &
284 ~IO_MASK(R_TIMER_CTRL
, tm1
) &
285 ~IO_MASK(R_TIMER_CTRL
, clksel1
)) |
286 IO_FIELD(R_TIMER_CTRL
, timerdiv1
, div
) |
287 IO_STATE(R_TIMER_CTRL
, tm1
, stop_ld
) |
288 IO_FIELD(R_TIMER_CTRL
, clksel1
, freq_index
); /* 6=c19k2Hz */
291 *R_TIMER_CTRL
= r_timer_ctrl_shadow
|
292 IO_STATE(R_TIMER_CTRL
, i1
, clr
);
295 *R_TIMER_CTRL
= r_timer_ctrl_shadow
=
296 (r_timer_ctrl_shadow
& ~IO_MASK(R_TIMER_CTRL
, tm1
)) |
297 IO_STATE(R_TIMER_CTRL
, tm1
, run
);
299 /* Enable timer1 irq */
300 *R_IRQ_MASK0_SET
= IO_STATE(R_IRQ_MASK0_SET
, timer1
, set
);
301 fast_timers_started
++;
302 fast_timer_running
= 1;
305 /* In version 1.4 this function takes 27 - 50 us */
306 void start_one_shot_timer(struct fast_timer
*t
,
307 fast_timer_function_type
*function
,
309 unsigned long delay_us
,
313 struct fast_timer
*tmp
;
315 D1(printk("sft %s %d us\n", name
, delay_us
));
320 do_gettimeofday_fast(&t
->tv_set
);
321 tmp
= fast_timer_list
;
323 SANITYCHECK({ /* Check so this is not in the list already... */
328 printk("timer name: %s data: 0x%08lX already in list!\n", name
, data
);
337 tmp
= fast_timer_list
;
340 t
->delay_us
= delay_us
;
341 t
->function
= function
;
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)
349 t
->tv_expires
.tv_usec
-= 1000000;
350 t
->tv_expires
.tv_sec
++;
352 #ifdef FAST_TIMER_LOG
353 timer_added_log
[fast_timers_added
% NUM_TIMER_STATS
] = *t
;
357 /* Check if this should timeout before anything else */
358 if (tmp
== NULL
|| timeval_cmp(&t
->tv_expires
, &tmp
->tv_expires
) < 0)
360 /* Put first in list and modify the timer value */
362 t
->next
= fast_timer_list
;
365 fast_timer_list
->prev
= t
;
368 #ifdef FAST_TIMER_LOG
369 timer_started_log
[fast_timers_started
% NUM_TIMER_STATS
] = *t
;
371 start_timer1(delay_us
);
373 /* Put in correct place in list */
375 timeval_cmp(&t
->tv_expires
, &tmp
->next
->tv_expires
) > 0)
379 /* Insert t after tmp */
389 D2(printk("start_one_shot_timer: %d us done\n", delay_us
));
391 restore_flags(flags
);
392 } /* start_one_shot_timer */
394 static inline int fast_timer_pending (const struct fast_timer
* t
)
396 return (t
->next
!= NULL
) || (t
->prev
!= NULL
) || (t
== fast_timer_list
);
399 static inline int detach_fast_timer (struct fast_timer
*t
)
401 struct fast_timer
*next
, *prev
;
402 if (!fast_timer_pending(t
))
411 fast_timer_list
= next
;
412 fast_timers_deleted
++;
416 int del_fast_timer(struct fast_timer
* t
)
423 ret
= detach_fast_timer(t
);
424 t
->next
= t
->prev
= NULL
;
425 restore_flags(flags
);
427 } /* del_fast_timer */
430 /* Interrupt routines or functions called in interrupt context */
432 /* Timer 1 interrupt handler */
435 timer1_handler(int irq
, void *dev_id
, struct pt_regs
*regs
)
437 struct fast_timer
*t
;
443 /* Clear timer1 irq */
444 *R_IRQ_MASK0_CLR
= IO_STATE(R_IRQ_MASK0_CLR
, timer1
, clr
);
446 /* First stop timer, then ack interrupt */
448 *R_TIMER_CTRL
= r_timer_ctrl_shadow
=
449 (r_timer_ctrl_shadow
& ~IO_MASK(R_TIMER_CTRL
, tm1
)) |
450 IO_STATE(R_TIMER_CTRL
, tm1
, stop_ld
);
453 *R_TIMER_CTRL
= r_timer_ctrl_shadow
| IO_STATE(R_TIMER_CTRL
, i1
, clr
);
455 fast_timer_running
= 0;
458 restore_flags(flags
);
465 /* Has it really expired? */
466 do_gettimeofday_fast(&tv
);
467 D1(printk("t: %is %06ius\n", tv
.tv_sec
, tv
.tv_usec
));
469 if (timeval_cmp(&t
->tv_expires
, &tv
) <= 0)
471 /* Yes it has expired */
472 #ifdef FAST_TIMER_LOG
473 timer_expired_log
[fast_timers_expired
% NUM_TIMER_STATS
] = *t
;
475 fast_timers_expired
++;
477 /* Remove this timer before call, since it may reuse the timer */
482 t
->prev
->next
= t
->next
;
486 fast_timer_list
= t
->next
;
490 t
->next
->prev
= t
->prev
;
494 restore_flags(flags
);
496 if (t
->function
!= NULL
)
498 t
->function(t
->data
);
502 DEBUG_LOG("!timer1 %i function==NULL!\n", fast_timer_ints
);
507 /* Timer is to early, let's set it again using the normal routines */
513 if ((t
= fast_timer_list
) != NULL
)
515 /* Start next timer.. */
519 do_gettimeofday_fast(&tv
);
520 us
= ((t
->tv_expires
.tv_sec
- tv
.tv_sec
) * 1000000 +
521 t
->tv_expires
.tv_usec
- tv
.tv_usec
);
524 if (!fast_timer_running
)
526 #ifdef FAST_TIMER_LOG
527 timer_started_log
[fast_timers_started
% NUM_TIMER_STATS
] = *t
;
531 restore_flags(flags
);
536 /* Timer already expired, let's handle it better late than never.
537 * The normal loop handles it
539 D1(printk("e! %d\n", us
));
542 restore_flags(flags
);
547 D1(printk("t1 stop!\n"));
553 static void wake_up_func(unsigned long data
)
555 #ifdef DECLARE_WAITQUEUE
556 wait_queue_head_t
*sleep_wait_p
= (wait_queue_head_t
*)data
;
558 struct wait_queue
**sleep_wait_p
= (struct wait_queue
**)data
;
560 wake_up(sleep_wait_p
);
566 void schedule_usleep(unsigned long us
)
569 #ifdef DECLARE_WAITQUEUE
570 wait_queue_head_t sleep_wait
;
571 init_waitqueue_head(&sleep_wait
);
573 DECLARE_WAITQUEUE(wait
, current
);
575 struct wait_queue
*sleep_wait
= NULL
;
576 struct wait_queue wait
= { current
, NULL
};
579 D1(printk("schedule_usleep(%d)\n", us
));
580 add_wait_queue(&sleep_wait
, &wait
);
581 set_current_state(TASK_INTERRUPTIBLE
);
582 start_one_shot_timer(&t
, wake_up_func
, (unsigned long)&sleep_wait
, us
,
585 set_current_state(TASK_RUNNING
);
586 remove_wait_queue(&sleep_wait
, &wait
);
587 D1(printk("done schedule_usleep(%d)\n", us
));
588 #ifdef DECLARE_WAITQUEUE
593 #ifdef CONFIG_PROC_FS
594 static int proc_fasttimer_read(char *buf
, char **start
, off_t offset
, int len
595 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,2,0)
596 ,int *eof
, void *data_unused
601 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,2,0)
602 static struct proc_dir_entry
*fasttimer_proc_entry
;
604 static struct proc_dir_entry fasttimer_proc_entry
=
607 S_IFREG
| S_IRUGO
, 1, 0, 0,
608 0, NULL
/* ops -- default to array */,
609 &proc_fasttimer_read
/* get_info */,
612 #endif /* CONFIG_PROC_FS */
614 #ifdef CONFIG_PROC_FS
616 /* This value is very much based on testing */
617 #define BIG_BUF_SIZE (500 + NUM_TIMER_STATS * 300)
619 static int proc_fasttimer_read(char *buf
, char **start
, off_t offset
, int len
620 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,2,0)
621 ,int *eof
, void *data_unused
631 struct fast_timer
*t
, *nextt
;
632 static char *bigbuf
= NULL
;
633 static unsigned long used
;
635 if (!bigbuf
&& !(bigbuf
= vmalloc(BIG_BUF_SIZE
)))
642 if (!offset
|| !used
)
644 do_gettimeofday_fast(&tv
);
647 used
+= sprintf(bigbuf
+ used
, "Fast timers added: %i\n",
649 used
+= sprintf(bigbuf
+ used
, "Fast timers started: %i\n",
650 fast_timers_started
);
651 used
+= sprintf(bigbuf
+ used
, "Fast timer interrupts: %i\n",
653 used
+= sprintf(bigbuf
+ used
, "Fast timers expired: %i\n",
654 fast_timers_expired
);
655 used
+= sprintf(bigbuf
+ used
, "Fast timers deleted: %i\n",
656 fast_timers_deleted
);
657 used
+= sprintf(bigbuf
+ used
, "Fast timer running: %s\n",
658 fast_timer_running
? "yes" : "no");
659 used
+= sprintf(bigbuf
+ used
, "Current time: %lu.%06lu\n",
660 (unsigned long)tv
.tv_sec
,
661 (unsigned long)tv
.tv_usec
);
662 #ifdef FAST_TIMER_SANITY_CHECKS
663 used
+= sprintf(bigbuf
+ used
, "Sanity failed: %i\n",
666 used
+= sprintf(bigbuf
+ used
, "\n");
668 #ifdef DEBUG_LOG_INCLUDED
670 int end_i
= debug_log_cnt
;
673 if (debug_log_cnt_wrapped
)
678 while ((i
!= end_i
|| (debug_log_cnt_wrapped
&& !used
)) &&
679 used
+100 < BIG_BUF_SIZE
)
681 used
+= sprintf(bigbuf
+ used
, debug_log_string
[i
],
683 i
= (i
+1) % DEBUG_LOG_MAX
;
686 used
+= sprintf(bigbuf
+ used
, "\n");
689 num_to_show
= (fast_timers_started
< NUM_TIMER_STATS
? fast_timers_started
:
691 used
+= sprintf(bigbuf
+ used
, "Timers started: %i\n", fast_timers_started
);
692 for (i
= 0; i
< num_to_show
&& (used
+100 < BIG_BUF_SIZE
) ; i
++)
694 int cur
= (fast_timers_started
- i
- 1) % NUM_TIMER_STATS
;
696 #if 1 //ndef FAST_TIMER_LOG
697 used
+= sprintf(bigbuf
+ used
, "div: %i freq: %i delay: %i"
699 timer_div_settings
[cur
],
700 timer_freq_settings
[cur
],
701 timer_delay_settings
[cur
]
704 #ifdef FAST_TIMER_LOG
705 t
= &timer_started_log
[cur
];
706 used
+= sprintf(bigbuf
+ used
, "%-14s s: %6lu.%06lu e: %6lu.%06lu "
707 "d: %6li us data: 0x%08lX"
710 (unsigned long)t
->tv_set
.tv_sec
,
711 (unsigned long)t
->tv_set
.tv_usec
,
712 (unsigned long)t
->tv_expires
.tv_sec
,
713 (unsigned long)t
->tv_expires
.tv_usec
,
719 used
+= sprintf(bigbuf
+ used
, "\n");
721 #ifdef FAST_TIMER_LOG
722 num_to_show
= (fast_timers_added
< NUM_TIMER_STATS
? fast_timers_added
:
724 used
+= sprintf(bigbuf
+ used
, "Timers added: %i\n", fast_timers_added
);
725 for (i
= 0; i
< num_to_show
&& (used
+100 < BIG_BUF_SIZE
); i
++)
727 t
= &timer_added_log
[(fast_timers_added
- i
- 1) % NUM_TIMER_STATS
];
728 used
+= sprintf(bigbuf
+ used
, "%-14s s: %6lu.%06lu e: %6lu.%06lu "
729 "d: %6li us data: 0x%08lX"
732 (unsigned long)t
->tv_set
.tv_sec
,
733 (unsigned long)t
->tv_set
.tv_usec
,
734 (unsigned long)t
->tv_expires
.tv_sec
,
735 (unsigned long)t
->tv_expires
.tv_usec
,
740 used
+= sprintf(bigbuf
+ used
, "\n");
742 num_to_show
= (fast_timers_expired
< NUM_TIMER_STATS
? fast_timers_expired
:
744 used
+= sprintf(bigbuf
+ used
, "Timers expired: %i\n", fast_timers_expired
);
745 for (i
= 0; i
< num_to_show
&& (used
+100 < BIG_BUF_SIZE
); i
++)
747 t
= &timer_expired_log
[(fast_timers_expired
- i
- 1) % NUM_TIMER_STATS
];
748 used
+= sprintf(bigbuf
+ used
, "%-14s s: %6lu.%06lu e: %6lu.%06lu "
749 "d: %6li us data: 0x%08lX"
752 (unsigned long)t
->tv_set
.tv_sec
,
753 (unsigned long)t
->tv_set
.tv_usec
,
754 (unsigned long)t
->tv_expires
.tv_sec
,
755 (unsigned long)t
->tv_expires
.tv_usec
,
760 used
+= sprintf(bigbuf
+ used
, "\n");
763 used
+= sprintf(bigbuf
+ used
, "Active timers:\n");
767 while (t
!= NULL
&& (used
+100 < BIG_BUF_SIZE
))
770 restore_flags(flags
);
771 used
+= sprintf(bigbuf
+ used
, "%-14s s: %6lu.%06lu e: %6lu.%06lu "
772 "d: %6li us data: 0x%08lX"
773 /* " func: 0x%08lX" */
776 (unsigned long)t
->tv_set
.tv_sec
,
777 (unsigned long)t
->tv_set
.tv_usec
,
778 (unsigned long)t
->tv_expires
.tv_sec
,
779 (unsigned long)t
->tv_expires
.tv_usec
,
785 if (t
->next
!= nextt
)
787 printk("timer removed!\n");
791 restore_flags(flags
);
794 if (used
- offset
< len
)
799 memcpy(buf
, bigbuf
+ offset
, len
);
801 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,2,0)
809 #ifdef FAST_TIMER_TEST
810 static volatile unsigned long i
= 0;
811 static volatile int num_test_timeout
= 0;
812 static struct fast_timer tr
[10];
813 static int exp_num
[10];
815 static struct timeval tv_exp
[100];
817 static void test_timeout(unsigned long data
)
819 do_gettimeofday_fast(&tv_exp
[data
]);
820 exp_num
[data
] = num_test_timeout
;
825 static void test_timeout1(unsigned long data
)
827 do_gettimeofday_fast(&tv_exp
[data
]);
828 exp_num
[data
] = num_test_timeout
;
831 start_one_shot_timer(&tr
[i
], test_timeout1
, i
, 1000, "timeout1");
838 static char buf0
[2000];
839 static char buf1
[2000];
840 static char buf2
[2000];
841 static char buf3
[2000];
842 static char buf4
[2000];
845 static char buf5
[6000];
846 static int j_u
[1000];
848 static void fast_timer_test(void)
853 struct timeval tv
, tv0
, tv1
, tv2
;
855 printk("fast_timer_test() start\n");
856 do_gettimeofday_fast(&tv
);
858 for (j
= 0; j
< 1000; j
++)
860 j_u
[j
] = GET_JIFFIES_USEC();
862 for (j
= 0; j
< 100; j
++)
864 do_gettimeofday_fast(&tv_exp
[j
]);
866 printk("fast_timer_test() %is %06i\n", tv
.tv_sec
, tv
.tv_usec
);
868 for (j
= 0; j
< 1000; j
++)
870 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]);
873 for (j
= 0; j
< 100; j
++)
875 printk("%i.%i %i.%i %i.%i %i.%i %i.%i\n",
876 tv_exp
[j
].tv_sec
,tv_exp
[j
].tv_usec
,
877 tv_exp
[j
+1].tv_sec
,tv_exp
[j
+1].tv_usec
,
878 tv_exp
[j
+2].tv_sec
,tv_exp
[j
+2].tv_usec
,
879 tv_exp
[j
+3].tv_sec
,tv_exp
[j
+3].tv_usec
,
880 tv_exp
[j
+4].tv_sec
,tv_exp
[j
+4].tv_usec
);
883 do_gettimeofday_fast(&tv0
);
884 start_one_shot_timer(&tr
[i
], test_timeout
, i
, 50000, "test0");
885 DP(proc_fasttimer_read(buf0
, NULL
, 0, 0, 0));
887 start_one_shot_timer(&tr
[i
], test_timeout
, i
, 70000, "test1");
888 DP(proc_fasttimer_read(buf1
, NULL
, 0, 0, 0));
890 start_one_shot_timer(&tr
[i
], test_timeout
, i
, 40000, "test2");
891 DP(proc_fasttimer_read(buf2
, NULL
, 0, 0, 0));
893 start_one_shot_timer(&tr
[i
], test_timeout
, i
, 60000, "test3");
894 DP(proc_fasttimer_read(buf3
, NULL
, 0, 0, 0));
896 start_one_shot_timer(&tr
[i
], test_timeout1
, i
, 55000, "test4xx");
897 DP(proc_fasttimer_read(buf4
, NULL
, 0, 0, 0));
899 do_gettimeofday_fast(&tv1
);
901 proc_fasttimer_read(buf5
, NULL
, 0, 0, 0);
903 prev_num
= num_test_timeout
;
904 while (num_test_timeout
< i
)
906 if (num_test_timeout
!= prev_num
)
908 prev_num
= num_test_timeout
;
911 do_gettimeofday_fast(&tv2
);
912 printk("Timers started %is %06i\n", tv0
.tv_sec
, tv0
.tv_usec
);
913 printk("Timers started at %is %06i\n", tv1
.tv_sec
, tv1
.tv_usec
);
914 printk("Timers done %is %06i\n", tv2
.tv_sec
, tv2
.tv_usec
);
915 DP(printk("buf0:\n");
929 printk("timers set:\n");
932 struct fast_timer
*t
= &tr
[j
];
933 printk("%-10s set: %6is %06ius exp: %6is %06ius "
934 "data: 0x%08X func: 0x%08X\n",
938 t
->tv_expires
.tv_sec
,
939 t
->tv_expires
.tv_usec
,
944 printk(" del: %6ius did exp: %6is %06ius as #%i error: %6li\n",
949 (tv_exp
[j
].tv_sec
- t
->tv_expires
.tv_sec
)*1000000 + tv_exp
[j
].tv_usec
- t
->tv_expires
.tv_usec
);
951 proc_fasttimer_read(buf5
, NULL
, 0, 0, 0);
952 printk("buf5 after all done:\n");
954 printk("fast_timer_test() done\n");
959 void fast_timer_init(void)
961 /* For some reason, request_irq() hangs when called froom time_init() */
962 if (!fast_timer_is_init
)
964 #if 0 && defined(FAST_TIMER_TEST)
968 printk("fast_timer_init()\n");
970 #if 0 && defined(FAST_TIMER_TEST)
971 for (i
= 0; i
<= TIMER0_DIV
; i
++)
973 /* We must be careful not to get overflow... */
974 printk("%3i %6u\n", i
, timer0_value_us
[i
]);
977 #ifdef CONFIG_PROC_FS
978 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,2,0)
979 if ((fasttimer_proc_entry
= create_proc_entry( "fasttimer", 0, 0 )))
980 fasttimer_proc_entry
->read_proc
= proc_fasttimer_read
;
982 proc_register_dynamic(&proc_root
, &fasttimer_proc_entry
);
985 if(request_irq(TIMER1_IRQ_NBR
, timer1_handler
, SA_SHIRQ
,
986 "fast timer int", NULL
))
988 printk("err: timer1 irq\n");
990 fast_timer_is_init
= 1;
991 #ifdef FAST_TIMER_TEST