Merge remote-tracking branch 'drivers-x86/for-next'
authorStephen Rothwell <sfr@canb.auug.org.au>
Tue, 13 Sep 2016 02:33:09 +0000 (12:33 +1000)
committerStephen Rothwell <sfr@canb.auug.org.au>
Tue, 13 Sep 2016 02:33:09 +0000 (12:33 +1000)
drivers/platform/x86/toshiba_acpi.c

index 9d60a40d8b3fbd63a326271305a61c6f6675825a..074bf2fa1c550933651e1ef899bd932c38abfb88 100644 (file)
@@ -321,10 +321,9 @@ static int write_acpi_int(const char *methodName, int val)
 static acpi_status tci_raw(struct toshiba_acpi_dev *dev,
                           const u32 in[TCI_WORDS], u32 out[TCI_WORDS])
 {
+       union acpi_object in_objs[TCI_WORDS], out_objs[TCI_WORDS + 1];
        struct acpi_object_list params;
-       union acpi_object in_objs[TCI_WORDS];
        struct acpi_buffer results;
-       union acpi_object out_objs[TCI_WORDS + 1];
        acpi_status status;
        int i;
 
@@ -387,9 +386,8 @@ static int sci_open(struct toshiba_acpi_dev *dev)
 {
        u32 in[TCI_WORDS] = { SCI_OPEN, 0, 0, 0, 0, 0 };
        u32 out[TCI_WORDS];
-       acpi_status status;
+       acpi_status status = tci_raw(dev, in, out);
 
-       status = tci_raw(dev, in, out);
        if  (ACPI_FAILURE(status)) {
                pr_err("ACPI call to open SCI failed\n");
                return 0;
@@ -425,9 +423,8 @@ static void sci_close(struct toshiba_acpi_dev *dev)
 {
        u32 in[TCI_WORDS] = { SCI_CLOSE, 0, 0, 0, 0, 0 };
        u32 out[TCI_WORDS];
-       acpi_status status;
+       acpi_status status = tci_raw(dev, in, out);
 
-       status = tci_raw(dev, in, out);
        if (ACPI_FAILURE(status)) {
                pr_err("ACPI call to close SCI failed\n");
                return;
@@ -479,10 +476,15 @@ static void toshiba_illumination_available(struct toshiba_acpi_dev *dev)
 
        status = tci_raw(dev, in, out);
        sci_close(dev);
-       if (ACPI_FAILURE(status))
+       if (ACPI_FAILURE(status)) {
                pr_err("ACPI call to query Illumination support failed\n");
-       else if (out[0] == TOS_SUCCESS)
-               dev->illumination_supported = 1;
+               return;
+       }
+
+       if (out[0] != TOS_SUCCESS)
+               return;
+
+       dev->illumination_supported = 1;
 }
 
 static void toshiba_illumination_set(struct led_classdev *cdev,
@@ -509,7 +511,8 @@ static enum led_brightness toshiba_illumination_get(struct led_classdev *cdev)
 {
        struct toshiba_acpi_dev *dev = container_of(cdev,
                        struct toshiba_acpi_dev, led_dev);
-       u32 state, result;
+       u32 result;
+       u32 state;
 
        /* First request : initialize communication. */
        if (!sci_open(dev))
@@ -546,24 +549,28 @@ static void toshiba_kbd_illum_available(struct toshiba_acpi_dev *dev)
        sci_close(dev);
        if (ACPI_FAILURE(status)) {
                pr_err("ACPI call to query kbd illumination support failed\n");
-       } else if (out[0] == TOS_SUCCESS) {
-               /*
-                * Check for keyboard backlight timeout max value,
-                * previous kbd backlight implementation set this to
-                * 0x3c0003, and now the new implementation set this
-                * to 0x3c001a, use this to distinguish between them.
-                */
-               if (out[3] == SCI_KBD_TIME_MAX)
-                       dev->kbd_type = 2;
-               else
-                       dev->kbd_type = 1;
-               /* Get the current keyboard backlight mode */
-               dev->kbd_mode = out[2] & SCI_KBD_MODE_MASK;
-               /* Get the current time (1-60 seconds) */
-               dev->kbd_time = out[2] >> HCI_MISC_SHIFT;
-               /* Flag as supported */
-               dev->kbd_illum_supported = 1;
+               return;
        }
+
+       if (out[0] != TOS_SUCCESS)
+               return;
+
+       /*
+        * Check for keyboard backlight timeout max value,
+        * previous kbd backlight implementation set this to
+        * 0x3c0003, and now the new implementation set this
+        * to 0x3c001a, use this to distinguish between them.
+        */
+       if (out[3] == SCI_KBD_TIME_MAX)
+               dev->kbd_type = 2;
+       else
+               dev->kbd_type = 1;
+       /* Get the current keyboard backlight mode */
+       dev->kbd_mode = out[2] & SCI_KBD_MODE_MASK;
+       /* Get the current time (1-60 seconds) */
+       dev->kbd_time = out[2] >> HCI_MISC_SHIFT;
+       /* Flag as supported */
+       dev->kbd_illum_supported = 1;
 }
 
 static int toshiba_kbd_illum_status_set(struct toshiba_acpi_dev *dev, u32 time)
@@ -672,9 +679,9 @@ static int toshiba_touchpad_get(struct toshiba_acpi_dev *dev, u32 *state)
 /* Eco Mode support */
 static void toshiba_eco_mode_available(struct toshiba_acpi_dev *dev)
 {
-       acpi_status status;
        u32 in[TCI_WORDS] = { HCI_GET, HCI_ECO_MODE, 0, 0, 0, 0 };
        u32 out[TCI_WORDS];
+       acpi_status status;
 
        dev->eco_supported = 0;
        dev->eco_led_registered = false;
@@ -682,7 +689,10 @@ static void toshiba_eco_mode_available(struct toshiba_acpi_dev *dev)
        status = tci_raw(dev, in, out);
        if (ACPI_FAILURE(status)) {
                pr_err("ACPI call to get ECO led failed\n");
-       } else if (out[0] == TOS_INPUT_DATA_ERROR) {
+               return;
+       }
+
+       if (out[0] == TOS_INPUT_DATA_ERROR) {
                /*
                 * If we receive 0x8300 (Input Data Error), it means that the
                 * LED device is present, but that we just screwed the input
@@ -694,10 +704,15 @@ static void toshiba_eco_mode_available(struct toshiba_acpi_dev *dev)
                 */
                in[3] = 1;
                status = tci_raw(dev, in, out);
-               if (ACPI_FAILURE(status))
+               if (ACPI_FAILURE(status)) {
                        pr_err("ACPI call to get ECO led failed\n");
-               else if (out[0] == TOS_SUCCESS)
-                       dev->eco_supported = 1;
+                       return;
+               }
+
+               if (out[0] != TOS_SUCCESS)
+                       return;
+
+               dev->eco_supported = 1;
        }
 }
 
@@ -714,10 +729,11 @@ toshiba_eco_mode_get_status(struct led_classdev *cdev)
        if (ACPI_FAILURE(status)) {
                pr_err("ACPI call to get ECO led failed\n");
                return LED_OFF;
-       } else if (out[0] != TOS_SUCCESS) {
-               return LED_OFF;
        }
 
+       if (out[0] != TOS_SUCCESS)
+               return LED_OFF;
+
        return out[2] ? LED_FULL : LED_OFF;
 }
 
@@ -751,10 +767,15 @@ static void toshiba_accelerometer_available(struct toshiba_acpi_dev *dev)
         * this call also serves as initialization
         */
        status = tci_raw(dev, in, out);
-       if (ACPI_FAILURE(status))
+       if (ACPI_FAILURE(status)) {
                pr_err("ACPI call to query the accelerometer failed\n");
-       else if (out[0] == TOS_SUCCESS)
-               dev->accelerometer_supported = 1;
+               return;
+       }
+
+       if (out[0] != TOS_SUCCESS)
+               return;
+
+       dev->accelerometer_supported = 1;
 }
 
 static int toshiba_accelerometer_get(struct toshiba_acpi_dev *dev,
@@ -769,15 +790,18 @@ static int toshiba_accelerometer_get(struct toshiba_acpi_dev *dev,
        if (ACPI_FAILURE(status)) {
                pr_err("ACPI call to query the accelerometer failed\n");
                return -EIO;
-       } else if (out[0] == TOS_NOT_SUPPORTED) {
-               return -ENODEV;
-       } else if (out[0] == TOS_SUCCESS) {
-               *xy = out[2];
-               *z = out[4];
-               return 0;
        }
 
-       return -EIO;
+       if (out[0] == TOS_NOT_SUPPORTED)
+               return -ENODEV;
+
+       if (out[0] != TOS_SUCCESS)
+               return -EIO;
+
+       *xy = out[2];
+       *z = out[4];
+
+       return 0;
 }
 
 /* Sleep (Charge and Music) utilities support */
@@ -797,24 +821,29 @@ static void toshiba_usb_sleep_charge_available(struct toshiba_acpi_dev *dev)
                pr_err("ACPI call to get USB Sleep and Charge mode failed\n");
                sci_close(dev);
                return;
-       } else if (out[0] == TOS_NOT_SUPPORTED) {
+       }
+
+       if (out[0] != TOS_SUCCESS) {
                sci_close(dev);
                return;
-       } else if (out[0] == TOS_SUCCESS) {
-               dev->usbsc_mode_base = out[4];
        }
 
+       dev->usbsc_mode_base = out[4];
+
        in[5] = SCI_USB_CHARGE_BAT_LVL;
        status = tci_raw(dev, in, out);
        sci_close(dev);
        if (ACPI_FAILURE(status)) {
                pr_err("ACPI call to get USB Sleep and Charge mode failed\n");
-       } else if (out[0] == TOS_SUCCESS) {
-               dev->usbsc_bat_level = out[2];
-               /* Flag as supported */
-               dev->usb_sleep_charge_supported = 1;
+               return;
        }
 
+       if (out[0] != TOS_SUCCESS)
+               return;
+
+       dev->usbsc_bat_level = out[2];
+       /* Flag as supported */
+       dev->usb_sleep_charge_supported = 1;
 }
 
 static int toshiba_usb_sleep_charge_get(struct toshiba_acpi_dev *dev,
@@ -868,14 +897,19 @@ static int toshiba_sleep_functions_status_get(struct toshiba_acpi_dev *dev,
        sci_close(dev);
        if (ACPI_FAILURE(status)) {
                pr_err("ACPI call to get USB S&C battery level failed\n");
-       } else if (out[0] == TOS_NOT_SUPPORTED) {
-               return -ENODEV;
-       } else if (out[0] == TOS_SUCCESS) {
-               *mode = out[2];
-               return 0;
+               return -EIO;
        }
 
-       return -EIO;
+       if (out[0] == TOS_NOT_SUPPORTED)
+               return -ENODEV;
+
+       if (out[0] != TOS_SUCCESS)
+               return -EIO;
+
+       *mode = out[2];
+
+       return 0;
+
 }
 
 static int toshiba_sleep_functions_status_set(struct toshiba_acpi_dev *dev,
@@ -892,9 +926,12 @@ static int toshiba_sleep_functions_status_set(struct toshiba_acpi_dev *dev,
        in[5] = SCI_USB_CHARGE_BAT_LVL;
        status = tci_raw(dev, in, out);
        sci_close(dev);
-       if (ACPI_FAILURE(status))
+       if (ACPI_FAILURE(status)) {
                pr_err("ACPI call to set USB S&C battery level failed\n");
-       else if (out[0] == TOS_NOT_SUPPORTED)
+               return -EIO;
+       }
+
+       if (out[0] == TOS_NOT_SUPPORTED)
                return -ENODEV;
 
        return out[0] == TOS_SUCCESS ? 0 : -EIO;
@@ -915,14 +952,18 @@ static int toshiba_usb_rapid_charge_get(struct toshiba_acpi_dev *dev,
        sci_close(dev);
        if (ACPI_FAILURE(status)) {
                pr_err("ACPI call to get USB Rapid Charge failed\n");
-       } else if (out[0] == TOS_NOT_SUPPORTED) {
-               return -ENODEV;
-       } else if (out[0] == TOS_SUCCESS || out[0] == TOS_SUCCESS2) {
-               *state = out[2];
-               return 0;
+               return -EIO;
        }
 
-       return -EIO;
+       if (out[0] == TOS_NOT_SUPPORTED)
+               return -ENODEV;
+
+       if (out[0] != TOS_SUCCESS && out[0] != TOS_SUCCESS2)
+               return -EIO;
+
+       *state = out[2];
+
+       return 0;
 }
 
 static int toshiba_usb_rapid_charge_set(struct toshiba_acpi_dev *dev,
@@ -939,9 +980,12 @@ static int toshiba_usb_rapid_charge_set(struct toshiba_acpi_dev *dev,
        in[5] = SCI_USB_CHARGE_RAPID_DSP;
        status = tci_raw(dev, in, out);
        sci_close(dev);
-       if (ACPI_FAILURE(status))
+       if (ACPI_FAILURE(status)) {
                pr_err("ACPI call to set USB Rapid Charge failed\n");
-       else if (out[0] == TOS_NOT_SUPPORTED)
+               return -EIO;
+       }
+
+       if (out[0] == TOS_NOT_SUPPORTED)
                return -ENODEV;
 
        return (out[0] == TOS_SUCCESS || out[0] == TOS_SUCCESS2) ? 0 : -EIO;
@@ -1097,14 +1141,18 @@ static int toshiba_hotkey_event_type_get(struct toshiba_acpi_dev *dev,
        status = tci_raw(dev, in, out);
        if (ACPI_FAILURE(status)) {
                pr_err("ACPI call to get System type failed\n");
-       } else if (out[0] == TOS_NOT_SUPPORTED) {
-               return -ENODEV;
-       } else if (out[0] == TOS_SUCCESS) {
-               *type = out[3];
-               return 0;
+               return -EIO;
        }
 
-       return -EIO;
+       if (out[0] == TOS_NOT_SUPPORTED)
+               return -ENODEV;
+
+       if (out[0] != TOS_SUCCESS)
+               return -EIO;
+
+       *type = out[3];
+
+       return 0;
 }
 
 /* Wireless status (RFKill, WLAN, BT, WWAN) */
@@ -1154,7 +1202,6 @@ static void toshiba_wwan_available(struct toshiba_acpi_dev *dev)
         */
        in[3] = HCI_WIRELESS_WWAN;
        status = tci_raw(dev, in, out);
-
        if (ACPI_FAILURE(status)) {
                pr_err("ACPI call to get WWAN status failed\n");
                return;
@@ -1174,7 +1221,6 @@ static int toshiba_wwan_set(struct toshiba_acpi_dev *dev, u32 state)
 
        in[3] = HCI_WIRELESS_WWAN_STATUS;
        status = tci_raw(dev, in, out);
-
        if (ACPI_FAILURE(status)) {
                pr_err("ACPI call to set WWAN status failed\n");
                return -EIO;
@@ -1193,7 +1239,6 @@ static int toshiba_wwan_set(struct toshiba_acpi_dev *dev, u32 state)
         */
        in[3] = HCI_WIRELESS_WWAN_POWER;
        status = tci_raw(dev, in, out);
-
        if (ACPI_FAILURE(status)) {
                pr_err("ACPI call to set WWAN power failed\n");
                return -EIO;
@@ -1216,8 +1261,10 @@ static void toshiba_cooling_method_available(struct toshiba_acpi_dev *dev)
        dev->max_cooling_method = 0;
 
        status = tci_raw(dev, in, out);
-       if (ACPI_FAILURE(status))
+       if (ACPI_FAILURE(status)) {
                pr_err("ACPI call to get Cooling Method failed\n");
+               return;
+       }
 
        if (out[0] != TOS_SUCCESS && out[0] != TOS_SUCCESS2)
                return;
@@ -1244,7 +1291,7 @@ static int toshiba_cooling_method_set(struct toshiba_acpi_dev *dev, u32 state)
        u32 result = hci_write(dev, HCI_COOLING_METHOD, state);
 
        if (result == TOS_FAILURE)
-               pr_err("ACPI call to get Cooling Method failed\n");
+               pr_err("ACPI call to set Cooling Method failed\n");
 
        if (result == TOS_NOT_SUPPORTED)
                return -ENODEV;
@@ -1282,9 +1329,9 @@ static struct proc_dir_entry *toshiba_proc_dir;
 /* LCD Brightness */
 static int __get_lcd_brightness(struct toshiba_acpi_dev *dev)
 {
+       int brightness = 0;
        u32 result;
        u32 value;
-       int brightness = 0;
 
        if (dev->tr_backlight_supported) {
                int ret = get_tr_backlight_status(dev, &value);
@@ -1301,10 +1348,10 @@ static int __get_lcd_brightness(struct toshiba_acpi_dev *dev)
                pr_err("ACPI call to get LCD Brightness failed\n");
        else if (result == TOS_NOT_SUPPORTED)
                return -ENODEV;
-       if (result == TOS_SUCCESS)
-               return brightness + (value >> HCI_LCD_BRIGHTNESS_SHIFT);
 
-       return -EIO;
+       return result == TOS_SUCCESS ?
+                       brightness + (value >> HCI_LCD_BRIGHTNESS_SHIFT) :
+                       -EIO;
 }
 
 static int get_lcd_brightness(struct backlight_device *bd)
@@ -1325,15 +1372,15 @@ static int lcd_proc_show(struct seq_file *m, void *v)
 
        levels = dev->backlight_dev->props.max_brightness + 1;
        value = get_lcd_brightness(dev->backlight_dev);
-       if (value >= 0) {
-               seq_printf(m, "brightness:              %d\n", value);
-               seq_printf(m, "brightness_levels:       %d\n", levels);
-               return 0;
+       if (value < 0) {
+               pr_err("Error reading LCD brightness\n");
+               return value;
        }
 
-       pr_err("Error reading LCD brightness\n");
+       seq_printf(m, "brightness:              %d\n", value);
+       seq_printf(m, "brightness_levels:       %d\n", levels);
 
-       return -EIO;
+       return 0;
 }
 
 static int lcd_proc_open(struct inode *inode, struct file *file)
@@ -1377,7 +1424,7 @@ static ssize_t lcd_proc_write(struct file *file, const char __user *buf,
        struct toshiba_acpi_dev *dev = PDE_DATA(file_inode(file));
        char cmd[42];
        size_t len;
-       int levels = dev->backlight_dev->props.max_brightness + 1;
+       int levels;
        int value;
 
        len = min(count, sizeof(cmd) - 1);
@@ -1385,6 +1432,7 @@ static ssize_t lcd_proc_write(struct file *file, const char __user *buf,
                return -EFAULT;
        cmd[len] = '\0';
 
+       levels = dev->backlight_dev->props.max_brightness + 1;
        if (sscanf(cmd, " brightness : %i", &value) != 1 &&
            value < 0 && value > levels)
                return -EINVAL;
@@ -1420,20 +1468,21 @@ static int get_video_status(struct toshiba_acpi_dev *dev, u32 *status)
 static int video_proc_show(struct seq_file *m, void *v)
 {
        struct toshiba_acpi_dev *dev = m->private;
+       int is_lcd, is_crt, is_tv;
        u32 value;
 
-       if (!get_video_status(dev, &value)) {
-               int is_lcd = (value & HCI_VIDEO_OUT_LCD) ? 1 : 0;
-               int is_crt = (value & HCI_VIDEO_OUT_CRT) ? 1 : 0;
-               int is_tv = (value & HCI_VIDEO_OUT_TV) ? 1 : 0;
+       if (get_video_status(dev, &value))
+               return -EIO;
 
-               seq_printf(m, "lcd_out:                 %d\n", is_lcd);
-               seq_printf(m, "crt_out:                 %d\n", is_crt);
-               seq_printf(m, "tv_out:                  %d\n", is_tv);
-               return 0;
-       }
+       is_lcd = (value & HCI_VIDEO_OUT_LCD) ? 1 : 0;
+       is_crt = (value & HCI_VIDEO_OUT_CRT) ? 1 : 0;
+       is_tv = (value & HCI_VIDEO_OUT_TV) ? 1 : 0;
 
-       return -EIO;
+       seq_printf(m, "lcd_out:                 %d\n", is_lcd);
+       seq_printf(m, "crt_out:                 %d\n", is_crt);
+       seq_printf(m, "tv_out:                  %d\n", is_tv);
+
+       return 0;
 }
 
 static int video_proc_open(struct inode *inode, struct file *file)
@@ -1447,10 +1496,8 @@ static ssize_t video_proc_write(struct file *file, const char __user *buf,
        struct toshiba_acpi_dev *dev = PDE_DATA(file_inode(file));
        char *buffer;
        char *cmd;
+       int lcd_out, crt_out, tv_out;
        int remain = count;
-       int lcd_out = -1;
-       int crt_out = -1;
-       int tv_out = -1;
        int value;
        int ret;
        u32 video_out;
@@ -1486,6 +1533,7 @@ static ssize_t video_proc_write(struct file *file, const char __user *buf,
 
        kfree(cmd);
 
+       lcd_out = crt_out = tv_out = -1;
        ret = get_video_status(dev, &video_out);
        if (!ret) {
                unsigned int new_video_out = video_out;
@@ -1980,8 +2028,8 @@ static ssize_t usb_sleep_charge_store(struct device *dev,
                                      const char *buf, size_t count)
 {
        struct toshiba_acpi_dev *toshiba = dev_get_drvdata(dev);
-       u32 mode;
        int state;
+       u32 mode;
        int ret;
 
        ret = kstrtoint(buf, 0, &state);
@@ -2021,9 +2069,8 @@ static ssize_t sleep_functions_on_battery_show(struct device *dev,
                                               char *buf)
 {
        struct toshiba_acpi_dev *toshiba = dev_get_drvdata(dev);
+       int bat_lvl, status;
        u32 state;
-       int bat_lvl;
-       int status;
        int ret;
        int tmp;
 
This page took 0.03423 seconds and 5 git commands to generate.