lenovo_fix.py 29 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791
  1. #!/usr/bin/env python3
  2. from __future__ import print_function
  3. import argparse
  4. import glob
  5. import gzip
  6. import os
  7. import re
  8. import struct
  9. import subprocess
  10. import sys
  11. from collections import defaultdict
  12. from errno import EACCES, EPERM
  13. from multiprocessing import cpu_count
  14. from platform import uname
  15. from threading import Event, Thread
  16. from time import time
  17. import configparser
  18. import dbus
  19. from dbus.mainloop.glib import DBusGMainLoop
  20. from gi.repository import GLib
  21. from mmio import MMIO, MMIOError
  22. DEFAULT_SYSFS_POWER_PATH = '/sys/class/power_supply/AC*/online'
  23. VOLTAGE_PLANES = {'CORE': 0, 'GPU': 1, 'CACHE': 2, 'UNCORE': 3, 'ANALOGIO': 4}
  24. CURRENT_PLANES = {'CORE': 0, 'GPU': 1, 'CACHE': 2}
  25. TRIP_TEMP_RANGE = [40, 97]
  26. UNDERVOLT_KEYS = ('UNDERVOLT', 'UNDERVOLT.AC', 'UNDERVOLT.BATTERY')
  27. ICCMAX_KEYS = ('ICCMAX', 'ICCMAX.AC', 'ICCMAX.BATTERY')
  28. power = {'source': None, 'method': 'polling'}
  29. HWP_VALUE = 0x20
  30. HWP_INTERVAL = 60
  31. platform_info_bits = {
  32. 'maximum_non_turbo_ratio': [8, 15],
  33. 'maximum_efficiency_ratio': [40, 47],
  34. 'minimum_operating_ratio': [48, 55],
  35. 'feature_ppin_cap': [23, 23],
  36. 'feature_programmable_turbo_ratio': [28, 28],
  37. 'feature_programmable_tdp_limit': [29, 29],
  38. 'number_of_additional_tdp_profiles': [33, 34],
  39. 'feature_programmable_temperature_target': [30, 30],
  40. 'feature_low_power_mode': [32, 32],
  41. }
  42. thermal_status_bits = {
  43. 'thermal_limit_status': [0, 0],
  44. 'thermal_limit_log': [1, 1],
  45. 'prochot_or_forcepr_status': [2, 2],
  46. 'prochot_or_forcepr_log': [3, 3],
  47. 'crit_temp_status': [4, 4],
  48. 'crit_temp_log': [5, 5],
  49. 'thermal_threshold1_status': [6, 6],
  50. 'thermal_threshold1_log': [7, 7],
  51. 'thermal_threshold2_status': [8, 8],
  52. 'thermal_threshold2_log': [9, 9],
  53. 'power_limit_status': [10, 10],
  54. 'power_limit_log': [11, 11],
  55. 'current_limit_status': [12, 12],
  56. 'current_limit_log': [13, 13],
  57. 'cross_domain_limit_status': [14, 14],
  58. 'cross_domain_limit_log': [15, 15],
  59. 'cpu_temp': [16, 22],
  60. 'temp_resolution': [27, 30],
  61. 'reading_valid': [31, 31],
  62. }
  63. supported_cpus = {
  64. 'Haswell': (0x3C, 0x3F, 0x45, 0x46),
  65. 'Broadwell': (0x3D, 0x47, 0x4F, 0x56),
  66. 'Skylake': (0x4E, 0x55),
  67. 'Skylake-S': (0x5E,),
  68. 'Ice Lake': (0x7E,),
  69. 'Kaby Lake (R)': (0x8E, 0x9E),
  70. 'Coffee Lake': (0x9E,),
  71. 'Cannon Lake': (0x66,),
  72. }
  73. class bcolors:
  74. YELLOW = '\033[93m'
  75. GREEN = '\033[92m'
  76. RED = '\033[91m'
  77. RESET = '\033[0m'
  78. BOLD = '\033[1m'
  79. OK = bcolors.GREEN + bcolors.BOLD + 'OK' + bcolors.RESET
  80. ERR = bcolors.RED + bcolors.BOLD + 'ERR' + bcolors.RESET
  81. LIM = bcolors.YELLOW + bcolors.BOLD + 'LIM' + bcolors.RESET
  82. def fatal(msg, code=1):
  83. print('[E] {:s}'.format(msg), file=sys.stderr)
  84. sys.exit(code)
  85. def warning(msg):
  86. print('[W] {:s}'.format(msg), file=sys.stderr)
  87. def writemsr(msr, val):
  88. msr_list = ['/dev/cpu/{:d}/msr'.format(x) for x in range(cpu_count())]
  89. if not os.path.exists(msr_list[0]):
  90. try:
  91. subprocess.check_call(('modprobe', 'msr'))
  92. except subprocess.CalledProcessError:
  93. fatal('Unable to load the msr module.')
  94. try:
  95. for addr in msr_list:
  96. f = os.open(addr, os.O_WRONLY)
  97. os.lseek(f, msr, os.SEEK_SET)
  98. os.write(f, struct.pack('Q', val))
  99. os.close(f)
  100. except (IOError, OSError) as e:
  101. if e.errno == EPERM or e.errno == EACCES:
  102. fatal(
  103. 'Unable to write to MSR. Try to disable Secure Boot '
  104. 'and check if your kernel does not restrict access to MSR.'
  105. )
  106. else:
  107. raise e
  108. # returns the value between from_bit and to_bit as unsigned long
  109. def readmsr(msr, from_bit=0, to_bit=63, cpu=None, flatten=False):
  110. assert cpu is None or cpu in range(cpu_count())
  111. if from_bit > to_bit:
  112. fatal('Wrong readmsr bit params')
  113. msr_list = ['/dev/cpu/{:d}/msr'.format(x) for x in range(cpu_count())]
  114. if not os.path.exists(msr_list[0]):
  115. try:
  116. subprocess.check_call(('modprobe', 'msr'))
  117. except subprocess.CalledProcessError:
  118. fatal('Unable to load the msr module.')
  119. try:
  120. output = []
  121. for addr in msr_list:
  122. f = os.open(addr, os.O_RDONLY)
  123. os.lseek(f, msr, os.SEEK_SET)
  124. val = struct.unpack('Q', os.read(f, 8))[0]
  125. os.close(f)
  126. output.append(get_value_for_bits(val, from_bit, to_bit))
  127. if flatten:
  128. return output[0] if len(set(output)) == 1 else output
  129. return output[cpu] if cpu is not None else output
  130. except (IOError, OSError) as e:
  131. if e.errno == EPERM or e.errno == EACCES:
  132. fatal('Unable to read from MSR. Try to disable Secure Boot.')
  133. else:
  134. raise e
  135. def get_value_for_bits(val, from_bit=0, to_bit=63):
  136. mask = sum(2 ** x for x in range(from_bit, to_bit + 1))
  137. return (val & mask) >> from_bit
  138. def is_on_battery(config):
  139. try:
  140. for path in glob.glob(config.get('GENERAL', 'Sysfs_Power_Path', fallback=DEFAULT_SYSFS_POWER_PATH)):
  141. with open(path) as f:
  142. return not bool(int(f.read()))
  143. raise
  144. except:
  145. warning('No valid Sysfs_Power_Path found! Trying upower method #1')
  146. try:
  147. out = subprocess.check_output(('upower', '-i', '/org/freedesktop/UPower/devices/line_power_AC'))
  148. res = re.search(rb'online:\s+(yes|no)', out).group(1).decode().strip()
  149. if res == 'yes':
  150. return False
  151. elif res == 'no':
  152. return True
  153. raise
  154. except:
  155. warning('Trying upower method #2')
  156. try:
  157. out = subprocess.check_output(('upower', '-i', '/org/freedesktop/UPower/devices/battery_BAT0'))
  158. res = re.search(rb'state:\s+(.+)', out).group(1).decode().strip()
  159. if res == 'discharging':
  160. return True
  161. elif res in ('fully-charged', 'charging'):
  162. return False
  163. except:
  164. pass
  165. warning('No valid power detection methods found. Assuming that the system is running on battery power.')
  166. return True
  167. def get_cpu_platform_info():
  168. features_msr_value = readmsr(0xCE, cpu=0)
  169. cpu_platform_info = {}
  170. for key, value in platform_info_bits.items():
  171. cpu_platform_info[key] = int(get_value_for_bits(features_msr_value, value[0], value[1]))
  172. return cpu_platform_info
  173. def get_reset_thermal_status():
  174. # read thermal status
  175. thermal_status_msr_value = readmsr(0x19C)
  176. thermal_status = []
  177. for core in range(cpu_count()):
  178. thermal_status_core = {}
  179. for key, value in thermal_status_bits.items():
  180. thermal_status_core[key] = int(get_value_for_bits(thermal_status_msr_value[core], value[0], value[1]))
  181. thermal_status.append(thermal_status_core)
  182. # reset log bits
  183. writemsr(0x19C, 0)
  184. return thermal_status
  185. def get_time_unit():
  186. # 0.000977 is the time unit of my CPU
  187. # TODO formula might be different for other CPUs
  188. return 1.0 / 2 ** readmsr(0x606, 16, 19, cpu=0)
  189. def get_power_unit():
  190. # 0.125 is the power unit of my CPU
  191. # TODO formula might be different for other CPUs
  192. return 1.0 / 2 ** readmsr(0x606, 0, 3, cpu=0)
  193. def get_critical_temp():
  194. # the critical temperature for my CPU is 100 'C
  195. return readmsr(0x1A2, 16, 23, cpu=0)
  196. def get_cur_pkg_power_limits():
  197. value = readmsr(0x610, 0, 55, flatten=True)
  198. return {
  199. 'PL1': get_value_for_bits(value, 0, 14),
  200. 'TW1': get_value_for_bits(value, 17, 23),
  201. 'PL2': get_value_for_bits(value, 32, 46),
  202. 'TW2': get_value_for_bits(value, 49, 55),
  203. }
  204. def calc_time_window_vars(t):
  205. time_unit = get_time_unit()
  206. for Y in range(2 ** 5):
  207. for Z in range(2 ** 2):
  208. if t <= (2 ** Y) * (1.0 + Z / 4.0) * time_unit:
  209. return (Y, Z)
  210. raise ValueError('Unable to find a good combination!')
  211. def calc_undervolt_msr(plane, offset):
  212. """Return the value to be written in the MSR 150h for setting the given
  213. offset voltage (in mV) to the given voltage plane.
  214. """
  215. assert offset <= 0
  216. assert plane in VOLTAGE_PLANES
  217. offset = int(round(offset * 1.024))
  218. offset = 0xFFE00000 & ((offset & 0xFFF) << 21)
  219. return 0x8000001100000000 | (VOLTAGE_PLANES[plane] << 40) | offset
  220. def calc_undervolt_mv(msr_value):
  221. """Return the offset voltage (in mV) from the given raw MSR 150h value.
  222. """
  223. offset = (msr_value & 0xFFE00000) >> 21
  224. offset = offset if offset <= 0x400 else -(0x800 - offset)
  225. return int(round(offset / 1.024))
  226. def get_undervolt(plane=None, convert=False):
  227. planes = [plane] if plane in VOLTAGE_PLANES else VOLTAGE_PLANES
  228. out = {}
  229. for plane in planes:
  230. writemsr(0x150, 0x8000001000000000 | (VOLTAGE_PLANES[plane] << 40))
  231. read_value = readmsr(0x150, flatten=True) & 0xFFFFFFFF
  232. out[plane] = calc_undervolt_mv(read_value) if convert else read_value
  233. return out
  234. def undervolt(config):
  235. for plane in VOLTAGE_PLANES:
  236. write_offset_mv = config.getfloat(
  237. 'UNDERVOLT.{:s}'.format(power['source']), plane, fallback=config.getfloat('UNDERVOLT', plane, fallback=0.0)
  238. )
  239. write_value = calc_undervolt_msr(plane, write_offset_mv)
  240. writemsr(0x150, write_value)
  241. if args.debug:
  242. write_value &= 0xFFFFFFFF
  243. read_value = get_undervolt(plane)[plane]
  244. read_offset_mv = calc_undervolt_mv(read_value)
  245. match = OK if write_value == read_value else ERR
  246. print(
  247. '[D] Undervolt plane {:s} - write {:.0f} mV ({:#x}) - read {:.0f} mV ({:#x}) - match {}'.format(
  248. plane, write_offset_mv, write_value, read_offset_mv, read_value, match
  249. )
  250. )
  251. def calc_icc_max_msr(plane, current):
  252. """Return the value to be written in the MSR 150h for setting the given
  253. IccMax (in A) to the given current plane.
  254. """
  255. assert 0 < current <= 0x3FF
  256. assert plane in CURRENT_PLANES
  257. current = int(round(current * 4))
  258. return 0x8000001700000000 | (CURRENT_PLANES[plane] << 40) | current
  259. def calc_icc_max_amp(msr_value):
  260. """Return the max current (in A) from the given raw MSR 150h value.
  261. """
  262. return (msr_value & 0x3FF) / 4.0
  263. def get_icc_max(plane=None, convert=False):
  264. planes = [plane] if plane in CURRENT_PLANES else CURRENT_PLANES
  265. out = {}
  266. for plane in planes:
  267. writemsr(0x150, 0x8000001600000000 | (CURRENT_PLANES[plane] << 40))
  268. read_value = readmsr(0x150, flatten=True) & 0x3FF
  269. out[plane] = calc_icc_max_amp(read_value) if convert else read_value
  270. return out
  271. def set_icc_max(config):
  272. for plane in CURRENT_PLANES:
  273. try:
  274. write_current_amp = config.getfloat(
  275. 'ICCMAX.{:s}'.format(power['source']), plane, fallback=config.getfloat('ICCMAX', plane, fallback=-1.0)
  276. )
  277. if write_current_amp > 0:
  278. write_value = calc_icc_max_msr(plane, write_current_amp)
  279. writemsr(0x150, write_value)
  280. if args.debug:
  281. write_value &= 0x3FF
  282. read_value = get_icc_max(plane)[plane]
  283. read_current_A = calc_icc_max_amp(read_value)
  284. match = OK if write_value == read_value else ERR
  285. print(
  286. '[D] IccMax plane {:s} - write {:.2f} A ({:#x}) - read {:.2f} A ({:#x}) - match {}'.format(
  287. plane, write_current_amp, write_value, read_current_A, read_value, match
  288. )
  289. )
  290. except (configparser.NoSectionError, configparser.NoOptionError):
  291. pass
  292. def load_config():
  293. config = configparser.ConfigParser()
  294. config.read(args.config)
  295. # config values sanity check
  296. for power_source in ('AC', 'BATTERY'):
  297. for option in ('Update_Rate_s', 'PL1_Tdp_W', 'PL1_Duration_s', 'PL2_Tdp_W', 'PL2_Duration_S'):
  298. value = config.getfloat(power_source, option, fallback=None)
  299. if value is not None:
  300. value = config.set(power_source, option, str(max(0.1, value)))
  301. elif option == 'Update_Rate_s':
  302. fatal('The mandatory "Update_Rate_s" parameter is missing.')
  303. trip_temp = config.getfloat(power_source, 'Trip_Temp_C', fallback=None)
  304. if trip_temp is not None:
  305. valid_trip_temp = min(TRIP_TEMP_RANGE[1], max(TRIP_TEMP_RANGE[0], trip_temp))
  306. if trip_temp != valid_trip_temp:
  307. config.set(power_source, 'Trip_Temp_C', str(valid_trip_temp))
  308. print(
  309. '[!] Overriding invalid "Trip_Temp_C" value in "{:s}": {:.1f} -> {:.1f}'.format(
  310. power_source, trip_temp, valid_trip_temp
  311. )
  312. )
  313. # fix any invalid value (ie. > 0) in the undervolt settings
  314. for key in UNDERVOLT_KEYS:
  315. for plane in VOLTAGE_PLANES:
  316. if key in config:
  317. value = config.getfloat(key, plane)
  318. valid_value = min(0, value)
  319. if value != valid_value:
  320. config.set(key, plane, str(valid_value))
  321. print(
  322. '[!] Overriding invalid "{:s}" value in "{:s}" voltage plane: {:.0f} -> {:.0f}'.format(
  323. key, plane, value, valid_value
  324. )
  325. )
  326. # handle the case where only one of UNDERVOLT.AC, UNDERVOLT.BATTERY keys exists
  327. # by forcing the other key to all zeros (ie. no undervolt)
  328. if any(key in config for key in UNDERVOLT_KEYS[1:]):
  329. for key in UNDERVOLT_KEYS[1:]:
  330. if key not in config:
  331. config.add_section(key)
  332. for plane in VOLTAGE_PLANES:
  333. value = config.getfloat(key, plane, fallback=0.0)
  334. config.set(key, plane, str(value))
  335. iccmax_enabled = False
  336. # check for invalid values (ie. <= 0 or > 0x3FF) in the IccMax settings
  337. for key in ICCMAX_KEYS:
  338. for plane in CURRENT_PLANES:
  339. if key in config:
  340. try:
  341. value = config.getfloat(key, plane)
  342. if value <= 0 or value >= 0x3FF:
  343. raise ValueError
  344. iccmax_enabled = True
  345. except ValueError:
  346. warning('Invalid value for {:s} in {:s}'.format(plane, key))
  347. config.remove_option(key, plane)
  348. except configparser.NoOptionError:
  349. pass
  350. if iccmax_enabled:
  351. warning('Warning! Raising IccMax above design limits can damage your system!')
  352. return config
  353. def calc_reg_values(platform_info, config):
  354. regs = defaultdict(dict)
  355. for power_source in ('AC', 'BATTERY'):
  356. if platform_info['feature_programmable_temperature_target'] != 1:
  357. warning("Setting temperature target is not supported by this CPU")
  358. else:
  359. # the critical temperature for my CPU is 100 'C
  360. critical_temp = get_critical_temp()
  361. # update the allowed temp range to keep at least 3 'C from the CPU critical temperature
  362. global TRIP_TEMP_RANGE
  363. TRIP_TEMP_RANGE[1] = min(TRIP_TEMP_RANGE[1], critical_temp - 3)
  364. Trip_Temp_C = config.getfloat(power_source, 'Trip_Temp_C', fallback=None)
  365. if Trip_Temp_C is not None:
  366. trip_offset = int(round(critical_temp - Trip_Temp_C))
  367. regs[power_source]['MSR_TEMPERATURE_TARGET'] = trip_offset << 24
  368. else:
  369. print('[I] {:s} trip temperature is disabled in config.'.format(power_source))
  370. power_unit = get_power_unit()
  371. PL1_Tdp_W = config.getfloat(power_source, 'PL1_Tdp_W', fallback=None)
  372. PL1_Duration_s = config.getfloat(power_source, 'PL1_Duration_s', fallback=None)
  373. PL2_Tdp_W = config.getfloat(power_source, 'PL2_Tdp_W', fallback=None)
  374. PL2_Duration_s = config.getfloat(power_source, 'PL2_Duration_s', fallback=None)
  375. if (PL1_Tdp_W, PL1_Duration_s, PL2_Tdp_W, PL2_Duration_s).count(None) < 4:
  376. cur_pkg_power_limits = get_cur_pkg_power_limits()
  377. if PL1_Tdp_W is None:
  378. PL1 = cur_pkg_power_limits['PL1']
  379. print('[I] {:s} PL1_Tdp_W disabled in config.'.format(power_source))
  380. else:
  381. PL1 = int(round(PL1_Tdp_W / power_unit))
  382. if PL1_Duration_s is None:
  383. TW1 = cur_pkg_power_limits['TW1']
  384. print('[I] {:s} PL1_Duration_s disabled in config.'.format(power_source))
  385. else:
  386. Y, Z = calc_time_window_vars(PL1_Duration_s)
  387. TW1 = Y | (Z << 5)
  388. if PL2_Tdp_W is None:
  389. PL2 = cur_pkg_power_limits['PL2']
  390. print('[I] {:s} PL2_Tdp_W disabled in config.'.format(power_source))
  391. else:
  392. PL2 = int(round(PL2_Tdp_W / power_unit))
  393. if PL2_Duration_s is None:
  394. TW2 = cur_pkg_power_limits['TW2']
  395. print('[I] {:s} PL2_Duration_s disabled in config.'.format(power_source))
  396. else:
  397. Y, Z = calc_time_window_vars(PL2_Duration_s)
  398. TW2 = Y | (Z << 5)
  399. regs[power_source]['MSR_PKG_POWER_LIMIT'] = (
  400. PL1 | (1 << 15) | (TW1 << 17) | (PL2 << 32) | (1 << 47) | (TW2 << 49)
  401. )
  402. else:
  403. print('[I] {:s} package power limits are disabled in config.'.format(power_source))
  404. # cTDP
  405. c_tdp_target_value = config.getint(power_source, 'cTDP', fallback=None)
  406. if c_tdp_target_value is not None:
  407. if platform_info['feature_programmable_tdp_limit'] != 1:
  408. print("[W] cTDP setting not supported by this CPU")
  409. elif platform_info['number_of_additional_tdp_profiles'] < c_tdp_target_value:
  410. print("[W] the configured cTDP profile is not supported by this CPU")
  411. else:
  412. valid_c_tdp_target_value = max(0, c_tdp_target_value)
  413. regs[power_source]['MSR_CONFIG_TDP_CONTROL'] = valid_c_tdp_target_value
  414. return regs
  415. def set_hwp():
  416. # set HWP energy performance preference
  417. cur_val = readmsr(0x774, cpu=0)
  418. new_val = (cur_val & 0xFFFFFFFF00FFFFFF) | (HWP_VALUE << 24)
  419. writemsr(0x774, new_val)
  420. if args.debug:
  421. read_value = readmsr(0x774, from_bit=24, to_bit=31)[0]
  422. match = OK if HWP_VALUE == read_value else ERR
  423. print('[D] HWP - write "{:#02x}" - read "{:#02x}" - match {}'.format(HWP_VALUE, read_value, match))
  424. def power_thread(config, regs, exit_event):
  425. try:
  426. mchbar_mmio = MMIO(0xFED159A0, 8)
  427. except MMIOError:
  428. fatal('Unable to open /dev/mem. Try to disable Secure Boot.')
  429. next_hwp_write = 0
  430. while not exit_event.is_set():
  431. # print thermal status
  432. if args.debug:
  433. thermal_status = get_reset_thermal_status()
  434. for index, core_thermal_status in enumerate(thermal_status):
  435. for key, value in core_thermal_status.items():
  436. print('[D] core {} thermal status: {} = {}'.format(index, key.replace("_", " "), value))
  437. # switch back to sysfs polling
  438. if power['method'] == 'polling':
  439. power['source'] = 'BATTERY' if is_on_battery(config) else 'AC'
  440. # set temperature trip point
  441. if 'MSR_TEMPERATURE_TARGET' in regs[power['source']]:
  442. write_value = regs[power['source']]['MSR_TEMPERATURE_TARGET']
  443. writemsr(0x1A2, write_value)
  444. if args.debug:
  445. read_value = readmsr(0x1A2, 24, 29, flatten=True)
  446. match = OK if write_value >> 24 == read_value else ERR
  447. print(
  448. '[D] TEMPERATURE_TARGET - write {:#x} - read {:#x} - match {}'.format(
  449. write_value >> 24, read_value, match
  450. )
  451. )
  452. # set cTDP
  453. if 'MSR_CONFIG_TDP_CONTROL' in regs[power['source']]:
  454. write_value = regs[power['source']]['MSR_CONFIG_TDP_CONTROL']
  455. writemsr(0x64B, write_value)
  456. if args.debug:
  457. read_value = readmsr(0x64B, 0, 1, flatten=True)
  458. match = OK if write_value == read_value else ERR
  459. print(
  460. '[D] CONFIG_TDP_CONTROL - write {:#x} - read {:#x} - match {}'.format(
  461. write_value, read_value, match
  462. )
  463. )
  464. # set PL1/2 on MSR
  465. write_value = regs[power['source']]['MSR_PKG_POWER_LIMIT']
  466. writemsr(0x610, write_value)
  467. if args.debug:
  468. read_value = readmsr(0x610, 0, 55, flatten=True)
  469. match = OK if write_value == read_value else ERR
  470. print(
  471. '[D] MSR PACKAGE_POWER_LIMIT - write {:#x} - read {:#x} - match {}'.format(
  472. write_value, read_value, match
  473. )
  474. )
  475. # set MCHBAR register to the same PL1/2 values
  476. mchbar_mmio.write32(0, write_value & 0xFFFFFFFF)
  477. mchbar_mmio.write32(4, write_value >> 32)
  478. if args.debug:
  479. read_value = mchbar_mmio.read32(0) | (mchbar_mmio.read32(4) << 32)
  480. match = OK if write_value == read_value else ERR
  481. print(
  482. '[D] MCHBAR PACKAGE_POWER_LIMIT - write {:#x} - read {:#x} - match {}'.format(
  483. write_value, read_value, match
  484. )
  485. )
  486. wait_t = config.getfloat(power['source'], 'Update_Rate_s')
  487. enable_hwp_mode = config.getboolean('AC', 'HWP_Mode', fallback=False)
  488. # set HWP less frequently. Just to be safe since (e.g.) TLP might reset this value
  489. if (
  490. enable_hwp_mode
  491. and next_hwp_write <= time()
  492. and (
  493. (power['method'] == 'dbus' and power['source'] == 'AC')
  494. or (power['method'] == 'polling' and not is_on_battery(config))
  495. )
  496. ):
  497. set_hwp()
  498. next_hwp_write = time() + HWP_INTERVAL
  499. else:
  500. exit_event.wait(wait_t)
  501. def check_kernel():
  502. if os.geteuid() != 0:
  503. fatal('No root no party. Try again with sudo.')
  504. kernel_config = None
  505. try:
  506. with open(os.path.join('/boot', 'config-{:s}'.format(uname()[2]))) as f:
  507. kernel_config = f.read()
  508. except IOError:
  509. config_gz_path = os.path.join('/proc', 'config.gz')
  510. try:
  511. if not os.path.isfile(config_gz_path):
  512. subprocess.check_call(('modprobe', 'configs'))
  513. with gzip.open(config_gz_path) as f:
  514. kernel_config = f.read().decode()
  515. except (subprocess.CalledProcessError, IOError):
  516. pass
  517. if kernel_config is None:
  518. print('[W] Unable to obtain and validate kernel config.')
  519. elif not re.search('CONFIG_DEVMEM=y', kernel_config):
  520. fatal('Bad kernel config: you need CONFIG_DEVMEM=y.')
  521. elif not re.search('CONFIG_X86_MSR=(y|m)', kernel_config):
  522. fatal('Bad kernel config: you need CONFIG_X86_MSR builtin or as module.')
  523. def check_cpu():
  524. try:
  525. with open('/proc/cpuinfo') as f:
  526. cpuinfo = {}
  527. for row in f.readlines():
  528. try:
  529. key, value = map(lambda x: x.strip(), row.split(':'))
  530. if key == 'processor' and value == '1':
  531. break
  532. try:
  533. cpuinfo[key] = int(value, 0)
  534. except ValueError:
  535. cpuinfo[key] = value
  536. except ValueError:
  537. pass
  538. if cpuinfo['vendor_id'] != 'GenuineIntel':
  539. fatal('This tool is designed for Intel CPUs only.')
  540. cpu_model = None
  541. for model in supported_cpus:
  542. if cpuinfo['model'] in supported_cpus[model]:
  543. cpu_model = model
  544. break
  545. if cpuinfo['cpu family'] != 6 or cpu_model is None:
  546. fatal('Your CPU model is not supported.')
  547. print('[I] Detected CPU architecture: Intel {:s}'.format(cpu_model))
  548. except:
  549. fatal('Unable to identify CPU model.')
  550. def monitor(exit_event, wait):
  551. IA32_THERM_STATUS = 0x19C
  552. IA32_PERF_STATUS = 0x198
  553. MSR_RAPL_POWER_UNIT = 0x606
  554. MSR_INTEL_PKG_ENERGY_STATUS = 0x611
  555. MSR_PP1_ENERGY_STATUS = 0x641
  556. MSR_DRAM_ENERGY_STATUS = 0x619
  557. wait = max(0.1, wait)
  558. rapl_power_unit = 0.5 ** readmsr(MSR_RAPL_POWER_UNIT, from_bit=8, to_bit=12, cpu=0)
  559. power_plane_msr = {
  560. 'Package': MSR_INTEL_PKG_ENERGY_STATUS,
  561. 'Graphics': MSR_PP1_ENERGY_STATUS,
  562. 'DRAM': MSR_DRAM_ENERGY_STATUS,
  563. }
  564. prev_energy = {
  565. 'Package': (readmsr(MSR_INTEL_PKG_ENERGY_STATUS, cpu=0) * rapl_power_unit, time()),
  566. 'Graphics': (readmsr(MSR_PP1_ENERGY_STATUS, cpu=0) * rapl_power_unit, time()),
  567. 'DRAM': (readmsr(MSR_DRAM_ENERGY_STATUS, cpu=0) * rapl_power_unit, time()),
  568. }
  569. undervolt_values = get_undervolt(convert=True)
  570. undervolt_output = ' | '.join('{:s}: {:.2f} mV'.format(plane, undervolt_values[plane]) for plane in VOLTAGE_PLANES)
  571. print('[D] Undervolt offsets: {:s}'.format(undervolt_output))
  572. iccmax_values = get_icc_max(convert=True)
  573. iccmax_output = ' | '.join('{:s}: {:.2f} A'.format(plane, iccmax_values[plane]) for plane in CURRENT_PLANES)
  574. print('[D] IccMax: {:s}'.format(iccmax_output))
  575. print('[D] Realtime monitoring of throttling causes:\n')
  576. while not exit_event.is_set():
  577. value = readmsr(IA32_THERM_STATUS, from_bit=0, to_bit=15, cpu=0)
  578. offsets = {'Thermal': 0, 'Power': 10, 'Current': 12, 'Cross-domain (e.g. GPU)': 14}
  579. output = ('{:s}: {:s}'.format(cause, LIM if bool((value >> offsets[cause]) & 1) else OK) for cause in offsets)
  580. # ugly code, just testing...
  581. vcore = readmsr(IA32_PERF_STATUS, from_bit=32, to_bit=47, cpu=0) / (2.0 ** 13) * 1000
  582. stats2 = {'VCore': '{:.0f} mV'.format(vcore)}
  583. for power_plane in ('Package', 'Graphics', 'DRAM'):
  584. energy_j = readmsr(power_plane_msr[power_plane], cpu=0) * rapl_power_unit
  585. now = time()
  586. prev_energy[power_plane], energy_w = (
  587. (energy_j, now),
  588. (energy_j - prev_energy[power_plane][0]) / (now - prev_energy[power_plane][1]),
  589. )
  590. stats2[power_plane] = '{:.1f} W'.format(energy_w)
  591. output2 = ('{:s}: {:s}'.format(label, stats2[label]) for label in stats2)
  592. print('[{}] {} || {}{}'.format(power['source'], ' - '.join(output), ' - '.join(output2), ' ' * 10), end='\r')
  593. exit_event.wait(wait)
  594. def main():
  595. global args
  596. parser = argparse.ArgumentParser()
  597. exclusive_group = parser.add_mutually_exclusive_group()
  598. exclusive_group.add_argument('--debug', action='store_true', help='add some debug info and additional checks')
  599. exclusive_group.add_argument(
  600. '--monitor',
  601. metavar='update_rate',
  602. const=1.0,
  603. type=float,
  604. nargs='?',
  605. help='realtime monitoring of throttling causes (default 1s)',
  606. )
  607. parser.add_argument('--config', default='/etc/lenovo_fix.conf', help='override default config file path')
  608. parser.add_argument('--force', action='store_true', help='bypass compatibility checks (EXPERTS only)')
  609. args = parser.parse_args()
  610. if not args.force:
  611. check_kernel()
  612. check_cpu()
  613. print('[I] Loading config file.')
  614. config = load_config()
  615. power['source'] = 'BATTERY' if is_on_battery(config) else 'AC'
  616. platform_info = get_cpu_platform_info()
  617. if args.debug:
  618. for key, value in platform_info.items():
  619. print('[D] cpu platform info: {} = {}'.format(key.replace("_", " "), value))
  620. regs = calc_reg_values(platform_info, config)
  621. if not config.getboolean('GENERAL', 'Enabled'):
  622. return
  623. exit_event = Event()
  624. thread = Thread(target=power_thread, args=(config, regs, exit_event))
  625. thread.daemon = True
  626. thread.start()
  627. undervolt(config)
  628. set_icc_max(config)
  629. # handle dbus events for applying undervolt/IccMax on resume from sleep/hybernate
  630. def handle_sleep_callback(sleeping):
  631. if not sleeping:
  632. undervolt(config)
  633. set_icc_max(config)
  634. def handle_ac_callback(*args):
  635. try:
  636. power['source'] = 'BATTERY' if args[1]['Online'] == 0 else 'AC'
  637. power['method'] = 'dbus'
  638. except:
  639. power['method'] = 'polling'
  640. DBusGMainLoop(set_as_default=True)
  641. bus = dbus.SystemBus()
  642. # add dbus receiver only if undervolt/IccMax is enabled in config
  643. if any(
  644. config.getfloat(key, plane, fallback=0) != 0 for plane in VOLTAGE_PLANES for key in UNDERVOLT_KEYS + ICCMAX_KEYS
  645. ):
  646. bus.add_signal_receiver(
  647. handle_sleep_callback, 'PrepareForSleep', 'org.freedesktop.login1.Manager', 'org.freedesktop.login1'
  648. )
  649. bus.add_signal_receiver(
  650. handle_ac_callback,
  651. signal_name="PropertiesChanged",
  652. dbus_interface="org.freedesktop.DBus.Properties",
  653. path="/org/freedesktop/UPower/devices/line_power_AC",
  654. )
  655. print('[I] Starting main loop.')
  656. if args.monitor is not None:
  657. monitor_thread = Thread(target=monitor, args=(exit_event, args.monitor))
  658. monitor_thread.daemon = True
  659. monitor_thread.start()
  660. try:
  661. loop = GLib.MainLoop()
  662. loop.run()
  663. except (KeyboardInterrupt, SystemExit):
  664. pass
  665. exit_event.set()
  666. loop.quit()
  667. thread.join(timeout=1)
  668. if args.monitor is not None:
  669. monitor_thread.join(timeout=0.1)
  670. if __name__ == '__main__':
  671. main()