xref: /kernel/linux/linux-6.6/tools/thermal/tmon/tmon.c (revision 62306a36)
162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * tmon.c Thermal Monitor (TMON) main function and entry point
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Copyright (C) 2012 Intel Corporation. All rights reserved.
662306a36Sopenharmony_ci *
762306a36Sopenharmony_ci * Author: Jacob Pan <jacob.jun.pan@linux.intel.com>
862306a36Sopenharmony_ci */
962306a36Sopenharmony_ci
1062306a36Sopenharmony_ci#include <getopt.h>
1162306a36Sopenharmony_ci#include <unistd.h>
1262306a36Sopenharmony_ci#include <stdio.h>
1362306a36Sopenharmony_ci#include <stdlib.h>
1462306a36Sopenharmony_ci#include <string.h>
1562306a36Sopenharmony_ci#include <sys/types.h>
1662306a36Sopenharmony_ci#include <sys/stat.h>
1762306a36Sopenharmony_ci#include <ncurses.h>
1862306a36Sopenharmony_ci#include <ctype.h>
1962306a36Sopenharmony_ci#include <time.h>
2062306a36Sopenharmony_ci#include <signal.h>
2162306a36Sopenharmony_ci#include <limits.h>
2262306a36Sopenharmony_ci#include <sys/time.h>
2362306a36Sopenharmony_ci#include <pthread.h>
2462306a36Sopenharmony_ci#include <math.h>
2562306a36Sopenharmony_ci#include <stdarg.h>
2662306a36Sopenharmony_ci#include <syslog.h>
2762306a36Sopenharmony_ci
2862306a36Sopenharmony_ci#include "tmon.h"
2962306a36Sopenharmony_ci
3062306a36Sopenharmony_ciunsigned long ticktime = 1; /* seconds */
3162306a36Sopenharmony_ciunsigned long no_control = 1; /* monitoring only or use cooling device for
3262306a36Sopenharmony_ci			       * temperature control.
3362306a36Sopenharmony_ci			       */
3462306a36Sopenharmony_cidouble time_elapsed = 0.0;
3562306a36Sopenharmony_ciunsigned long target_temp_user = 65; /* can be select by tui later */
3662306a36Sopenharmony_ciint dialogue_on;
3762306a36Sopenharmony_ciint tmon_exit;
3862306a36Sopenharmony_cistatic short	daemon_mode;
3962306a36Sopenharmony_cistatic int logging; /* for recording thermal data to a file */
4062306a36Sopenharmony_cistatic int debug_on;
4162306a36Sopenharmony_ciFILE *tmon_log;
4262306a36Sopenharmony_ci/*cooling device used for the PID controller */
4362306a36Sopenharmony_cichar ctrl_cdev[CDEV_NAME_SIZE] = "None";
4462306a36Sopenharmony_ciint target_thermal_zone; /* user selected target zone instance */
4562306a36Sopenharmony_cistatic void	start_daemon_mode(void);
4662306a36Sopenharmony_ci
4762306a36Sopenharmony_cipthread_t event_tid;
4862306a36Sopenharmony_cipthread_mutex_t input_lock;
4962306a36Sopenharmony_civoid usage(void)
5062306a36Sopenharmony_ci{
5162306a36Sopenharmony_ci	printf("Usage: tmon [OPTION...]\n");
5262306a36Sopenharmony_ci	printf("  -c, --control         cooling device in control\n");
5362306a36Sopenharmony_ci	printf("  -d, --daemon          run as daemon, no TUI\n");
5462306a36Sopenharmony_ci	printf("  -g, --debug           debug message in syslog\n");
5562306a36Sopenharmony_ci	printf("  -h, --help            show this help message\n");
5662306a36Sopenharmony_ci	printf("  -l, --log             log data to /var/tmp/tmon.log\n");
5762306a36Sopenharmony_ci	printf("  -t, --time-interval   sampling time interval, > 1 sec.\n");
5862306a36Sopenharmony_ci	printf("  -T, --target-temp     initial target temperature\n");
5962306a36Sopenharmony_ci	printf("  -v, --version         show version\n");
6062306a36Sopenharmony_ci	printf("  -z, --zone            target thermal zone id\n");
6162306a36Sopenharmony_ci
6262306a36Sopenharmony_ci	exit(0);
6362306a36Sopenharmony_ci}
6462306a36Sopenharmony_ci
6562306a36Sopenharmony_civoid version(void)
6662306a36Sopenharmony_ci{
6762306a36Sopenharmony_ci	printf("TMON version %s\n", VERSION);
6862306a36Sopenharmony_ci	exit(EXIT_SUCCESS);
6962306a36Sopenharmony_ci}
7062306a36Sopenharmony_ci
7162306a36Sopenharmony_cistatic void tmon_cleanup(void)
7262306a36Sopenharmony_ci{
7362306a36Sopenharmony_ci	syslog(LOG_INFO, "TMON exit cleanup\n");
7462306a36Sopenharmony_ci	fflush(stdout);
7562306a36Sopenharmony_ci	refresh();
7662306a36Sopenharmony_ci	if (tmon_log)
7762306a36Sopenharmony_ci		fclose(tmon_log);
7862306a36Sopenharmony_ci	if (event_tid) {
7962306a36Sopenharmony_ci		pthread_mutex_lock(&input_lock);
8062306a36Sopenharmony_ci		pthread_cancel(event_tid);
8162306a36Sopenharmony_ci		pthread_mutex_unlock(&input_lock);
8262306a36Sopenharmony_ci		pthread_mutex_destroy(&input_lock);
8362306a36Sopenharmony_ci	}
8462306a36Sopenharmony_ci	closelog();
8562306a36Sopenharmony_ci	/* relax control knobs, undo throttling */
8662306a36Sopenharmony_ci	set_ctrl_state(0);
8762306a36Sopenharmony_ci
8862306a36Sopenharmony_ci	keypad(stdscr, FALSE);
8962306a36Sopenharmony_ci	echo();
9062306a36Sopenharmony_ci	nocbreak();
9162306a36Sopenharmony_ci	close_windows();
9262306a36Sopenharmony_ci	endwin();
9362306a36Sopenharmony_ci	free_thermal_data();
9462306a36Sopenharmony_ci
9562306a36Sopenharmony_ci	exit(1);
9662306a36Sopenharmony_ci}
9762306a36Sopenharmony_ci
9862306a36Sopenharmony_cistatic void tmon_sig_handler(int sig)
9962306a36Sopenharmony_ci{
10062306a36Sopenharmony_ci	syslog(LOG_INFO, "TMON caught signal %d\n", sig);
10162306a36Sopenharmony_ci	refresh();
10262306a36Sopenharmony_ci	switch (sig) {
10362306a36Sopenharmony_ci	case SIGTERM:
10462306a36Sopenharmony_ci		printf("sigterm, exit and clean up\n");
10562306a36Sopenharmony_ci		fflush(stdout);
10662306a36Sopenharmony_ci		break;
10762306a36Sopenharmony_ci	case SIGKILL:
10862306a36Sopenharmony_ci		printf("sigkill, exit and clean up\n");
10962306a36Sopenharmony_ci		fflush(stdout);
11062306a36Sopenharmony_ci		break;
11162306a36Sopenharmony_ci	case SIGINT:
11262306a36Sopenharmony_ci		printf("ctrl-c, exit and clean up\n");
11362306a36Sopenharmony_ci		fflush(stdout);
11462306a36Sopenharmony_ci		break;
11562306a36Sopenharmony_ci	default:
11662306a36Sopenharmony_ci		break;
11762306a36Sopenharmony_ci	}
11862306a36Sopenharmony_ci	tmon_exit = true;
11962306a36Sopenharmony_ci}
12062306a36Sopenharmony_ci
12162306a36Sopenharmony_cistatic void start_syslog(void)
12262306a36Sopenharmony_ci{
12362306a36Sopenharmony_ci	if (debug_on)
12462306a36Sopenharmony_ci		setlogmask(LOG_UPTO(LOG_DEBUG));
12562306a36Sopenharmony_ci	else
12662306a36Sopenharmony_ci		setlogmask(LOG_UPTO(LOG_ERR));
12762306a36Sopenharmony_ci	openlog("tmon.log", LOG_CONS | LOG_PID | LOG_NDELAY, LOG_LOCAL0);
12862306a36Sopenharmony_ci	syslog(LOG_NOTICE, "TMON started by User %d", getuid());
12962306a36Sopenharmony_ci}
13062306a36Sopenharmony_ci
13162306a36Sopenharmony_cistatic void prepare_logging(void)
13262306a36Sopenharmony_ci{
13362306a36Sopenharmony_ci	int i;
13462306a36Sopenharmony_ci	struct stat logstat;
13562306a36Sopenharmony_ci
13662306a36Sopenharmony_ci	if (!logging)
13762306a36Sopenharmony_ci		return;
13862306a36Sopenharmony_ci	/* open local data log file */
13962306a36Sopenharmony_ci	tmon_log = fopen(TMON_LOG_FILE, "w+");
14062306a36Sopenharmony_ci	if (!tmon_log) {
14162306a36Sopenharmony_ci		syslog(LOG_ERR, "failed to open log file %s\n", TMON_LOG_FILE);
14262306a36Sopenharmony_ci		return;
14362306a36Sopenharmony_ci	}
14462306a36Sopenharmony_ci
14562306a36Sopenharmony_ci	if (lstat(TMON_LOG_FILE, &logstat) < 0) {
14662306a36Sopenharmony_ci		syslog(LOG_ERR, "Unable to stat log file %s\n", TMON_LOG_FILE);
14762306a36Sopenharmony_ci		fclose(tmon_log);
14862306a36Sopenharmony_ci		tmon_log = NULL;
14962306a36Sopenharmony_ci		return;
15062306a36Sopenharmony_ci	}
15162306a36Sopenharmony_ci
15262306a36Sopenharmony_ci	/* The log file must be a regular file owned by us */
15362306a36Sopenharmony_ci	if (S_ISLNK(logstat.st_mode)) {
15462306a36Sopenharmony_ci		syslog(LOG_ERR, "Log file is a symlink.  Will not log\n");
15562306a36Sopenharmony_ci		fclose(tmon_log);
15662306a36Sopenharmony_ci		tmon_log = NULL;
15762306a36Sopenharmony_ci		return;
15862306a36Sopenharmony_ci	}
15962306a36Sopenharmony_ci
16062306a36Sopenharmony_ci	if (logstat.st_uid != getuid()) {
16162306a36Sopenharmony_ci		syslog(LOG_ERR, "We don't own the log file.  Not logging\n");
16262306a36Sopenharmony_ci		fclose(tmon_log);
16362306a36Sopenharmony_ci		tmon_log = NULL;
16462306a36Sopenharmony_ci		return;
16562306a36Sopenharmony_ci	}
16662306a36Sopenharmony_ci
16762306a36Sopenharmony_ci	fprintf(tmon_log, "#----------- THERMAL SYSTEM CONFIG -------------\n");
16862306a36Sopenharmony_ci	for (i = 0; i < ptdata.nr_tz_sensor; i++) {
16962306a36Sopenharmony_ci		char binding_str[33]; /* size of long + 1 */
17062306a36Sopenharmony_ci		int j;
17162306a36Sopenharmony_ci
17262306a36Sopenharmony_ci		memset(binding_str, 0, sizeof(binding_str));
17362306a36Sopenharmony_ci		for (j = 0; j < 32; j++)
17462306a36Sopenharmony_ci			binding_str[j] = (ptdata.tzi[i].cdev_binding & (1 << j)) ?
17562306a36Sopenharmony_ci				'1' : '0';
17662306a36Sopenharmony_ci
17762306a36Sopenharmony_ci		fprintf(tmon_log, "#thermal zone %s%02d cdevs binding: %32s\n",
17862306a36Sopenharmony_ci			ptdata.tzi[i].type,
17962306a36Sopenharmony_ci			ptdata.tzi[i].instance,
18062306a36Sopenharmony_ci			binding_str);
18162306a36Sopenharmony_ci		for (j = 0; j <	ptdata.tzi[i].nr_trip_pts; j++) {
18262306a36Sopenharmony_ci			fprintf(tmon_log, "#\tTP%02d type:%s, temp:%lu\n", j,
18362306a36Sopenharmony_ci				trip_type_name[ptdata.tzi[i].tp[j].type],
18462306a36Sopenharmony_ci				ptdata.tzi[i].tp[j].temp);
18562306a36Sopenharmony_ci		}
18662306a36Sopenharmony_ci	}
18762306a36Sopenharmony_ci
18862306a36Sopenharmony_ci	for (i = 0; i <	ptdata.nr_cooling_dev; i++)
18962306a36Sopenharmony_ci		fprintf(tmon_log, "#cooling devices%02d: %s\n",
19062306a36Sopenharmony_ci			i, ptdata.cdi[i].type);
19162306a36Sopenharmony_ci
19262306a36Sopenharmony_ci	fprintf(tmon_log, "#---------- THERMAL DATA LOG STARTED -----------\n");
19362306a36Sopenharmony_ci	fprintf(tmon_log, "Samples TargetTemp ");
19462306a36Sopenharmony_ci	for (i = 0; i < ptdata.nr_tz_sensor; i++) {
19562306a36Sopenharmony_ci		fprintf(tmon_log, "%s%d    ", ptdata.tzi[i].type,
19662306a36Sopenharmony_ci			ptdata.tzi[i].instance);
19762306a36Sopenharmony_ci	}
19862306a36Sopenharmony_ci	for (i = 0; i <	ptdata.nr_cooling_dev; i++)
19962306a36Sopenharmony_ci		fprintf(tmon_log, "%s%d ", ptdata.cdi[i].type,
20062306a36Sopenharmony_ci			ptdata.cdi[i].instance);
20162306a36Sopenharmony_ci
20262306a36Sopenharmony_ci	fprintf(tmon_log, "\n");
20362306a36Sopenharmony_ci}
20462306a36Sopenharmony_ci
20562306a36Sopenharmony_cistatic struct option opts[] = {
20662306a36Sopenharmony_ci	{ "control", 1, NULL, 'c' },
20762306a36Sopenharmony_ci	{ "daemon", 0, NULL, 'd' },
20862306a36Sopenharmony_ci	{ "time-interval", 1, NULL, 't' },
20962306a36Sopenharmony_ci	{ "target-temp", 1, NULL, 'T' },
21062306a36Sopenharmony_ci	{ "log", 0, NULL, 'l' },
21162306a36Sopenharmony_ci	{ "help", 0, NULL, 'h' },
21262306a36Sopenharmony_ci	{ "version", 0, NULL, 'v' },
21362306a36Sopenharmony_ci	{ "debug", 0, NULL, 'g' },
21462306a36Sopenharmony_ci	{ 0, 0, NULL, 0 }
21562306a36Sopenharmony_ci};
21662306a36Sopenharmony_ci
21762306a36Sopenharmony_ciint main(int argc, char **argv)
21862306a36Sopenharmony_ci{
21962306a36Sopenharmony_ci	int err = 0;
22062306a36Sopenharmony_ci	int id2 = 0, c;
22162306a36Sopenharmony_ci	double yk = 0.0, temp; /* controller output */
22262306a36Sopenharmony_ci	int target_tz_index;
22362306a36Sopenharmony_ci
22462306a36Sopenharmony_ci	if (geteuid() != 0) {
22562306a36Sopenharmony_ci		printf("TMON needs to be run as root\n");
22662306a36Sopenharmony_ci		exit(EXIT_FAILURE);
22762306a36Sopenharmony_ci	}
22862306a36Sopenharmony_ci
22962306a36Sopenharmony_ci	while ((c = getopt_long(argc, argv, "c:dlht:T:vgz:", opts, &id2)) != -1) {
23062306a36Sopenharmony_ci		switch (c) {
23162306a36Sopenharmony_ci		case 'c':
23262306a36Sopenharmony_ci			no_control = 0;
23362306a36Sopenharmony_ci			strncpy(ctrl_cdev, optarg, CDEV_NAME_SIZE);
23462306a36Sopenharmony_ci			break;
23562306a36Sopenharmony_ci		case 'd':
23662306a36Sopenharmony_ci			start_daemon_mode();
23762306a36Sopenharmony_ci			printf("Run TMON in daemon mode\n");
23862306a36Sopenharmony_ci			break;
23962306a36Sopenharmony_ci		case 't':
24062306a36Sopenharmony_ci			ticktime = strtod(optarg, NULL);
24162306a36Sopenharmony_ci			if (ticktime < 1)
24262306a36Sopenharmony_ci				ticktime = 1;
24362306a36Sopenharmony_ci			break;
24462306a36Sopenharmony_ci		case 'T':
24562306a36Sopenharmony_ci			temp = strtod(optarg, NULL);
24662306a36Sopenharmony_ci			if (temp < 0) {
24762306a36Sopenharmony_ci				fprintf(stderr, "error: temperature must be positive\n");
24862306a36Sopenharmony_ci				return 1;
24962306a36Sopenharmony_ci			}
25062306a36Sopenharmony_ci			target_temp_user = temp;
25162306a36Sopenharmony_ci			break;
25262306a36Sopenharmony_ci		case 'l':
25362306a36Sopenharmony_ci			printf("Logging data to /var/tmp/tmon.log\n");
25462306a36Sopenharmony_ci			logging = 1;
25562306a36Sopenharmony_ci			break;
25662306a36Sopenharmony_ci		case 'h':
25762306a36Sopenharmony_ci			usage();
25862306a36Sopenharmony_ci			break;
25962306a36Sopenharmony_ci		case 'v':
26062306a36Sopenharmony_ci			version();
26162306a36Sopenharmony_ci			break;
26262306a36Sopenharmony_ci		case 'g':
26362306a36Sopenharmony_ci			debug_on = 1;
26462306a36Sopenharmony_ci			break;
26562306a36Sopenharmony_ci		case 'z':
26662306a36Sopenharmony_ci			target_thermal_zone = strtod(optarg, NULL);
26762306a36Sopenharmony_ci			break;
26862306a36Sopenharmony_ci		default:
26962306a36Sopenharmony_ci			break;
27062306a36Sopenharmony_ci		}
27162306a36Sopenharmony_ci	}
27262306a36Sopenharmony_ci	if (pthread_mutex_init(&input_lock, NULL) != 0) {
27362306a36Sopenharmony_ci		fprintf(stderr, "\n mutex init failed, exit\n");
27462306a36Sopenharmony_ci		return 1;
27562306a36Sopenharmony_ci	}
27662306a36Sopenharmony_ci	start_syslog();
27762306a36Sopenharmony_ci	if (signal(SIGINT, tmon_sig_handler) == SIG_ERR)
27862306a36Sopenharmony_ci		syslog(LOG_DEBUG, "Cannot handle SIGINT\n");
27962306a36Sopenharmony_ci	if (signal(SIGTERM, tmon_sig_handler) == SIG_ERR)
28062306a36Sopenharmony_ci		syslog(LOG_DEBUG, "Cannot handle SIGTERM\n");
28162306a36Sopenharmony_ci
28262306a36Sopenharmony_ci	if (probe_thermal_sysfs()) {
28362306a36Sopenharmony_ci		pthread_mutex_destroy(&input_lock);
28462306a36Sopenharmony_ci		closelog();
28562306a36Sopenharmony_ci		return -1;
28662306a36Sopenharmony_ci	}
28762306a36Sopenharmony_ci	initialize_curses();
28862306a36Sopenharmony_ci	setup_windows();
28962306a36Sopenharmony_ci	signal(SIGWINCH, resize_handler);
29062306a36Sopenharmony_ci	show_title_bar();
29162306a36Sopenharmony_ci	show_sensors_w();
29262306a36Sopenharmony_ci	show_cooling_device();
29362306a36Sopenharmony_ci	update_thermal_data();
29462306a36Sopenharmony_ci	show_data_w();
29562306a36Sopenharmony_ci	prepare_logging();
29662306a36Sopenharmony_ci	init_thermal_controller();
29762306a36Sopenharmony_ci
29862306a36Sopenharmony_ci	nodelay(stdscr, TRUE);
29962306a36Sopenharmony_ci	err = pthread_create(&event_tid, NULL, &handle_tui_events, NULL);
30062306a36Sopenharmony_ci	if (err != 0) {
30162306a36Sopenharmony_ci		printf("\ncan't create thread :[%s]", strerror(err));
30262306a36Sopenharmony_ci		tmon_cleanup();
30362306a36Sopenharmony_ci		exit(EXIT_FAILURE);
30462306a36Sopenharmony_ci	}
30562306a36Sopenharmony_ci
30662306a36Sopenharmony_ci	/* validate range of user selected target zone, default to the first
30762306a36Sopenharmony_ci	 * instance if out of range
30862306a36Sopenharmony_ci	 */
30962306a36Sopenharmony_ci	target_tz_index = zone_instance_to_index(target_thermal_zone);
31062306a36Sopenharmony_ci	if (target_tz_index < 0) {
31162306a36Sopenharmony_ci		target_thermal_zone = ptdata.tzi[0].instance;
31262306a36Sopenharmony_ci		syslog(LOG_ERR, "target zone is not found, default to %d\n",
31362306a36Sopenharmony_ci			target_thermal_zone);
31462306a36Sopenharmony_ci	}
31562306a36Sopenharmony_ci	while (1) {
31662306a36Sopenharmony_ci		sleep(ticktime);
31762306a36Sopenharmony_ci		show_title_bar();
31862306a36Sopenharmony_ci		show_sensors_w();
31962306a36Sopenharmony_ci		update_thermal_data();
32062306a36Sopenharmony_ci		if (!dialogue_on) {
32162306a36Sopenharmony_ci			show_data_w();
32262306a36Sopenharmony_ci			show_cooling_device();
32362306a36Sopenharmony_ci		}
32462306a36Sopenharmony_ci		time_elapsed += ticktime;
32562306a36Sopenharmony_ci		controller_handler(trec[0].temp[target_tz_index] / 1000, &yk);
32662306a36Sopenharmony_ci		trec[0].pid_out_pct = yk;
32762306a36Sopenharmony_ci		if (!dialogue_on)
32862306a36Sopenharmony_ci			show_control_w();
32962306a36Sopenharmony_ci		if (tmon_exit)
33062306a36Sopenharmony_ci			break;
33162306a36Sopenharmony_ci	}
33262306a36Sopenharmony_ci	tmon_cleanup();
33362306a36Sopenharmony_ci	return 0;
33462306a36Sopenharmony_ci}
33562306a36Sopenharmony_ci
33662306a36Sopenharmony_cistatic void start_daemon_mode(void)
33762306a36Sopenharmony_ci{
33862306a36Sopenharmony_ci	daemon_mode = 1;
33962306a36Sopenharmony_ci	/* fork */
34062306a36Sopenharmony_ci	pid_t	sid, pid = fork();
34162306a36Sopenharmony_ci
34262306a36Sopenharmony_ci	if (pid < 0)
34362306a36Sopenharmony_ci		exit(EXIT_FAILURE);
34462306a36Sopenharmony_ci	else if (pid > 0)
34562306a36Sopenharmony_ci		/* kill parent */
34662306a36Sopenharmony_ci		exit(EXIT_SUCCESS);
34762306a36Sopenharmony_ci
34862306a36Sopenharmony_ci	/* disable TUI, it may not be necessary, but saves some resource */
34962306a36Sopenharmony_ci	disable_tui();
35062306a36Sopenharmony_ci
35162306a36Sopenharmony_ci	/* change the file mode mask */
35262306a36Sopenharmony_ci	umask(S_IWGRP | S_IWOTH);
35362306a36Sopenharmony_ci
35462306a36Sopenharmony_ci	/* new SID for the daemon process */
35562306a36Sopenharmony_ci	sid = setsid();
35662306a36Sopenharmony_ci	if (sid < 0)
35762306a36Sopenharmony_ci		exit(EXIT_FAILURE);
35862306a36Sopenharmony_ci
35962306a36Sopenharmony_ci	/* change working directory */
36062306a36Sopenharmony_ci	if ((chdir("/")) < 0)
36162306a36Sopenharmony_ci		exit(EXIT_FAILURE);
36262306a36Sopenharmony_ci
36362306a36Sopenharmony_ci	sleep(10);
36462306a36Sopenharmony_ci
36562306a36Sopenharmony_ci	close(STDIN_FILENO);
36662306a36Sopenharmony_ci	close(STDOUT_FILENO);
36762306a36Sopenharmony_ci	close(STDERR_FILENO);
36862306a36Sopenharmony_ci}
369