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