These changes are the raw update to linux-4.4.6-rt14. Kernel sources
[kvmfornfv.git] / kernel / drivers / net / wireless / ath / ath10k / thermal.c
index aede750..60fe562 100644 (file)
 #include "debug.h"
 #include "wmi-ops.h"
 
-static int ath10k_thermal_get_active_vifs(struct ath10k *ar,
-                                         enum wmi_vdev_type type)
+static int
+ath10k_thermal_get_max_throttle_state(struct thermal_cooling_device *cdev,
+                                     unsigned long *state)
 {
-       struct ath10k_vif *arvif;
-       int count = 0;
-
-       lockdep_assert_held(&ar->conf_mutex);
-
-       list_for_each_entry(arvif, &ar->arvifs, list) {
-               if (!arvif->is_started)
-                       continue;
-
-               if (!arvif->is_up)
-                       continue;
-
-               if (arvif->vdev_type != type)
-                       continue;
-
-               count++;
-       }
-       return count;
-}
-
-static int ath10k_thermal_get_max_dutycycle(struct thermal_cooling_device *cdev,
-                                           unsigned long *state)
-{
-       *state = ATH10K_QUIET_DUTY_CYCLE_MAX;
+       *state = ATH10K_THERMAL_THROTTLE_MAX;
 
        return 0;
 }
 
-static int ath10k_thermal_get_cur_dutycycle(struct thermal_cooling_device *cdev,
-                                           unsigned long *state)
+static int
+ath10k_thermal_get_cur_throttle_state(struct thermal_cooling_device *cdev,
+                                     unsigned long *state)
 {
        struct ath10k *ar = cdev->devdata;
 
        mutex_lock(&ar->conf_mutex);
-       *state = ar->thermal.duty_cycle;
+       *state = ar->thermal.throttle_state;
        mutex_unlock(&ar->conf_mutex);
 
        return 0;
 }
 
-static int ath10k_thermal_set_cur_dutycycle(struct thermal_cooling_device *cdev,
-                                           unsigned long duty_cycle)
+static int
+ath10k_thermal_set_cur_throttle_state(struct thermal_cooling_device *cdev,
+                                     unsigned long throttle_state)
 {
        struct ath10k *ar = cdev->devdata;
-       u32 period, duration, enabled;
-       int num_bss, ret = 0;
-
-       mutex_lock(&ar->conf_mutex);
-       if (ar->state != ATH10K_STATE_ON) {
-               ret = -ENETDOWN;
-               goto out;
-       }
 
-       if (duty_cycle > ATH10K_QUIET_DUTY_CYCLE_MAX) {
-               ath10k_warn(ar, "duty cycle %ld is exceeding the limit %d\n",
-                           duty_cycle, ATH10K_QUIET_DUTY_CYCLE_MAX);
-               ret = -EINVAL;
-               goto out;
-       }
-       /* TODO: Right now, thermal mitigation is handled only for single/multi
-        * vif AP mode. Since quiet param is not validated in STA mode, it needs
-        * to be investigated further to handle multi STA and multi-vif (AP+STA)
-        * mode properly.
-        */
-       num_bss = ath10k_thermal_get_active_vifs(ar, WMI_VDEV_TYPE_AP);
-       if (!num_bss) {
-               ath10k_warn(ar, "no active AP interfaces\n");
-               ret = -ENETDOWN;
-               goto out;
-       }
-       period = max(ATH10K_QUIET_PERIOD_MIN,
-                    (ATH10K_QUIET_PERIOD_DEFAULT / num_bss));
-       duration = (period * duty_cycle) / 100;
-       enabled = duration ? 1 : 0;
-
-       ret = ath10k_wmi_pdev_set_quiet_mode(ar, period, duration,
-                                            ATH10K_QUIET_START_OFFSET,
-                                            enabled);
-       if (ret) {
-               ath10k_warn(ar, "failed to set quiet mode period %u duarion %u enabled %u ret %d\n",
-                           period, duration, enabled, ret);
-               goto out;
+       if (throttle_state > ATH10K_THERMAL_THROTTLE_MAX) {
+               ath10k_warn(ar, "throttle state %ld is exceeding the limit %d\n",
+                           throttle_state, ATH10K_THERMAL_THROTTLE_MAX);
+               return -EINVAL;
        }
-       ar->thermal.duty_cycle = duty_cycle;
-out:
+       mutex_lock(&ar->conf_mutex);
+       ar->thermal.throttle_state = throttle_state;
+       ath10k_thermal_set_throttling(ar);
        mutex_unlock(&ar->conf_mutex);
-       return ret;
+       return 0;
 }
 
 static struct thermal_cooling_device_ops ath10k_thermal_ops = {
-       .get_max_state = ath10k_thermal_get_max_dutycycle,
-       .get_cur_state = ath10k_thermal_get_cur_dutycycle,
-       .set_cur_state = ath10k_thermal_set_cur_dutycycle,
+       .get_max_state = ath10k_thermal_get_max_throttle_state,
+       .get_cur_state = ath10k_thermal_get_cur_throttle_state,
+       .set_cur_state = ath10k_thermal_set_cur_throttle_state,
 };
 
 static ssize_t ath10k_thermal_show_temp(struct device *dev,
@@ -127,6 +75,7 @@ static ssize_t ath10k_thermal_show_temp(struct device *dev,
 {
        struct ath10k *ar = dev_get_drvdata(dev);
        int ret, temperature;
+       unsigned long time_left;
 
        mutex_lock(&ar->conf_mutex);
 
@@ -148,9 +97,9 @@ static ssize_t ath10k_thermal_show_temp(struct device *dev,
                goto out;
        }
 
-       ret = wait_for_completion_timeout(&ar->thermal.wmi_sync,
-                                         ATH10K_THERMAL_SYNC_TIMEOUT_HZ);
-       if (ret == 0) {
+       time_left = wait_for_completion_timeout(&ar->thermal.wmi_sync,
+                                               ATH10K_THERMAL_SYNC_TIMEOUT_HZ);
+       if (!time_left) {
                ath10k_warn(ar, "failed to synchronize thermal read\n");
                ret = -ETIMEDOUT;
                goto out;
@@ -184,6 +133,32 @@ static struct attribute *ath10k_hwmon_attrs[] = {
 };
 ATTRIBUTE_GROUPS(ath10k_hwmon);
 
+void ath10k_thermal_set_throttling(struct ath10k *ar)
+{
+       u32 period, duration, enabled;
+       int ret;
+
+       lockdep_assert_held(&ar->conf_mutex);
+
+       if (!ar->wmi.ops->gen_pdev_set_quiet_mode)
+               return;
+
+       if (ar->state != ATH10K_STATE_ON)
+               return;
+
+       period = ar->thermal.quiet_period;
+       duration = (period * ar->thermal.throttle_state) / 100;
+       enabled = duration ? 1 : 0;
+
+       ret = ath10k_wmi_pdev_set_quiet_mode(ar, period, duration,
+                                            ATH10K_QUIET_START_OFFSET,
+                                            enabled);
+       if (ret) {
+               ath10k_warn(ar, "failed to set quiet mode period %u duarion %u enabled %u ret %d\n",
+                           period, duration, enabled, ret);
+       }
+}
+
 int ath10k_thermal_register(struct ath10k *ar)
 {
        struct thermal_cooling_device *cdev;
@@ -202,11 +177,12 @@ int ath10k_thermal_register(struct ath10k *ar)
        ret = sysfs_create_link(&ar->dev->kobj, &cdev->device.kobj,
                                "cooling_device");
        if (ret) {
-               ath10k_err(ar, "failed to create thermal symlink\n");
+               ath10k_err(ar, "failed to create cooling device symlink\n");
                goto err_cooling_destroy;
        }
 
        ar->thermal.cdev = cdev;
+       ar->thermal.quiet_period = ATH10K_QUIET_PERIOD_DEFAULT;
 
        /* Do not register hwmon device when temperature reading is not
         * supported by firmware
@@ -231,7 +207,7 @@ int ath10k_thermal_register(struct ath10k *ar)
        return 0;
 
 err_remove_link:
-       sysfs_remove_link(&ar->dev->kobj, "thermal_sensor");
+       sysfs_remove_link(&ar->dev->kobj, "cooling_device");
 err_cooling_destroy:
        thermal_cooling_device_unregister(cdev);
        return ret;
@@ -239,6 +215,6 @@ err_cooling_destroy:
 
 void ath10k_thermal_unregister(struct ath10k *ar)
 {
-       thermal_cooling_device_unregister(ar->thermal.cdev);
        sysfs_remove_link(&ar->dev->kobj, "cooling_device");
+       thermal_cooling_device_unregister(ar->thermal.cdev);
 }