ideapad: use EC command to control camera
[linux-2.6.git] / drivers / platform / x86 / ideapad_acpi.c
index ae744ca..e45fc50 100644 (file)
 #define IDEAPAD_DEV_3G         3
 #define IDEAPAD_DEV_KILLSW     4
 
-static struct rfkill *ideapad_rfkill[5];
-
-static const char *ideapad_rfk_names[] = {
-       "ideapad_camera", "ideapad_wlan", "ideapad_bluetooth", "ideapad_3g", "ideapad_rfkill"
+struct ideapad_private {
+       acpi_handle handle;
+       struct rfkill *rfk[5];
 };
-static const int ideapad_rfk_types[] = {
-       0, RFKILL_TYPE_WLAN, RFKILL_TYPE_BLUETOOTH, RFKILL_TYPE_WWAN, RFKILL_TYPE_WLAN
+
+static struct {
+       char *name;
+       int cfgbit;
+       int type;
+} ideapad_rfk_data[] = {
+       { "ideapad_camera",     19, NUM_RFKILL_TYPES },
+       { "ideapad_wlan",       18, RFKILL_TYPE_WLAN },
+       { "ideapad_bluetooth",  16, RFKILL_TYPE_BLUETOOTH },
+       { "ideapad_3g",         17, RFKILL_TYPE_WWAN },
+       { "ideapad_killsw",     0, RFKILL_TYPE_WLAN }
 };
 
-static int ideapad_dev_exists(int device)
+/*
+ * ACPI Helpers
+ */
+#define IDEAPAD_EC_TIMEOUT (100) /* in ms */
+
+static int read_method_int(acpi_handle handle, const char *method, int *val)
 {
        acpi_status status;
-       union acpi_object in_param;
-       struct acpi_object_list input = { 1, &in_param };
-       struct acpi_buffer output;
-       union acpi_object out_obj;
+       unsigned long long result;
 
-       output.length = sizeof(out_obj);
-       output.pointer = &out_obj;
+       status = acpi_evaluate_integer(handle, (char *)method, NULL, &result);
+       if (ACPI_FAILURE(status)) {
+               *val = -1;
+               return -1;
+       } else {
+               *val = result;
+               return 0;
+       }
+}
 
-       in_param.type = ACPI_TYPE_INTEGER;
-       in_param.integer.value = device + 1;
+static int method_vpcr(acpi_handle handle, int cmd, int *ret)
+{
+       acpi_status status;
+       unsigned long long result;
+       struct acpi_object_list params;
+       union acpi_object in_obj;
+
+       params.count = 1;
+       params.pointer = &in_obj;
+       in_obj.type = ACPI_TYPE_INTEGER;
+       in_obj.integer.value = cmd;
+
+       status = acpi_evaluate_integer(handle, "VPCR", &params, &result);
 
-       status = acpi_evaluate_object(NULL, "\\_SB_.DECN", &input, &output);
        if (ACPI_FAILURE(status)) {
-               printk(KERN_WARNING "IdeaPAD \\_SB_.DECN method failed %d. Is this an IdeaPAD?\n", status);
-               return -ENODEV;
+               *ret = -1;
+               return -1;
+       } else {
+               *ret = result;
+               return 0;
        }
-       if (out_obj.type != ACPI_TYPE_INTEGER) {
-               printk(KERN_WARNING "IdeaPAD \\_SB_.DECN method returned unexpected type\n");
-               return -ENODEV;
+}
+
+static int method_vpcw(acpi_handle handle, int cmd, int data)
+{
+       struct acpi_object_list params;
+       union acpi_object in_obj[2];
+       acpi_status status;
+
+       params.count = 2;
+       params.pointer = in_obj;
+       in_obj[0].type = ACPI_TYPE_INTEGER;
+       in_obj[0].integer.value = cmd;
+       in_obj[1].type = ACPI_TYPE_INTEGER;
+       in_obj[1].integer.value = data;
+
+       status = acpi_evaluate_object(handle, "VPCW", &params, NULL);
+       if (status != AE_OK)
+               return -1;
+       return 0;
+}
+
+static int read_ec_data(acpi_handle handle, int cmd, unsigned long *data)
+{
+       int val;
+       unsigned long int end_jiffies;
+
+       if (method_vpcw(handle, 1, cmd))
+               return -1;
+
+       for (end_jiffies = jiffies+(HZ)*IDEAPAD_EC_TIMEOUT/1000+1;
+            time_before(jiffies, end_jiffies);) {
+               schedule();
+               if (method_vpcr(handle, 1, &val))
+                       return -1;
+               if (val == 0) {
+                       if (method_vpcr(handle, 0, &val))
+                               return -1;
+                       *data = val;
+                       return 0;
+               }
        }
-       return out_obj.integer.value;
+       pr_err("timeout in read_ec_cmd\n");
+       return -1;
 }
 
+static int write_ec_cmd(acpi_handle handle, int cmd, unsigned long data)
+{
+       int val;
+       unsigned long int end_jiffies;
+
+       if (method_vpcw(handle, 0, data))
+               return -1;
+       if (method_vpcw(handle, 1, cmd))
+               return -1;
+
+       for (end_jiffies = jiffies+(HZ)*IDEAPAD_EC_TIMEOUT/1000+1;
+            time_before(jiffies, end_jiffies);) {
+               schedule();
+               if (method_vpcr(handle, 1, &val))
+                       return -1;
+               if (val == 0)
+                       return 0;
+       }
+       pr_err("timeout in write_ec_cmd\n");
+       return -1;
+}
+/* the above is ACPI helpers */
+
 static int ideapad_dev_get_state(int device)
 {
        acpi_status status;
@@ -117,24 +208,28 @@ static ssize_t show_ideapad_cam(struct device *dev,
                                struct device_attribute *attr,
                                char *buf)
 {
-       int state = ideapad_dev_get_state(IDEAPAD_DEV_CAMERA);
-       if (state < 0)
-               return state;
+       struct ideapad_private *priv = dev_get_drvdata(dev);
+       acpi_handle handle = priv->handle;
+       unsigned long result;
 
-       return sprintf(buf, "%d\n", state);
+       if (read_ec_data(handle, 0x1D, &result))
+               return sprintf(buf, "-1\n");
+       return sprintf(buf, "%lu\n", result);
 }
 
 static ssize_t store_ideapad_cam(struct device *dev,
                                 struct device_attribute *attr,
                                 const char *buf, size_t count)
 {
+       struct ideapad_private *priv = dev_get_drvdata(dev);
+       acpi_handle handle = priv->handle;
        int ret, state;
 
        if (!count)
                return 0;
        if (sscanf(buf, "%i", &state) != 1)
                return -EINVAL;
-       ret = ideapad_dev_set_state(IDEAPAD_DEV_CAMERA, state);
+       ret = write_ec_cmd(handle, 0x1E, state);
        if (ret < 0)
                return ret;
        return count;
@@ -155,48 +250,52 @@ static struct rfkill_ops ideapad_rfk_ops = {
        .set_block = ideapad_rfk_set,
 };
 
-static void ideapad_sync_rfk_state(void)
+static void ideapad_sync_rfk_state(struct acpi_device *adevice)
 {
+       struct ideapad_private *priv = dev_get_drvdata(&adevice->dev);
        int hw_blocked = !ideapad_dev_get_state(IDEAPAD_DEV_KILLSW);
        int i;
 
-       rfkill_set_hw_state(ideapad_rfkill[IDEAPAD_DEV_KILLSW], hw_blocked);
+       rfkill_set_hw_state(priv->rfk[IDEAPAD_DEV_KILLSW], hw_blocked);
        for (i = IDEAPAD_DEV_WLAN; i < IDEAPAD_DEV_KILLSW; i++)
-               if (ideapad_rfkill[i])
-                       rfkill_set_hw_state(ideapad_rfkill[i], hw_blocked);
+               if (priv->rfk[i])
+                       rfkill_set_hw_state(priv->rfk[i], hw_blocked);
        if (hw_blocked)
                return;
 
        for (i = IDEAPAD_DEV_WLAN; i < IDEAPAD_DEV_KILLSW; i++)
-               if (ideapad_rfkill[i])
-                       rfkill_set_sw_state(ideapad_rfkill[i], !ideapad_dev_get_state(i));
+               if (priv->rfk[i])
+                       rfkill_set_sw_state(priv->rfk[i], !ideapad_dev_get_state(i));
 }
 
-static int ideapad_register_rfkill(struct acpi_device *device, int dev)
+static int ideapad_register_rfkill(struct acpi_device *adevice, int dev)
 {
+       struct ideapad_private *priv = dev_get_drvdata(&adevice->dev);
        int ret;
 
-       ideapad_rfkill[dev] = rfkill_alloc(ideapad_rfk_names[dev], &device->dev,
-                                          ideapad_rfk_types[dev], &ideapad_rfk_ops,
-                                          (void *)(long)dev);
-       if (!ideapad_rfkill[dev])
+       priv->rfk[dev] = rfkill_alloc(ideapad_rfk_data[dev-1].name, &adevice->dev,
+                                     ideapad_rfk_data[dev-1].type, &ideapad_rfk_ops,
+                                     (void *)(long)dev);
+       if (!priv->rfk[dev])
                return -ENOMEM;
 
-       ret = rfkill_register(ideapad_rfkill[dev]);
+       ret = rfkill_register(priv->rfk[dev]);
        if (ret) {
-               rfkill_destroy(ideapad_rfkill[dev]);
+               rfkill_destroy(priv->rfk[dev]);
                return ret;
        }
        return 0;
 }
 
-static void ideapad_unregister_rfkill(int dev)
+static void ideapad_unregister_rfkill(struct acpi_device *adevice, int dev)
 {
-       if (!ideapad_rfkill[dev])
+       struct ideapad_private *priv = dev_get_drvdata(&adevice->dev);
+
+       if (!priv->rfk[dev])
                return;
 
-       rfkill_unregister(ideapad_rfkill[dev]);
-       rfkill_destroy(ideapad_rfkill[dev]);
+       rfkill_unregister(priv->rfk[dev]);
+       rfkill_destroy(priv->rfk[dev]);
 }
 
 static const struct acpi_device_id ideapad_device_ids[] = {
@@ -205,48 +304,81 @@ static const struct acpi_device_id ideapad_device_ids[] = {
 };
 MODULE_DEVICE_TABLE(acpi, ideapad_device_ids);
 
-static int ideapad_acpi_add(struct acpi_device *device)
+static int ideapad_acpi_add(struct acpi_device *adevice)
 {
-       int i;
+       int i, cfg;
        int devs_present[5];
+       struct ideapad_private *priv;
+
+       if (read_method_int(adevice->handle, "_CFG", &cfg))
+               return -ENODEV;
 
        for (i = IDEAPAD_DEV_CAMERA; i < IDEAPAD_DEV_KILLSW; i++) {
-               devs_present[i] = ideapad_dev_exists(i);
-               if (devs_present[i] < 0)
-                       return devs_present[i];
+               if (test_bit(ideapad_rfk_data[i].cfgbit, (unsigned long *)&cfg))
+                       devs_present[i] = 1;
+               else
+                       devs_present[i] = 0;
        }
 
        /* The hardware switch is always present */
        devs_present[IDEAPAD_DEV_KILLSW] = 1;
 
+       priv = kzalloc(sizeof(*priv), GFP_KERNEL);
+       if (!priv)
+               return -ENOMEM;
+
        if (devs_present[IDEAPAD_DEV_CAMERA]) {
-               int ret = device_create_file(&device->dev, &dev_attr_camera_power);
-               if (ret)
+               int ret = device_create_file(&adevice->dev, &dev_attr_camera_power);
+               if (ret) {
+                       kfree(priv);
                        return ret;
+               }
        }
 
+       priv->handle = adevice->handle;
+       dev_set_drvdata(&adevice->dev, priv);
        for (i = IDEAPAD_DEV_WLAN; i <= IDEAPAD_DEV_KILLSW; i++) {
                if (!devs_present[i])
                        continue;
 
-               ideapad_register_rfkill(device, i);
+               ideapad_register_rfkill(adevice, i);
        }
-       ideapad_sync_rfk_state();
+       ideapad_sync_rfk_state(adevice);
        return 0;
 }
 
-static int ideapad_acpi_remove(struct acpi_device *device, int type)
+static int ideapad_acpi_remove(struct acpi_device *adevice, int type)
 {
+       struct ideapad_private *priv = dev_get_drvdata(&adevice->dev);
        int i;
-       device_remove_file(&device->dev, &dev_attr_camera_power);
-       for (i = 0; i < 5; i++)
-               ideapad_unregister_rfkill(i);
+
+       device_remove_file(&adevice->dev, &dev_attr_camera_power);
+
+       for (i = IDEAPAD_DEV_WLAN; i <= IDEAPAD_DEV_KILLSW; i++)
+               ideapad_unregister_rfkill(adevice, i);
+
+       dev_set_drvdata(&adevice->dev, NULL);
+       kfree(priv);
        return 0;
 }
 
-static void ideapad_acpi_notify(struct acpi_device *device, u32 event)
+static void ideapad_acpi_notify(struct acpi_device *adevice, u32 event)
 {
-       ideapad_sync_rfk_state();
+       acpi_handle handle = adevice->handle;
+       unsigned long vpc1, vpc2, vpc_bit;
+
+       if (read_ec_data(handle, 0x10, &vpc1))
+               return;
+       if (read_ec_data(handle, 0x1A, &vpc2))
+               return;
+
+       vpc1 = (vpc2 << 8) | vpc1;
+       for (vpc_bit = 0; vpc_bit < 16; vpc_bit++) {
+               if (test_bit(vpc_bit, &vpc1)) {
+                       if (vpc_bit == 9)
+                               ideapad_sync_rfk_state(adevice);
+               }
+       }
 }
 
 static struct acpi_driver ideapad_acpi_driver = {