- fixed arm926 cp15 command bug (thanks to Vincent Palatin for this patch)
[openocd.git] / src / helper / time_support.c
1 /***************************************************************************
2 * Copyright (C) 2006 by Dominic Rath *
3 * Dominic.Rath@gmx.de *
4 * *
5 * This program is free software; you can redistribute it and/or modify *
6 * it under the terms of the GNU General Public License as published by *
7 * the Free Software Foundation; either version 2 of the License, or *
8 * (at your option) any later version. *
9 * *
10 * This program is distributed in the hope that it will be useful, *
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
13 * GNU General Public License for more details. *
14 * *
15 * You should have received a copy of the GNU General Public License *
16 * along with this program; if not, write to the *
17 * Free Software Foundation, Inc., *
18 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
19 ***************************************************************************/
20 #ifdef HAVE_CONFIG_H
21 #include "config.h"
22 #endif
23
24 #include "time_support.h"
25 #include "log.h"
26
27 #include <stdlib.h>
28 #include <sys/time.h>
29 #include <time.h>
30
31 int timeval_subtract(struct timeval *result, struct timeval *x, struct timeval *y);
32 int timeval_add(struct timeval *result, struct timeval *x, struct timeval *y);
33 int timeval_add_time(struct timeval *result, int sec, int usec);
34
35 /* calculate difference between two struct timeval values */
36 int timeval_subtract(struct timeval *result, struct timeval *x, struct timeval *y)
37 {
38 if (x->tv_usec < y->tv_usec)
39 {
40 int nsec = (y->tv_usec - x->tv_usec) / 1000000 + 1;
41 y->tv_usec -= 1000000 * nsec;
42 y->tv_sec += nsec;
43 }
44 if (x->tv_usec - y->tv_usec > 1000000) {
45 int nsec = (x->tv_usec - y->tv_usec) / 1000000;
46 y->tv_usec += 1000000 * nsec;
47 y->tv_sec -= nsec;
48 }
49
50 result->tv_sec = x->tv_sec - y->tv_sec;
51 result->tv_usec = x->tv_usec - y->tv_usec;
52
53 /* Return 1 if result is negative. */
54 return x->tv_sec < y->tv_sec;
55 }
56
57 /* add two struct timeval values */
58 int timeval_add(struct timeval *result, struct timeval *x, struct timeval *y)
59 {
60 result->tv_sec = x->tv_sec + y->tv_sec;
61
62 result->tv_usec = x->tv_usec + y->tv_usec;
63
64 while (result->tv_usec > 1000000)
65 {
66 result->tv_usec -= 1000000;
67 result->tv_sec++;
68 }
69
70 return 0;
71 }
72
73 int timeval_add_time(struct timeval *result, int sec, int usec)
74 {
75 result->tv_sec += sec;
76 result->tv_usec += usec;
77
78 while (result->tv_usec > 1000000)
79 {
80 result->tv_usec -= 1000000;
81 result->tv_sec++;
82 }
83
84 return 0;
85 }
86
87 int duration_start_measure(duration_t *duration)
88 {
89 gettimeofday(&duration->start, NULL);
90
91 return ERROR_OK;
92 }
93
94 int duration_stop_measure(duration_t *duration, char **text)
95 {
96 struct timeval end;
97
98 gettimeofday(&end, NULL);
99
100 timeval_subtract(&duration->duration, &end, &duration->start);
101
102 if (text)
103 {
104 *text = malloc(16);
105 snprintf(*text, 16, "%lis %lius", duration->duration.tv_sec, duration->duration.tv_usec);
106 }
107
108 return ERROR_OK;
109 }