1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
|
/* $Id$
* $URL$
*
* short delays
*
* Copyright (C) 1999, 2000 Michael Reinelt <michael@reinelt.co.at>
* Copyright (C) 2004 The LCD4Linux Team <lcd4linux-devel@users.sourceforge.net>
*
* This file is part of LCD4Linux.
*
* LCD4Linux is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2, or (at your option)
* any later version.
*
* LCD4Linux is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*
*/
/*
*
* exported fuctions:
*
* void udelay_init (void)
* selects delay method (gettimeofday() ord rdtsc() according
* to processor features
*
* unsigned long timing (const char *driver, const char *section, const char *name, const int defval, const char *unit);
* returns a timing value from config or the default value
*
* void udelay (unsigned long usec)
* delays program execution for usec microseconds
* uses global variable 'loops_per_usec', which has to be set before.
* This function does busy-waiting! so use only for delays smaller
* than 10 msec
*
*/
#include "config.h"
#include <stdlib.h>
#include <stdio.h>
#include <math.h>
#include <unistd.h>
#include <fcntl.h>
#include <errno.h>
#include <string.h>
#include <sys/time.h>
#include "debug.h"
#include "cfg.h"
#include "qprintf.h"
#include "udelay.h"
void udelay_init(void)
{
info("udelay: using gettimeofday() delay loop");
}
unsigned long timing(const char *driver, const char *section, const char *name, const int defval, const char *unit)
{
char sec[256];
int fuzz, val;
qprintf(sec, sizeof(sec), "%s.Timing", section);
/* fuzz all timings by given factor */
cfg_number(sec, "fuzz", 100, 1, -1, &fuzz);
cfg_number(sec, name, defval, 0, -1, &val);
val = val * fuzz / 100;
if (val != defval) {
if (fuzz != 100) {
info("%s: timing: %6s = %5d %s (default %d %s, fuzz %d)", driver, name, val, unit, defval, unit, fuzz);
} else {
info("%s: timing: %6s = %5d %s (default %d %s)", driver, name, val, unit, defval, unit);
}
} else {
info("%s: timing: %6s = %5d %s (default)", driver, name, defval, unit);
}
return val;
}
void ndelay(const unsigned long nsec)
{
struct timeval now, end;
gettimeofday(&end, NULL);
end.tv_usec += (nsec + 999) / 1000;
while (end.tv_usec > 1000000) {
end.tv_usec -= 1000000;
end.tv_sec++;
}
do {
rep_nop();
gettimeofday(&now, NULL);
} while (now.tv_sec == end.tv_sec ? now.tv_usec < end.tv_usec : now.tv_sec < end.tv_sec);
}
|
