diff options
Diffstat (limited to 'tools/thermal/tmon/tmon.c')
-rw-r--r-- | tools/thermal/tmon/tmon.c | 352 |
1 files changed, 352 insertions, 0 deletions
diff --git a/tools/thermal/tmon/tmon.c b/tools/thermal/tmon/tmon.c new file mode 100644 index 000000000000..b30f531173e4 --- /dev/null +++ b/tools/thermal/tmon/tmon.c | |||
@@ -0,0 +1,352 @@ | |||
1 | /* | ||
2 | * tmon.c Thermal Monitor (TMON) main function and entry point | ||
3 | * | ||
4 | * Copyright (C) 2012 Intel Corporation. All rights reserved. | ||
5 | * | ||
6 | * This program is free software; you can redistribute it and/or | ||
7 | * modify it under the terms of the GNU General Public License version | ||
8 | * 2 or later as published by the Free Software Foundation. | ||
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 | * Author: Jacob Pan <jacob.jun.pan@linux.intel.com> | ||
16 | * | ||
17 | */ | ||
18 | |||
19 | #include <getopt.h> | ||
20 | #include <unistd.h> | ||
21 | #include <stdio.h> | ||
22 | #include <stdlib.h> | ||
23 | #include <string.h> | ||
24 | #include <sys/types.h> | ||
25 | #include <sys/stat.h> | ||
26 | #include <ncurses.h> | ||
27 | #include <ctype.h> | ||
28 | #include <time.h> | ||
29 | #include <signal.h> | ||
30 | #include <limits.h> | ||
31 | #include <sys/time.h> | ||
32 | #include <pthread.h> | ||
33 | #include <math.h> | ||
34 | #include <stdarg.h> | ||
35 | #include <syslog.h> | ||
36 | |||
37 | #include "tmon.h" | ||
38 | |||
39 | unsigned long ticktime = 1; /* seconds */ | ||
40 | unsigned long no_control = 1; /* monitoring only or use cooling device for | ||
41 | * temperature control. | ||
42 | */ | ||
43 | double time_elapsed = 0.0; | ||
44 | unsigned long target_temp_user = 65; /* can be select by tui later */ | ||
45 | int dialogue_on; | ||
46 | int tmon_exit; | ||
47 | static short daemon_mode; | ||
48 | static int logging; /* for recording thermal data to a file */ | ||
49 | static int debug_on; | ||
50 | FILE *tmon_log; | ||
51 | /*cooling device used for the PID controller */ | ||
52 | char ctrl_cdev[CDEV_NAME_SIZE] = "None"; | ||
53 | int target_thermal_zone; /* user selected target zone instance */ | ||
54 | static void start_daemon_mode(void); | ||
55 | |||
56 | pthread_t event_tid; | ||
57 | pthread_mutex_t input_lock; | ||
58 | void usage() | ||
59 | { | ||
60 | printf("Usage: tmon [OPTION...]\n"); | ||
61 | printf(" -c, --control cooling device in control\n"); | ||
62 | printf(" -d, --daemon run as daemon, no TUI\n"); | ||
63 | printf(" -g, --debug debug message in syslog\n"); | ||
64 | printf(" -h, --help show this help message\n"); | ||
65 | printf(" -l, --log log data to /var/tmp/tmon.log\n"); | ||
66 | printf(" -t, --time-interval sampling time interval, > 1 sec.\n"); | ||
67 | printf(" -v, --version show version\n"); | ||
68 | printf(" -z, --zone target thermal zone id\n"); | ||
69 | |||
70 | exit(0); | ||
71 | } | ||
72 | |||
73 | void version() | ||
74 | { | ||
75 | printf("TMON version %s\n", VERSION); | ||
76 | exit(EXIT_SUCCESS); | ||
77 | } | ||
78 | |||
79 | static void tmon_cleanup(void) | ||
80 | { | ||
81 | |||
82 | syslog(LOG_INFO, "TMON exit cleanup\n"); | ||
83 | fflush(stdout); | ||
84 | refresh(); | ||
85 | if (tmon_log) | ||
86 | fclose(tmon_log); | ||
87 | if (event_tid) { | ||
88 | pthread_mutex_lock(&input_lock); | ||
89 | pthread_cancel(event_tid); | ||
90 | pthread_mutex_unlock(&input_lock); | ||
91 | pthread_mutex_destroy(&input_lock); | ||
92 | } | ||
93 | closelog(); | ||
94 | /* relax control knobs, undo throttling */ | ||
95 | set_ctrl_state(0); | ||
96 | |||
97 | keypad(stdscr, FALSE); | ||
98 | echo(); | ||
99 | nocbreak(); | ||
100 | close_windows(); | ||
101 | endwin(); | ||
102 | free_thermal_data(); | ||
103 | |||
104 | exit(1); | ||
105 | } | ||
106 | |||
107 | |||
108 | static void tmon_sig_handler(int sig) | ||
109 | { | ||
110 | syslog(LOG_INFO, "TMON caught signal %d\n", sig); | ||
111 | refresh(); | ||
112 | switch (sig) { | ||
113 | case SIGTERM: | ||
114 | printf("sigterm, exit and clean up\n"); | ||
115 | fflush(stdout); | ||
116 | break; | ||
117 | case SIGKILL: | ||
118 | printf("sigkill, exit and clean up\n"); | ||
119 | fflush(stdout); | ||
120 | break; | ||
121 | case SIGINT: | ||
122 | printf("ctrl-c, exit and clean up\n"); | ||
123 | fflush(stdout); | ||
124 | break; | ||
125 | default: | ||
126 | break; | ||
127 | } | ||
128 | tmon_exit = true; | ||
129 | } | ||
130 | |||
131 | |||
132 | static void start_syslog(void) | ||
133 | { | ||
134 | if (debug_on) | ||
135 | setlogmask(LOG_UPTO(LOG_DEBUG)); | ||
136 | else | ||
137 | setlogmask(LOG_UPTO(LOG_ERR)); | ||
138 | openlog("tmon.log", LOG_CONS | LOG_PID | LOG_NDELAY, LOG_LOCAL0); | ||
139 | syslog(LOG_NOTICE, "TMON started by User %d", getuid()); | ||
140 | } | ||
141 | |||
142 | static void prepare_logging(void) | ||
143 | { | ||
144 | int i; | ||
145 | |||
146 | if (!logging) | ||
147 | return; | ||
148 | /* open local data log file */ | ||
149 | tmon_log = fopen(TMON_LOG_FILE, "w+"); | ||
150 | if (!tmon_log) { | ||
151 | syslog(LOG_ERR, "failed to open log file %s\n", TMON_LOG_FILE); | ||
152 | return; | ||
153 | } | ||
154 | |||
155 | fprintf(tmon_log, "#----------- THERMAL SYSTEM CONFIG -------------\n"); | ||
156 | for (i = 0; i < ptdata.nr_tz_sensor; i++) { | ||
157 | char binding_str[33]; /* size of long + 1 */ | ||
158 | int j; | ||
159 | |||
160 | memset(binding_str, 0, sizeof(binding_str)); | ||
161 | for (j = 0; j < 32; j++) | ||
162 | binding_str[j] = (ptdata.tzi[i].cdev_binding & 1<<j) ? | ||
163 | '1' : '0'; | ||
164 | |||
165 | fprintf(tmon_log, "#thermal zone %s%02d cdevs binding: %32s\n", | ||
166 | ptdata.tzi[i].type, | ||
167 | ptdata.tzi[i].instance, | ||
168 | binding_str); | ||
169 | for (j = 0; j < ptdata.tzi[i].nr_trip_pts; j++) { | ||
170 | fprintf(tmon_log, "#\tTP%02d type:%s, temp:%lu\n", j, | ||
171 | trip_type_name[ptdata.tzi[i].tp[j].type], | ||
172 | ptdata.tzi[i].tp[j].temp); | ||
173 | } | ||
174 | |||
175 | } | ||
176 | |||
177 | for (i = 0; i < ptdata.nr_cooling_dev; i++) | ||
178 | fprintf(tmon_log, "#cooling devices%02d: %s\n", | ||
179 | i, ptdata.cdi[i].type); | ||
180 | |||
181 | fprintf(tmon_log, "#---------- THERMAL DATA LOG STARTED -----------\n"); | ||
182 | fprintf(tmon_log, "Samples TargetTemp "); | ||
183 | for (i = 0; i < ptdata.nr_tz_sensor; i++) { | ||
184 | fprintf(tmon_log, "%s%d ", ptdata.tzi[i].type, | ||
185 | ptdata.tzi[i].instance); | ||
186 | } | ||
187 | for (i = 0; i < ptdata.nr_cooling_dev; i++) | ||
188 | fprintf(tmon_log, "%s%d ", ptdata.cdi[i].type, | ||
189 | ptdata.cdi[i].instance); | ||
190 | |||
191 | fprintf(tmon_log, "\n"); | ||
192 | } | ||
193 | |||
194 | static struct option opts[] = { | ||
195 | { "control", 1, NULL, 'c' }, | ||
196 | { "daemon", 0, NULL, 'd' }, | ||
197 | { "time-interval", 1, NULL, 't' }, | ||
198 | { "log", 0, NULL, 'l' }, | ||
199 | { "help", 0, NULL, 'h' }, | ||
200 | { "version", 0, NULL, 'v' }, | ||
201 | { "debug", 0, NULL, 'g' }, | ||
202 | { 0, 0, NULL, 0 } | ||
203 | }; | ||
204 | |||
205 | |||
206 | int main(int argc, char **argv) | ||
207 | { | ||
208 | int err = 0; | ||
209 | int id2 = 0, c; | ||
210 | double yk = 0.0; /* controller output */ | ||
211 | int target_tz_index; | ||
212 | |||
213 | if (geteuid() != 0) { | ||
214 | printf("TMON needs to be run as root\n"); | ||
215 | exit(EXIT_FAILURE); | ||
216 | } | ||
217 | |||
218 | while ((c = getopt_long(argc, argv, "c:dlht:vgz:", opts, &id2)) != -1) { | ||
219 | switch (c) { | ||
220 | case 'c': | ||
221 | no_control = 0; | ||
222 | strncpy(ctrl_cdev, optarg, CDEV_NAME_SIZE); | ||
223 | break; | ||
224 | case 'd': | ||
225 | start_daemon_mode(); | ||
226 | printf("Run TMON in daemon mode\n"); | ||
227 | break; | ||
228 | case 't': | ||
229 | ticktime = strtod(optarg, NULL); | ||
230 | if (ticktime < 1) | ||
231 | ticktime = 1; | ||
232 | break; | ||
233 | case 'l': | ||
234 | printf("Logging data to /var/tmp/tmon.log\n"); | ||
235 | logging = 1; | ||
236 | break; | ||
237 | case 'h': | ||
238 | usage(); | ||
239 | break; | ||
240 | case 'v': | ||
241 | version(); | ||
242 | break; | ||
243 | case 'g': | ||
244 | debug_on = 1; | ||
245 | break; | ||
246 | case 'z': | ||
247 | target_thermal_zone = strtod(optarg, NULL); | ||
248 | break; | ||
249 | default: | ||
250 | break; | ||
251 | } | ||
252 | } | ||
253 | if (pthread_mutex_init(&input_lock, NULL) != 0) { | ||
254 | fprintf(stderr, "\n mutex init failed, exit\n"); | ||
255 | return 1; | ||
256 | } | ||
257 | start_syslog(); | ||
258 | if (signal(SIGINT, tmon_sig_handler) == SIG_ERR) | ||
259 | syslog(LOG_DEBUG, "Cannot handle SIGINT\n"); | ||
260 | if (signal(SIGTERM, tmon_sig_handler) == SIG_ERR) | ||
261 | syslog(LOG_DEBUG, "Cannot handle SIGINT\n"); | ||
262 | |||
263 | if (probe_thermal_sysfs()) { | ||
264 | pthread_mutex_destroy(&input_lock); | ||
265 | closelog(); | ||
266 | return -1; | ||
267 | } | ||
268 | initialize_curses(); | ||
269 | setup_windows(); | ||
270 | signal(SIGWINCH, resize_handler); | ||
271 | show_title_bar(); | ||
272 | show_sensors_w(); | ||
273 | show_cooling_device(); | ||
274 | update_thermal_data(); | ||
275 | show_data_w(); | ||
276 | prepare_logging(); | ||
277 | init_thermal_controller(); | ||
278 | |||
279 | nodelay(stdscr, TRUE); | ||
280 | err = pthread_create(&event_tid, NULL, &handle_tui_events, NULL); | ||
281 | if (err != 0) { | ||
282 | printf("\ncan't create thread :[%s]", strerror(err)); | ||
283 | tmon_cleanup(); | ||
284 | exit(EXIT_FAILURE); | ||
285 | } | ||
286 | |||
287 | /* validate range of user selected target zone, default to the first | ||
288 | * instance if out of range | ||
289 | */ | ||
290 | target_tz_index = zone_instance_to_index(target_thermal_zone); | ||
291 | if (target_tz_index < 0) { | ||
292 | target_thermal_zone = ptdata.tzi[0].instance; | ||
293 | syslog(LOG_ERR, "target zone is not found, default to %d\n", | ||
294 | target_thermal_zone); | ||
295 | } | ||
296 | while (1) { | ||
297 | sleep(ticktime); | ||
298 | show_title_bar(); | ||
299 | show_sensors_w(); | ||
300 | update_thermal_data(); | ||
301 | if (!dialogue_on) { | ||
302 | show_data_w(); | ||
303 | show_cooling_device(); | ||
304 | } | ||
305 | cur_thermal_record++; | ||
306 | time_elapsed += ticktime; | ||
307 | controller_handler(trec[0].temp[target_tz_index] / 1000, | ||
308 | &yk); | ||
309 | trec[0].pid_out_pct = yk; | ||
310 | if (!dialogue_on) | ||
311 | show_control_w(); | ||
312 | if (tmon_exit) | ||
313 | break; | ||
314 | } | ||
315 | tmon_cleanup(); | ||
316 | return 0; | ||
317 | } | ||
318 | |||
319 | static void start_daemon_mode() | ||
320 | { | ||
321 | daemon_mode = 1; | ||
322 | /* fork */ | ||
323 | pid_t sid, pid = fork(); | ||
324 | if (pid < 0) { | ||
325 | exit(EXIT_FAILURE); | ||
326 | } else if (pid > 0) | ||
327 | /* kill parent */ | ||
328 | exit(EXIT_SUCCESS); | ||
329 | |||
330 | /* disable TUI, it may not be necessary, but saves some resource */ | ||
331 | disable_tui(); | ||
332 | |||
333 | /* change the file mode mask */ | ||
334 | umask(0); | ||
335 | |||
336 | /* new SID for the daemon process */ | ||
337 | sid = setsid(); | ||
338 | if (sid < 0) | ||
339 | exit(EXIT_FAILURE); | ||
340 | |||
341 | /* change working directory */ | ||
342 | if ((chdir("/")) < 0) | ||
343 | exit(EXIT_FAILURE); | ||
344 | |||
345 | |||
346 | sleep(10); | ||
347 | |||
348 | close(STDIN_FILENO); | ||
349 | close(STDOUT_FILENO); | ||
350 | close(STDERR_FILENO); | ||
351 | |||
352 | } | ||