|
|
@@ -189,14 +189,13 @@ struct rapl_package {
|
|
|
unsigned int time_unit;
|
|
|
struct rapl_domain *domains; /* array of domains, sized at runtime */
|
|
|
struct powercap_zone *power_zone; /* keep track of parent zone */
|
|
|
- int nr_cpus; /* active cpus on the package, topology info is lost during
|
|
|
- * cpu hotplug. so we have to track ourselves.
|
|
|
- */
|
|
|
unsigned long power_limit_irq; /* keep track of package power limit
|
|
|
* notify interrupt enable status.
|
|
|
*/
|
|
|
struct list_head plist;
|
|
|
int lead_cpu; /* one active cpu per package for access */
|
|
|
+ /* Track active cpus */
|
|
|
+ struct cpumask cpumask;
|
|
|
};
|
|
|
|
|
|
struct rapl_defaults {
|
|
|
@@ -275,18 +274,6 @@ static struct rapl_package *find_package_by_id(int id)
|
|
|
return NULL;
|
|
|
}
|
|
|
|
|
|
-/* caller must hold cpu hotplug lock */
|
|
|
-static void rapl_cleanup_data(void)
|
|
|
-{
|
|
|
- struct rapl_package *p, *tmp;
|
|
|
-
|
|
|
- list_for_each_entry_safe(p, tmp, &rapl_packages, plist) {
|
|
|
- kfree(p->domains);
|
|
|
- list_del(&p->plist);
|
|
|
- kfree(p);
|
|
|
- }
|
|
|
-}
|
|
|
-
|
|
|
static int get_energy_counter(struct powercap_zone *power_zone, u64 *energy_raw)
|
|
|
{
|
|
|
struct rapl_domain *rd;
|
|
|
@@ -442,6 +429,7 @@ static int contraint_to_pl(struct rapl_domain *rd, int cid)
|
|
|
return i;
|
|
|
}
|
|
|
}
|
|
|
+ pr_err("Cannot find matching power limit for constraint %d\n", cid);
|
|
|
|
|
|
return -EINVAL;
|
|
|
}
|
|
|
@@ -457,6 +445,10 @@ static int set_power_limit(struct powercap_zone *power_zone, int cid,
|
|
|
get_online_cpus();
|
|
|
rd = power_zone_to_rapl_domain(power_zone);
|
|
|
id = contraint_to_pl(rd, cid);
|
|
|
+ if (id < 0) {
|
|
|
+ ret = id;
|
|
|
+ goto set_exit;
|
|
|
+ }
|
|
|
|
|
|
rp = rd->rp;
|
|
|
|
|
|
@@ -496,6 +488,11 @@ static int get_current_power_limit(struct powercap_zone *power_zone, int cid,
|
|
|
get_online_cpus();
|
|
|
rd = power_zone_to_rapl_domain(power_zone);
|
|
|
id = contraint_to_pl(rd, cid);
|
|
|
+ if (id < 0) {
|
|
|
+ ret = id;
|
|
|
+ goto get_exit;
|
|
|
+ }
|
|
|
+
|
|
|
switch (rd->rpl[id].prim_id) {
|
|
|
case PL1_ENABLE:
|
|
|
prim = POWER_LIMIT1;
|
|
|
@@ -512,6 +509,7 @@ static int get_current_power_limit(struct powercap_zone *power_zone, int cid,
|
|
|
else
|
|
|
*data = val;
|
|
|
|
|
|
+get_exit:
|
|
|
put_online_cpus();
|
|
|
|
|
|
return ret;
|
|
|
@@ -527,6 +525,10 @@ static int set_time_window(struct powercap_zone *power_zone, int cid,
|
|
|
get_online_cpus();
|
|
|
rd = power_zone_to_rapl_domain(power_zone);
|
|
|
id = contraint_to_pl(rd, cid);
|
|
|
+ if (id < 0) {
|
|
|
+ ret = id;
|
|
|
+ goto set_time_exit;
|
|
|
+ }
|
|
|
|
|
|
switch (rd->rpl[id].prim_id) {
|
|
|
case PL1_ENABLE:
|
|
|
@@ -538,6 +540,8 @@ static int set_time_window(struct powercap_zone *power_zone, int cid,
|
|
|
default:
|
|
|
ret = -EINVAL;
|
|
|
}
|
|
|
+
|
|
|
+set_time_exit:
|
|
|
put_online_cpus();
|
|
|
return ret;
|
|
|
}
|
|
|
@@ -552,6 +556,10 @@ static int get_time_window(struct powercap_zone *power_zone, int cid, u64 *data)
|
|
|
get_online_cpus();
|
|
|
rd = power_zone_to_rapl_domain(power_zone);
|
|
|
id = contraint_to_pl(rd, cid);
|
|
|
+ if (id < 0) {
|
|
|
+ ret = id;
|
|
|
+ goto get_time_exit;
|
|
|
+ }
|
|
|
|
|
|
switch (rd->rpl[id].prim_id) {
|
|
|
case PL1_ENABLE:
|
|
|
@@ -566,6 +574,8 @@ static int get_time_window(struct powercap_zone *power_zone, int cid, u64 *data)
|
|
|
}
|
|
|
if (!ret)
|
|
|
*data = val;
|
|
|
+
|
|
|
+get_time_exit:
|
|
|
put_online_cpus();
|
|
|
|
|
|
return ret;
|
|
|
@@ -707,7 +717,7 @@ static u64 rapl_unit_xlate(struct rapl_domain *rd, enum unit_type type,
|
|
|
case ENERGY_UNIT:
|
|
|
scale = ENERGY_UNIT_SCALE;
|
|
|
/* per domain unit takes precedence */
|
|
|
- if (rd && rd->domain_energy_unit)
|
|
|
+ if (rd->domain_energy_unit)
|
|
|
units = rd->domain_energy_unit;
|
|
|
else
|
|
|
units = rp->energy_unit;
|
|
|
@@ -976,10 +986,20 @@ static void package_power_limit_irq_save(struct rapl_package *rp)
|
|
|
smp_call_function_single(rp->lead_cpu, power_limit_irq_save_cpu, rp, 1);
|
|
|
}
|
|
|
|
|
|
-static void power_limit_irq_restore_cpu(void *info)
|
|
|
+/*
|
|
|
+ * Restore per package power limit interrupt enable state. Called from cpu
|
|
|
+ * hotplug code on package removal.
|
|
|
+ */
|
|
|
+static void package_power_limit_irq_restore(struct rapl_package *rp)
|
|
|
{
|
|
|
- u32 l, h = 0;
|
|
|
- struct rapl_package *rp = (struct rapl_package *)info;
|
|
|
+ u32 l, h;
|
|
|
+
|
|
|
+ if (!boot_cpu_has(X86_FEATURE_PTS) || !boot_cpu_has(X86_FEATURE_PLN))
|
|
|
+ return;
|
|
|
+
|
|
|
+ /* irq enable state not saved, nothing to restore */
|
|
|
+ if (!(rp->power_limit_irq & PACKAGE_PLN_INT_SAVED))
|
|
|
+ return;
|
|
|
|
|
|
rdmsr_safe(MSR_IA32_PACKAGE_THERM_INTERRUPT, &l, &h);
|
|
|
|
|
|
@@ -991,19 +1011,6 @@ static void power_limit_irq_restore_cpu(void *info)
|
|
|
wrmsr_safe(MSR_IA32_PACKAGE_THERM_INTERRUPT, l, h);
|
|
|
}
|
|
|
|
|
|
-/* restore per package power limit interrupt enable state */
|
|
|
-static void package_power_limit_irq_restore(struct rapl_package *rp)
|
|
|
-{
|
|
|
- if (!boot_cpu_has(X86_FEATURE_PTS) || !boot_cpu_has(X86_FEATURE_PLN))
|
|
|
- return;
|
|
|
-
|
|
|
- /* irq enable state not saved, nothing to restore */
|
|
|
- if (!(rp->power_limit_irq & PACKAGE_PLN_INT_SAVED))
|
|
|
- return;
|
|
|
-
|
|
|
- smp_call_function_single(rp->lead_cpu, power_limit_irq_restore_cpu, rp, 1);
|
|
|
-}
|
|
|
-
|
|
|
static void set_floor_freq_default(struct rapl_domain *rd, bool mode)
|
|
|
{
|
|
|
int nr_powerlimit = find_nr_power_limit(rd);
|
|
|
@@ -1160,84 +1167,49 @@ static const struct x86_cpu_id rapl_ids[] __initconst = {
|
|
|
RAPL_CPU(INTEL_FAM6_ATOM_DENVERTON, rapl_defaults_core),
|
|
|
|
|
|
RAPL_CPU(INTEL_FAM6_XEON_PHI_KNL, rapl_defaults_hsw_server),
|
|
|
+ RAPL_CPU(INTEL_FAM6_XEON_PHI_KNM, rapl_defaults_hsw_server),
|
|
|
{}
|
|
|
};
|
|
|
MODULE_DEVICE_TABLE(x86cpu, rapl_ids);
|
|
|
|
|
|
-/* read once for all raw primitive data for all packages, domains */
|
|
|
-static void rapl_update_domain_data(void)
|
|
|
+/* Read once for all raw primitive data for domains */
|
|
|
+static void rapl_update_domain_data(struct rapl_package *rp)
|
|
|
{
|
|
|
int dmn, prim;
|
|
|
u64 val;
|
|
|
- struct rapl_package *rp;
|
|
|
|
|
|
- list_for_each_entry(rp, &rapl_packages, plist) {
|
|
|
- for (dmn = 0; dmn < rp->nr_domains; dmn++) {
|
|
|
- pr_debug("update package %d domain %s data\n", rp->id,
|
|
|
- rp->domains[dmn].name);
|
|
|
- /* exclude non-raw primitives */
|
|
|
- for (prim = 0; prim < NR_RAW_PRIMITIVES; prim++)
|
|
|
- if (!rapl_read_data_raw(&rp->domains[dmn], prim,
|
|
|
- rpi[prim].unit,
|
|
|
- &val))
|
|
|
- rp->domains[dmn].rdd.primitives[prim] =
|
|
|
- val;
|
|
|
+ for (dmn = 0; dmn < rp->nr_domains; dmn++) {
|
|
|
+ pr_debug("update package %d domain %s data\n", rp->id,
|
|
|
+ rp->domains[dmn].name);
|
|
|
+ /* exclude non-raw primitives */
|
|
|
+ for (prim = 0; prim < NR_RAW_PRIMITIVES; prim++) {
|
|
|
+ if (!rapl_read_data_raw(&rp->domains[dmn], prim,
|
|
|
+ rpi[prim].unit, &val))
|
|
|
+ rp->domains[dmn].rdd.primitives[prim] = val;
|
|
|
}
|
|
|
}
|
|
|
|
|
|
}
|
|
|
|
|
|
-static int rapl_unregister_powercap(void)
|
|
|
+static void rapl_unregister_powercap(void)
|
|
|
{
|
|
|
- struct rapl_package *rp;
|
|
|
- struct rapl_domain *rd, *rd_package = NULL;
|
|
|
-
|
|
|
- /* unregister all active rapl packages from the powercap layer,
|
|
|
- * hotplug lock held
|
|
|
- */
|
|
|
- list_for_each_entry(rp, &rapl_packages, plist) {
|
|
|
- package_power_limit_irq_restore(rp);
|
|
|
-
|
|
|
- for (rd = rp->domains; rd < rp->domains + rp->nr_domains;
|
|
|
- rd++) {
|
|
|
- pr_debug("remove package, undo power limit on %d: %s\n",
|
|
|
- rp->id, rd->name);
|
|
|
- rapl_write_data_raw(rd, PL1_ENABLE, 0);
|
|
|
- rapl_write_data_raw(rd, PL1_CLAMP, 0);
|
|
|
- if (find_nr_power_limit(rd) > 1) {
|
|
|
- rapl_write_data_raw(rd, PL2_ENABLE, 0);
|
|
|
- rapl_write_data_raw(rd, PL2_CLAMP, 0);
|
|
|
- }
|
|
|
- if (rd->id == RAPL_DOMAIN_PACKAGE) {
|
|
|
- rd_package = rd;
|
|
|
- continue;
|
|
|
- }
|
|
|
- powercap_unregister_zone(control_type, &rd->power_zone);
|
|
|
- }
|
|
|
- /* do the package zone last */
|
|
|
- if (rd_package)
|
|
|
- powercap_unregister_zone(control_type,
|
|
|
- &rd_package->power_zone);
|
|
|
- }
|
|
|
-
|
|
|
if (platform_rapl_domain) {
|
|
|
powercap_unregister_zone(control_type,
|
|
|
&platform_rapl_domain->power_zone);
|
|
|
kfree(platform_rapl_domain);
|
|
|
}
|
|
|
-
|
|
|
powercap_unregister_control_type(control_type);
|
|
|
-
|
|
|
- return 0;
|
|
|
}
|
|
|
|
|
|
static int rapl_package_register_powercap(struct rapl_package *rp)
|
|
|
{
|
|
|
struct rapl_domain *rd;
|
|
|
- int ret = 0;
|
|
|
char dev_name[17]; /* max domain name = 7 + 1 + 8 for int + 1 for null*/
|
|
|
struct powercap_zone *power_zone = NULL;
|
|
|
- int nr_pl;
|
|
|
+ int nr_pl, ret;;
|
|
|
+
|
|
|
+ /* Update the domain data of the new package */
|
|
|
+ rapl_update_domain_data(rp);
|
|
|
|
|
|
/* first we register package domain as the parent zone*/
|
|
|
for (rd = rp->domains; rd < rp->domains + rp->nr_domains; rd++) {
|
|
|
@@ -1257,8 +1229,7 @@ static int rapl_package_register_powercap(struct rapl_package *rp)
|
|
|
if (IS_ERR(power_zone)) {
|
|
|
pr_debug("failed to register package, %d\n",
|
|
|
rp->id);
|
|
|
- ret = PTR_ERR(power_zone);
|
|
|
- goto exit_package;
|
|
|
+ return PTR_ERR(power_zone);
|
|
|
}
|
|
|
/* track parent zone in per package/socket data */
|
|
|
rp->power_zone = power_zone;
|
|
|
@@ -1268,8 +1239,7 @@ static int rapl_package_register_powercap(struct rapl_package *rp)
|
|
|
}
|
|
|
if (!power_zone) {
|
|
|
pr_err("no package domain found, unknown topology!\n");
|
|
|
- ret = -ENODEV;
|
|
|
- goto exit_package;
|
|
|
+ return -ENODEV;
|
|
|
}
|
|
|
/* now register domains as children of the socket/package*/
|
|
|
for (rd = rp->domains; rd < rp->domains + rp->nr_domains; rd++) {
|
|
|
@@ -1290,11 +1260,11 @@ static int rapl_package_register_powercap(struct rapl_package *rp)
|
|
|
goto err_cleanup;
|
|
|
}
|
|
|
}
|
|
|
+ return 0;
|
|
|
|
|
|
-exit_package:
|
|
|
- return ret;
|
|
|
err_cleanup:
|
|
|
- /* clean up previously initialized domains within the package if we
|
|
|
+ /*
|
|
|
+ * Clean up previously initialized domains within the package if we
|
|
|
* failed after the first domain setup.
|
|
|
*/
|
|
|
while (--rd >= rp->domains) {
|
|
|
@@ -1305,7 +1275,7 @@ static int rapl_package_register_powercap(struct rapl_package *rp)
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
-static int rapl_register_psys(void)
|
|
|
+static int __init rapl_register_psys(void)
|
|
|
{
|
|
|
struct rapl_domain *rd;
|
|
|
struct powercap_zone *power_zone;
|
|
|
@@ -1346,40 +1316,14 @@ static int rapl_register_psys(void)
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
-static int rapl_register_powercap(void)
|
|
|
+static int __init rapl_register_powercap(void)
|
|
|
{
|
|
|
- struct rapl_domain *rd;
|
|
|
- struct rapl_package *rp;
|
|
|
- int ret = 0;
|
|
|
-
|
|
|
control_type = powercap_register_control_type(NULL, "intel-rapl", NULL);
|
|
|
if (IS_ERR(control_type)) {
|
|
|
pr_debug("failed to register powercap control_type.\n");
|
|
|
return PTR_ERR(control_type);
|
|
|
}
|
|
|
- /* read the initial data */
|
|
|
- rapl_update_domain_data();
|
|
|
- list_for_each_entry(rp, &rapl_packages, plist)
|
|
|
- if (rapl_package_register_powercap(rp))
|
|
|
- goto err_cleanup_package;
|
|
|
-
|
|
|
- /* Don't bail out if PSys is not supported */
|
|
|
- rapl_register_psys();
|
|
|
-
|
|
|
- return ret;
|
|
|
-
|
|
|
-err_cleanup_package:
|
|
|
- /* clean up previously initialized packages */
|
|
|
- list_for_each_entry_continue_reverse(rp, &rapl_packages, plist) {
|
|
|
- for (rd = rp->domains; rd < rp->domains + rp->nr_domains;
|
|
|
- rd++) {
|
|
|
- pr_debug("unregister zone/package %d, %s domain\n",
|
|
|
- rp->id, rd->name);
|
|
|
- powercap_unregister_zone(control_type, &rd->power_zone);
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- return ret;
|
|
|
+ return 0;
|
|
|
}
|
|
|
|
|
|
static int rapl_check_domain(int cpu, int domain)
|
|
|
@@ -1452,9 +1396,8 @@ static void rapl_detect_powerlimit(struct rapl_domain *rd)
|
|
|
*/
|
|
|
static int rapl_detect_domains(struct rapl_package *rp, int cpu)
|
|
|
{
|
|
|
- int i;
|
|
|
- int ret = 0;
|
|
|
struct rapl_domain *rd;
|
|
|
+ int i;
|
|
|
|
|
|
for (i = 0; i < RAPL_DOMAIN_MAX; i++) {
|
|
|
/* use physical package id to read counters */
|
|
|
@@ -1466,84 +1409,20 @@ static int rapl_detect_domains(struct rapl_package *rp, int cpu)
|
|
|
rp->nr_domains = bitmap_weight(&rp->domain_map, RAPL_DOMAIN_MAX);
|
|
|
if (!rp->nr_domains) {
|
|
|
pr_debug("no valid rapl domains found in package %d\n", rp->id);
|
|
|
- ret = -ENODEV;
|
|
|
- goto done;
|
|
|
+ return -ENODEV;
|
|
|
}
|
|
|
pr_debug("found %d domains on package %d\n", rp->nr_domains, rp->id);
|
|
|
|
|
|
rp->domains = kcalloc(rp->nr_domains + 1, sizeof(struct rapl_domain),
|
|
|
GFP_KERNEL);
|
|
|
- if (!rp->domains) {
|
|
|
- ret = -ENOMEM;
|
|
|
- goto done;
|
|
|
- }
|
|
|
+ if (!rp->domains)
|
|
|
+ return -ENOMEM;
|
|
|
+
|
|
|
rapl_init_domains(rp);
|
|
|
|
|
|
for (rd = rp->domains; rd < rp->domains + rp->nr_domains; rd++)
|
|
|
rapl_detect_powerlimit(rd);
|
|
|
|
|
|
-
|
|
|
-
|
|
|
-done:
|
|
|
- return ret;
|
|
|
-}
|
|
|
-
|
|
|
-static bool is_package_new(int package)
|
|
|
-{
|
|
|
- struct rapl_package *rp;
|
|
|
-
|
|
|
- /* caller prevents cpu hotplug, there will be no new packages added
|
|
|
- * or deleted while traversing the package list, no need for locking.
|
|
|
- */
|
|
|
- list_for_each_entry(rp, &rapl_packages, plist)
|
|
|
- if (package == rp->id)
|
|
|
- return false;
|
|
|
-
|
|
|
- return true;
|
|
|
-}
|
|
|
-
|
|
|
-/* RAPL interface can be made of a two-level hierarchy: package level and domain
|
|
|
- * level. We first detect the number of packages then domains of each package.
|
|
|
- * We have to consider the possiblity of CPU online/offline due to hotplug and
|
|
|
- * other scenarios.
|
|
|
- */
|
|
|
-static int rapl_detect_topology(void)
|
|
|
-{
|
|
|
- int i;
|
|
|
- int phy_package_id;
|
|
|
- struct rapl_package *new_package, *rp;
|
|
|
-
|
|
|
- for_each_online_cpu(i) {
|
|
|
- phy_package_id = topology_physical_package_id(i);
|
|
|
- if (is_package_new(phy_package_id)) {
|
|
|
- new_package = kzalloc(sizeof(*rp), GFP_KERNEL);
|
|
|
- if (!new_package) {
|
|
|
- rapl_cleanup_data();
|
|
|
- return -ENOMEM;
|
|
|
- }
|
|
|
- /* add the new package to the list */
|
|
|
- new_package->id = phy_package_id;
|
|
|
- new_package->nr_cpus = 1;
|
|
|
- /* use the first active cpu of the package to access */
|
|
|
- new_package->lead_cpu = i;
|
|
|
- /* check if the package contains valid domains */
|
|
|
- if (rapl_detect_domains(new_package, i) ||
|
|
|
- rapl_defaults->check_unit(new_package, i)) {
|
|
|
- kfree(new_package->domains);
|
|
|
- kfree(new_package);
|
|
|
- /* free up the packages already initialized */
|
|
|
- rapl_cleanup_data();
|
|
|
- return -ENODEV;
|
|
|
- }
|
|
|
- INIT_LIST_HEAD(&new_package->plist);
|
|
|
- list_add(&new_package->plist, &rapl_packages);
|
|
|
- } else {
|
|
|
- rp = find_package_by_id(phy_package_id);
|
|
|
- if (rp)
|
|
|
- ++rp->nr_cpus;
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
@@ -1552,12 +1431,21 @@ static void rapl_remove_package(struct rapl_package *rp)
|
|
|
{
|
|
|
struct rapl_domain *rd, *rd_package = NULL;
|
|
|
|
|
|
+ package_power_limit_irq_restore(rp);
|
|
|
+
|
|
|
for (rd = rp->domains; rd < rp->domains + rp->nr_domains; rd++) {
|
|
|
+ rapl_write_data_raw(rd, PL1_ENABLE, 0);
|
|
|
+ rapl_write_data_raw(rd, PL1_CLAMP, 0);
|
|
|
+ if (find_nr_power_limit(rd) > 1) {
|
|
|
+ rapl_write_data_raw(rd, PL2_ENABLE, 0);
|
|
|
+ rapl_write_data_raw(rd, PL2_CLAMP, 0);
|
|
|
+ }
|
|
|
if (rd->id == RAPL_DOMAIN_PACKAGE) {
|
|
|
rd_package = rd;
|
|
|
continue;
|
|
|
}
|
|
|
- pr_debug("remove package %d, %s domain\n", rp->id, rd->name);
|
|
|
+ pr_debug("remove package, undo power limit on %d: %s\n",
|
|
|
+ rp->id, rd->name);
|
|
|
powercap_unregister_zone(control_type, &rd->power_zone);
|
|
|
}
|
|
|
/* do parent zone last */
|
|
|
@@ -1567,20 +1455,17 @@ static void rapl_remove_package(struct rapl_package *rp)
|
|
|
}
|
|
|
|
|
|
/* called from CPU hotplug notifier, hotplug lock held */
|
|
|
-static int rapl_add_package(int cpu)
|
|
|
+static struct rapl_package *rapl_add_package(int cpu, int pkgid)
|
|
|
{
|
|
|
- int ret = 0;
|
|
|
- int phy_package_id;
|
|
|
struct rapl_package *rp;
|
|
|
+ int ret;
|
|
|
|
|
|
- phy_package_id = topology_physical_package_id(cpu);
|
|
|
rp = kzalloc(sizeof(struct rapl_package), GFP_KERNEL);
|
|
|
if (!rp)
|
|
|
- return -ENOMEM;
|
|
|
+ return ERR_PTR(-ENOMEM);
|
|
|
|
|
|
/* add the new package to the list */
|
|
|
- rp->id = phy_package_id;
|
|
|
- rp->nr_cpus = 1;
|
|
|
+ rp->id = pkgid;
|
|
|
rp->lead_cpu = cpu;
|
|
|
|
|
|
/* check if the package contains valid domains */
|
|
|
@@ -1589,17 +1474,17 @@ static int rapl_add_package(int cpu)
|
|
|
ret = -ENODEV;
|
|
|
goto err_free_package;
|
|
|
}
|
|
|
- if (!rapl_package_register_powercap(rp)) {
|
|
|
+ ret = rapl_package_register_powercap(rp);
|
|
|
+ if (!ret) {
|
|
|
INIT_LIST_HEAD(&rp->plist);
|
|
|
list_add(&rp->plist, &rapl_packages);
|
|
|
- return ret;
|
|
|
+ return rp;
|
|
|
}
|
|
|
|
|
|
err_free_package:
|
|
|
kfree(rp->domains);
|
|
|
kfree(rp);
|
|
|
-
|
|
|
- return ret;
|
|
|
+ return ERR_PTR(ret);
|
|
|
}
|
|
|
|
|
|
/* Handles CPU hotplug on multi-socket systems.
|
|
|
@@ -1609,55 +1494,46 @@ static int rapl_add_package(int cpu)
|
|
|
* associated domains. Cooling devices are handled accordingly at
|
|
|
* per-domain level.
|
|
|
*/
|
|
|
-static int rapl_cpu_callback(struct notifier_block *nfb,
|
|
|
- unsigned long action, void *hcpu)
|
|
|
+static int rapl_cpu_online(unsigned int cpu)
|
|
|
{
|
|
|
- unsigned long cpu = (unsigned long)hcpu;
|
|
|
- int phy_package_id;
|
|
|
+ int pkgid = topology_physical_package_id(cpu);
|
|
|
struct rapl_package *rp;
|
|
|
- int lead_cpu;
|
|
|
|
|
|
- phy_package_id = topology_physical_package_id(cpu);
|
|
|
- switch (action) {
|
|
|
- case CPU_ONLINE:
|
|
|
- case CPU_ONLINE_FROZEN:
|
|
|
- case CPU_DOWN_FAILED:
|
|
|
- case CPU_DOWN_FAILED_FROZEN:
|
|
|
- rp = find_package_by_id(phy_package_id);
|
|
|
- if (rp)
|
|
|
- ++rp->nr_cpus;
|
|
|
- else
|
|
|
- rapl_add_package(cpu);
|
|
|
- break;
|
|
|
- case CPU_DOWN_PREPARE:
|
|
|
- case CPU_DOWN_PREPARE_FROZEN:
|
|
|
- rp = find_package_by_id(phy_package_id);
|
|
|
- if (!rp)
|
|
|
- break;
|
|
|
- if (--rp->nr_cpus == 0)
|
|
|
- rapl_remove_package(rp);
|
|
|
- else if (cpu == rp->lead_cpu) {
|
|
|
- /* choose another active cpu in the package */
|
|
|
- lead_cpu = cpumask_any_but(topology_core_cpumask(cpu), cpu);
|
|
|
- if (lead_cpu < nr_cpu_ids)
|
|
|
- rp->lead_cpu = lead_cpu;
|
|
|
- else /* should never go here */
|
|
|
- pr_err("no active cpu available for package %d\n",
|
|
|
- phy_package_id);
|
|
|
- }
|
|
|
+ rp = find_package_by_id(pkgid);
|
|
|
+ if (!rp) {
|
|
|
+ rp = rapl_add_package(cpu, pkgid);
|
|
|
+ if (IS_ERR(rp))
|
|
|
+ return PTR_ERR(rp);
|
|
|
}
|
|
|
+ cpumask_set_cpu(cpu, &rp->cpumask);
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static int rapl_cpu_down_prep(unsigned int cpu)
|
|
|
+{
|
|
|
+ int pkgid = topology_physical_package_id(cpu);
|
|
|
+ struct rapl_package *rp;
|
|
|
+ int lead_cpu;
|
|
|
+
|
|
|
+ rp = find_package_by_id(pkgid);
|
|
|
+ if (!rp)
|
|
|
+ return 0;
|
|
|
|
|
|
- return NOTIFY_OK;
|
|
|
+ cpumask_clear_cpu(cpu, &rp->cpumask);
|
|
|
+ lead_cpu = cpumask_first(&rp->cpumask);
|
|
|
+ if (lead_cpu >= nr_cpu_ids)
|
|
|
+ rapl_remove_package(rp);
|
|
|
+ else if (rp->lead_cpu == cpu)
|
|
|
+ rp->lead_cpu = lead_cpu;
|
|
|
+ return 0;
|
|
|
}
|
|
|
|
|
|
-static struct notifier_block rapl_cpu_notifier = {
|
|
|
- .notifier_call = rapl_cpu_callback,
|
|
|
-};
|
|
|
+static enum cpuhp_state pcap_rapl_online;
|
|
|
|
|
|
static int __init rapl_init(void)
|
|
|
{
|
|
|
- int ret = 0;
|
|
|
const struct x86_cpu_id *id;
|
|
|
+ int ret;
|
|
|
|
|
|
id = x86_match_cpu(rapl_ids);
|
|
|
if (!id) {
|
|
|
@@ -1669,36 +1545,29 @@ static int __init rapl_init(void)
|
|
|
|
|
|
rapl_defaults = (struct rapl_defaults *)id->driver_data;
|
|
|
|
|
|
- cpu_notifier_register_begin();
|
|
|
-
|
|
|
- /* prevent CPU hotplug during detection */
|
|
|
- get_online_cpus();
|
|
|
- ret = rapl_detect_topology();
|
|
|
+ ret = rapl_register_powercap();
|
|
|
if (ret)
|
|
|
- goto done;
|
|
|
+ return ret;
|
|
|
|
|
|
- if (rapl_register_powercap()) {
|
|
|
- rapl_cleanup_data();
|
|
|
- ret = -ENODEV;
|
|
|
- goto done;
|
|
|
- }
|
|
|
- __register_hotcpu_notifier(&rapl_cpu_notifier);
|
|
|
-done:
|
|
|
- put_online_cpus();
|
|
|
- cpu_notifier_register_done();
|
|
|
+ ret = cpuhp_setup_state(CPUHP_AP_ONLINE_DYN, "powercap/rapl:online",
|
|
|
+ rapl_cpu_online, rapl_cpu_down_prep);
|
|
|
+ if (ret < 0)
|
|
|
+ goto err_unreg;
|
|
|
+ pcap_rapl_online = ret;
|
|
|
+
|
|
|
+ /* Don't bail out if PSys is not supported */
|
|
|
+ rapl_register_psys();
|
|
|
+ return 0;
|
|
|
|
|
|
+err_unreg:
|
|
|
+ rapl_unregister_powercap();
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
static void __exit rapl_exit(void)
|
|
|
{
|
|
|
- cpu_notifier_register_begin();
|
|
|
- get_online_cpus();
|
|
|
- __unregister_hotcpu_notifier(&rapl_cpu_notifier);
|
|
|
+ cpuhp_remove_state(pcap_rapl_online);
|
|
|
rapl_unregister_powercap();
|
|
|
- rapl_cleanup_data();
|
|
|
- put_online_cpus();
|
|
|
- cpu_notifier_register_done();
|
|
|
}
|
|
|
|
|
|
module_init(rapl_init);
|