]> git.karo-electronics.de Git - karo-tx-linux.git/blobdiff - drivers/powercap/intel_rapl.c
powercap/intel rapl: Convert to hotplug state machine
[karo-tx-linux.git] / drivers / powercap / intel_rapl.c
index 243b233ff31bff9fdcfae1ab019b3104fd36916e..de5cf22371f5839b9dc163ed603a45a6cea1e493 100644 (file)
@@ -1164,24 +1164,20 @@ static const struct x86_cpu_id rapl_ids[] __initconst = {
 };
 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;
                }
        }
 
@@ -1234,10 +1230,12 @@ static int rapl_unregister_powercap(void)
 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 +1255,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 +1265,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,9 +1286,8 @@ 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
         * failed after the first domain setup.
@@ -1357,8 +1352,7 @@ static int rapl_register_powercap(void)
                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;
@@ -1569,9 +1563,8 @@ static void rapl_remove_package(struct rapl_package *rp)
 /* called from CPU hotplug notifier, hotplug lock held */
 static int rapl_add_package(int cpu)
 {
-       int ret = 0;
-       int phy_package_id;
        struct rapl_package *rp;
+       int ret, phy_package_id;
 
        phy_package_id = topology_physical_package_id(cpu);
        rp = kzalloc(sizeof(struct rapl_package), GFP_KERNEL);
@@ -1589,10 +1582,11 @@ 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 0;
        }
 
 err_free_package:
@@ -1609,50 +1603,48 @@ err_free_package:
  * 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)
+{
+       struct rapl_package *rp;
+       int phy_package_id;
+
+       phy_package_id = topology_physical_package_id(cpu);
+
+       rp = find_package_by_id(phy_package_id);
+       if (rp)
+               rp->nr_cpus++;
+       else
+               rapl_add_package(cpu);
+       return 0;
+}
+
+static int rapl_cpu_down_prep(unsigned int cpu)
 {
-       unsigned long cpu = (unsigned long)hcpu;
        int phy_package_id;
        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(phy_package_id);
+       if (!rp)
+               return 0;
+       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);
                }
        }
-
-       return NOTIFY_OK;
+       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)
 {
@@ -1669,36 +1661,42 @@ 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();
        if (ret)
-               goto done;
+               goto err;
 
        if (rapl_register_powercap()) {
-               rapl_cleanup_data();
                ret = -ENODEV;
-               goto done;
+               goto err_cleanup;
        }
-       __register_hotcpu_notifier(&rapl_cpu_notifier);
-done:
+       ret = cpuhp_setup_state_nocalls(CPUHP_AP_ONLINE_DYN,
+                                       "powercap/rapl:online",
+                                       rapl_cpu_online, rapl_cpu_down_prep);
+       if (ret < 0)
+               goto err_unreg;
+       pcap_rapl_online = ret;
        put_online_cpus();
-       cpu_notifier_register_done();
+       return 0;
 
+err_unreg:
+       rapl_unregister_powercap();
+
+err_cleanup:
+       rapl_cleanup_data();
+err:
+       put_online_cpus();
        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);