~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

TOMOYO Linux Cross Reference
Linux/Documentation/timers/hpet_example.c

Version: ~ [ linux-5.8-rc4 ] ~ [ linux-5.7.7 ] ~ [ linux-5.6.19 ] ~ [ linux-5.5.19 ] ~ [ linux-5.4.50 ] ~ [ linux-5.3.18 ] ~ [ linux-5.2.21 ] ~ [ linux-5.1.21 ] ~ [ linux-5.0.21 ] ~ [ linux-4.20.17 ] ~ [ linux-4.19.131 ] ~ [ linux-4.18.20 ] ~ [ linux-4.17.19 ] ~ [ linux-4.16.18 ] ~ [ linux-4.15.18 ] ~ [ linux-4.14.187 ] ~ [ linux-4.13.16 ] ~ [ linux-4.12.14 ] ~ [ linux-4.11.12 ] ~ [ linux-4.10.17 ] ~ [ linux-4.9.229 ] ~ [ linux-4.8.17 ] ~ [ linux-4.7.10 ] ~ [ linux-4.6.7 ] ~ [ linux-4.5.7 ] ~ [ linux-4.4.229 ] ~ [ linux-4.3.6 ] ~ [ linux-4.2.8 ] ~ [ linux-4.1.52 ] ~ [ linux-4.0.9 ] ~ [ linux-3.19.8 ] ~ [ linux-3.18.140 ] ~ [ linux-3.17.8 ] ~ [ linux-3.16.85 ] ~ [ linux-3.15.10 ] ~ [ linux-3.14.79 ] ~ [ linux-3.13.11 ] ~ [ linux-3.12.74 ] ~ [ linux-3.11.10 ] ~ [ linux-3.10.108 ] ~ [ linux-2.6.32.71 ] ~ [ linux-2.6.0 ] ~ [ linux-2.4.37.11 ] ~ [ unix-v6-master ] ~ [ ccs-tools-1.8.5 ] ~ [ policy-sample ] ~
Architecture: ~ [ i386 ] ~ [ alpha ] ~ [ m68k ] ~ [ mips ] ~ [ ppc ] ~ [ sparc ] ~ [ sparc64 ] ~

  1 #include <stdio.h>
  2 #include <stdlib.h>
  3 #include <unistd.h>
  4 #include <fcntl.h>
  5 #include <string.h>
  6 #include <memory.h>
  7 #include <malloc.h>
  8 #include <time.h>
  9 #include <ctype.h>
 10 #include <sys/types.h>
 11 #include <sys/wait.h>
 12 #include <signal.h>
 13 #include <errno.h>
 14 #include <sys/time.h>
 15 #include <linux/hpet.h>
 16 
 17 
 18 extern void hpet_open_close(int, const char **);
 19 extern void hpet_info(int, const char **);
 20 extern void hpet_poll(int, const char **);
 21 extern void hpet_fasync(int, const char **);
 22 extern void hpet_read(int, const char **);
 23 
 24 #include <sys/poll.h>
 25 #include <sys/ioctl.h>
 26 
 27 struct hpet_command {
 28         char            *command;
 29         void            (*func)(int argc, const char ** argv);
 30 } hpet_command[] = {
 31         {
 32                 "open-close",
 33                 hpet_open_close
 34         },
 35         {
 36                 "info",
 37                 hpet_info
 38         },
 39         {
 40                 "poll",
 41                 hpet_poll
 42         },
 43         {
 44                 "fasync",
 45                 hpet_fasync
 46         },
 47 };
 48 
 49 int
 50 main(int argc, const char ** argv)
 51 {
 52         unsigned int    i;
 53 
 54         argc--;
 55         argv++;
 56 
 57         if (!argc) {
 58                 fprintf(stderr, "-hpet: requires command\n");
 59                 return -1;
 60         }
 61 
 62 
 63         for (i = 0; i < (sizeof (hpet_command) / sizeof (hpet_command[0])); i++)
 64                 if (!strcmp(argv[0], hpet_command[i].command)) {
 65                         argc--;
 66                         argv++;
 67                         fprintf(stderr, "-hpet: executing %s\n",
 68                                 hpet_command[i].command);
 69                         hpet_command[i].func(argc, argv);
 70                         return 0;
 71                 }
 72 
 73         fprintf(stderr, "do_hpet: command %s not implemented\n", argv[0]);
 74 
 75         return -1;
 76 }
 77 
 78 void
 79 hpet_open_close(int argc, const char **argv)
 80 {
 81         int     fd;
 82 
 83         if (argc != 1) {
 84                 fprintf(stderr, "hpet_open_close: device-name\n");
 85                 return;
 86         }
 87 
 88         fd = open(argv[0], O_RDONLY);
 89         if (fd < 0)
 90                 fprintf(stderr, "hpet_open_close: open failed\n");
 91         else
 92                 close(fd);
 93 
 94         return;
 95 }
 96 
 97 void
 98 hpet_info(int argc, const char **argv)
 99 {
100         struct hpet_info        info;
101         int                     fd;
102 
103         if (argc != 1) {
104                 fprintf(stderr, "hpet_info: device-name\n");
105                 return;
106         }
107 
108         fd = open(argv[0], O_RDONLY);
109         if (fd < 0) {
110                 fprintf(stderr, "hpet_info: open of %s failed\n", argv[0]);
111                 return;
112         }
113 
114         if (ioctl(fd, HPET_INFO, &info) < 0) {
115                 fprintf(stderr, "hpet_info: failed to get info\n");
116                 goto out;
117         }
118 
119         fprintf(stderr, "hpet_info: hi_irqfreq 0x%lx hi_flags 0x%lx ",
120                 info.hi_ireqfreq, info.hi_flags);
121         fprintf(stderr, "hi_hpet %d hi_timer %d\n",
122                 info.hi_hpet, info.hi_timer);
123 
124 out:
125         close(fd);
126         return;
127 }
128 
129 void
130 hpet_poll(int argc, const char **argv)
131 {
132         unsigned long           freq;
133         int                     iterations, i, fd;
134         struct pollfd           pfd;
135         struct hpet_info        info;
136         struct timeval          stv, etv;
137         struct timezone         tz;
138         long                    usec;
139 
140         if (argc != 3) {
141                 fprintf(stderr, "hpet_poll: device-name freq iterations\n");
142                 return;
143         }
144 
145         freq = atoi(argv[1]);
146         iterations = atoi(argv[2]);
147 
148         fd = open(argv[0], O_RDONLY);
149 
150         if (fd < 0) {
151                 fprintf(stderr, "hpet_poll: open of %s failed\n", argv[0]);
152                 return;
153         }
154 
155         if (ioctl(fd, HPET_IRQFREQ, freq) < 0) {
156                 fprintf(stderr, "hpet_poll: HPET_IRQFREQ failed\n");
157                 goto out;
158         }
159 
160         if (ioctl(fd, HPET_INFO, &info) < 0) {
161                 fprintf(stderr, "hpet_poll: failed to get info\n");
162                 goto out;
163         }
164 
165         fprintf(stderr, "hpet_poll: info.hi_flags 0x%lx\n", info.hi_flags);
166 
167         if (info.hi_flags && (ioctl(fd, HPET_EPI, 0) < 0)) {
168                 fprintf(stderr, "hpet_poll: HPET_EPI failed\n");
169                 goto out;
170         }
171 
172         if (ioctl(fd, HPET_IE_ON, 0) < 0) {
173                 fprintf(stderr, "hpet_poll, HPET_IE_ON failed\n");
174                 goto out;
175         }
176 
177         pfd.fd = fd;
178         pfd.events = POLLIN;
179 
180         for (i = 0; i < iterations; i++) {
181                 pfd.revents = 0;
182                 gettimeofday(&stv, &tz);
183                 if (poll(&pfd, 1, -1) < 0)
184                         fprintf(stderr, "hpet_poll: poll failed\n");
185                 else {
186                         long    data;
187 
188                         gettimeofday(&etv, &tz);
189                         usec = stv.tv_sec * 1000000 + stv.tv_usec;
190                         usec = (etv.tv_sec * 1000000 + etv.tv_usec) - usec;
191 
192                         fprintf(stderr,
193                                 "hpet_poll: expired time = 0x%lx\n", usec);
194 
195                         fprintf(stderr, "hpet_poll: revents = 0x%x\n",
196                                 pfd.revents);
197 
198                         if (read(fd, &data, sizeof(data)) != sizeof(data)) {
199                                 fprintf(stderr, "hpet_poll: read failed\n");
200                         }
201                         else
202                                 fprintf(stderr, "hpet_poll: data 0x%lx\n",
203                                         data);
204                 }
205         }
206 
207 out:
208         close(fd);
209         return;
210 }
211 
212 static int hpet_sigio_count;
213 
214 static void
215 hpet_sigio(int val)
216 {
217         fprintf(stderr, "hpet_sigio: called\n");
218         hpet_sigio_count++;
219 }
220 
221 void
222 hpet_fasync(int argc, const char **argv)
223 {
224         unsigned long           freq;
225         int                     iterations, i, fd, value;
226         sig_t                   oldsig;
227         struct hpet_info        info;
228 
229         hpet_sigio_count = 0;
230         fd = -1;
231 
232         if ((oldsig = signal(SIGIO, hpet_sigio)) == SIG_ERR) {
233                 fprintf(stderr, "hpet_fasync: failed to set signal handler\n");
234                 return;
235         }
236 
237         if (argc != 3) {
238                 fprintf(stderr, "hpet_fasync: device-name freq iterations\n");
239                 goto out;
240         }
241 
242         fd = open(argv[0], O_RDONLY);
243 
244         if (fd < 0) {
245                 fprintf(stderr, "hpet_fasync: failed to open %s\n", argv[0]);
246                 return;
247         }
248 
249 
250         if ((fcntl(fd, F_SETOWN, getpid()) == 1) ||
251                 ((value = fcntl(fd, F_GETFL)) == 1) ||
252                 (fcntl(fd, F_SETFL, value | O_ASYNC) == 1)) {
253                 fprintf(stderr, "hpet_fasync: fcntl failed\n");
254                 goto out;
255         }
256 
257         freq = atoi(argv[1]);
258         iterations = atoi(argv[2]);
259 
260         if (ioctl(fd, HPET_IRQFREQ, freq) < 0) {
261                 fprintf(stderr, "hpet_fasync: HPET_IRQFREQ failed\n");
262                 goto out;
263         }
264 
265         if (ioctl(fd, HPET_INFO, &info) < 0) {
266                 fprintf(stderr, "hpet_fasync: failed to get info\n");
267                 goto out;
268         }
269 
270         fprintf(stderr, "hpet_fasync: info.hi_flags 0x%lx\n", info.hi_flags);
271 
272         if (info.hi_flags && (ioctl(fd, HPET_EPI, 0) < 0)) {
273                 fprintf(stderr, "hpet_fasync: HPET_EPI failed\n");
274                 goto out;
275         }
276 
277         if (ioctl(fd, HPET_IE_ON, 0) < 0) {
278                 fprintf(stderr, "hpet_fasync, HPET_IE_ON failed\n");
279                 goto out;
280         }
281 
282         for (i = 0; i < iterations; i++) {
283                 (void) pause();
284                 fprintf(stderr, "hpet_fasync: count = %d\n", hpet_sigio_count);
285         }
286 
287 out:
288         signal(SIGIO, oldsig);
289 
290         if (fd >= 0)
291                 close(fd);
292 
293         return;
294 }
295 

~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

kernel.org | git.kernel.org | LWN.net | Project Home | Wiki (Japanese) | Wiki (English) | SVN repository | Mail admin

Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.

osdn.jp