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

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

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

~ [ 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