ideapad-laptop.c 8.9 KB
Newer Older
D
David Woodhouse 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36
/*
 *  ideapad_acpi.c - Lenovo IdeaPad ACPI Extras
 *
 *  Copyright © 2010 Intel Corporation
 *  Copyright © 2010 David Woodhouse <dwmw2@infradead.org>
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, write to the Free Software
 *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
 *  02110-1301, USA.
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/types.h>
#include <acpi/acpi_bus.h>
#include <acpi/acpi_drivers.h>
#include <linux/rfkill.h>

#define IDEAPAD_DEV_CAMERA	0
#define IDEAPAD_DEV_WLAN	1
#define IDEAPAD_DEV_BLUETOOTH	2
#define IDEAPAD_DEV_3G		3
#define IDEAPAD_DEV_KILLSW	4

37
struct ideapad_private {
38
	acpi_handle handle;
39
	struct rfkill *rfk[5];
I
Ike Panhc 已提交
40
} *ideapad_priv;
41 42 43

static struct {
	char *name;
44
	int cfgbit;
I
Ike Panhc 已提交
45
	int opcode;
46 47
	int type;
} ideapad_rfk_data[] = {
I
Ike Panhc 已提交
48 49 50 51 52
	{ "ideapad_camera",	19, 0x1E, NUM_RFKILL_TYPES },
	{ "ideapad_wlan",	18, 0x15, RFKILL_TYPE_WLAN },
	{ "ideapad_bluetooth",	16, 0x17, RFKILL_TYPE_BLUETOOTH },
	{ "ideapad_3g",		17, 0x20, RFKILL_TYPE_WWAN },
	{ "ideapad_killsw",	0,  0,    RFKILL_TYPE_WLAN }
D
David Woodhouse 已提交
53 54
};

I
Ike Panhc 已提交
55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163
/*
 * 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;
	unsigned long long result;

	status = acpi_evaluate_integer(handle, (char *)method, NULL, &result);
	if (ACPI_FAILURE(status)) {
		*val = -1;
		return -1;
	} else {
		*val = result;
		return 0;
	}
}

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);

	if (ACPI_FAILURE(status)) {
		*ret = -1;
		return -1;
	} else {
		*ret = result;
		return 0;
	}
}

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;
		}
	}
	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 */

D
David Woodhouse 已提交
164 165 166 167
static ssize_t show_ideapad_cam(struct device *dev,
				struct device_attribute *attr,
				char *buf)
{
168 169 170
	struct ideapad_private *priv = dev_get_drvdata(dev);
	acpi_handle handle = priv->handle;
	unsigned long result;
D
David Woodhouse 已提交
171

172 173 174
	if (read_ec_data(handle, 0x1D, &result))
		return sprintf(buf, "-1\n");
	return sprintf(buf, "%lu\n", result);
D
David Woodhouse 已提交
175 176 177 178 179 180
}

static ssize_t store_ideapad_cam(struct device *dev,
				 struct device_attribute *attr,
				 const char *buf, size_t count)
{
181 182
	struct ideapad_private *priv = dev_get_drvdata(dev);
	acpi_handle handle = priv->handle;
D
David Woodhouse 已提交
183 184 185 186 187 188
	int ret, state;

	if (!count)
		return 0;
	if (sscanf(buf, "%i", &state) != 1)
		return -EINVAL;
189
	ret = write_ec_cmd(handle, 0x1E, state);
D
David Woodhouse 已提交
190 191 192 193 194 195 196 197 198 199 200 201 202
	if (ret < 0)
		return ret;
	return count;
}

static DEVICE_ATTR(camera_power, 0644, show_ideapad_cam, store_ideapad_cam);

static int ideapad_rfk_set(void *data, bool blocked)
{
	int device = (unsigned long)data;

	if (device == IDEAPAD_DEV_KILLSW)
		return -EINVAL;
I
Ike Panhc 已提交
203 204 205 206

	return write_ec_cmd(ideapad_priv->handle,
			    ideapad_rfk_data[device].opcode,
			    !blocked);
D
David Woodhouse 已提交
207 208 209 210 211 212
}

static struct rfkill_ops ideapad_rfk_ops = {
	.set_block = ideapad_rfk_set,
};

213
static void ideapad_sync_rfk_state(struct acpi_device *adevice)
D
David Woodhouse 已提交
214
{
215
	struct ideapad_private *priv = dev_get_drvdata(&adevice->dev);
I
Ike Panhc 已提交
216 217
	acpi_handle handle = priv->handle;
	unsigned long hw_blocked;
D
David Woodhouse 已提交
218 219
	int i;

I
Ike Panhc 已提交
220
	if (read_ec_data(handle, 0x23, &hw_blocked))
D
David Woodhouse 已提交
221
		return;
I
Ike Panhc 已提交
222
	hw_blocked = !hw_blocked;
D
David Woodhouse 已提交
223

I
Ike Panhc 已提交
224
	for (i = IDEAPAD_DEV_WLAN; i <= IDEAPAD_DEV_KILLSW; i++)
225
		if (priv->rfk[i])
I
Ike Panhc 已提交
226
			rfkill_set_hw_state(priv->rfk[i], hw_blocked);
D
David Woodhouse 已提交
227 228
}

229
static int ideapad_register_rfkill(struct acpi_device *adevice, int dev)
D
David Woodhouse 已提交
230
{
231
	struct ideapad_private *priv = dev_get_drvdata(&adevice->dev);
D
David Woodhouse 已提交
232
	int ret;
I
Ike Panhc 已提交
233
	unsigned long sw_blocked;
D
David Woodhouse 已提交
234

I
Ike Panhc 已提交
235 236
	priv->rfk[dev] = rfkill_alloc(ideapad_rfk_data[dev].name, &adevice->dev,
				      ideapad_rfk_data[dev].type, &ideapad_rfk_ops,
237 238
				      (void *)(long)dev);
	if (!priv->rfk[dev])
D
David Woodhouse 已提交
239 240
		return -ENOMEM;

I
Ike Panhc 已提交
241 242 243 244 245 246 247 248
	if (read_ec_data(ideapad_priv->handle, ideapad_rfk_data[dev].opcode-1,
			 &sw_blocked)) {
		rfkill_init_sw_state(priv->rfk[dev], 0);
	} else {
		sw_blocked = !sw_blocked;
		rfkill_init_sw_state(priv->rfk[dev], sw_blocked);
	}

249
	ret = rfkill_register(priv->rfk[dev]);
D
David Woodhouse 已提交
250
	if (ret) {
251
		rfkill_destroy(priv->rfk[dev]);
D
David Woodhouse 已提交
252 253 254 255 256
		return ret;
	}
	return 0;
}

257
static void ideapad_unregister_rfkill(struct acpi_device *adevice, int dev)
D
David Woodhouse 已提交
258
{
259 260 261
	struct ideapad_private *priv = dev_get_drvdata(&adevice->dev);

	if (!priv->rfk[dev])
D
David Woodhouse 已提交
262 263
		return;

264 265
	rfkill_unregister(priv->rfk[dev]);
	rfkill_destroy(priv->rfk[dev]);
D
David Woodhouse 已提交
266 267 268 269 270 271 272 273
}

static const struct acpi_device_id ideapad_device_ids[] = {
	{ "VPC2004", 0},
	{ "", 0},
};
MODULE_DEVICE_TABLE(acpi, ideapad_device_ids);

274
static int ideapad_acpi_add(struct acpi_device *adevice)
D
David Woodhouse 已提交
275
{
276
	int i, cfg;
D
David Woodhouse 已提交
277
	int devs_present[5];
278
	struct ideapad_private *priv;
D
David Woodhouse 已提交
279

280 281 282
	if (read_method_int(adevice->handle, "_CFG", &cfg))
		return -ENODEV;

D
David Woodhouse 已提交
283
	for (i = IDEAPAD_DEV_CAMERA; i < IDEAPAD_DEV_KILLSW; i++) {
284 285 286 287
		if (test_bit(ideapad_rfk_data[i].cfgbit, (unsigned long *)&cfg))
			devs_present[i] = 1;
		else
			devs_present[i] = 0;
D
David Woodhouse 已提交
288 289 290 291 292
	}

	/* The hardware switch is always present */
	devs_present[IDEAPAD_DEV_KILLSW] = 1;

293 294 295 296
	priv = kzalloc(sizeof(*priv), GFP_KERNEL);
	if (!priv)
		return -ENOMEM;

D
David Woodhouse 已提交
297
	if (devs_present[IDEAPAD_DEV_CAMERA]) {
298 299 300
		int ret = device_create_file(&adevice->dev, &dev_attr_camera_power);
		if (ret) {
			kfree(priv);
D
David Woodhouse 已提交
301
			return ret;
302
		}
D
David Woodhouse 已提交
303 304
	}

305
	priv->handle = adevice->handle;
306
	dev_set_drvdata(&adevice->dev, priv);
I
Ike Panhc 已提交
307
	ideapad_priv = priv;
D
David Woodhouse 已提交
308 309 310 311
	for (i = IDEAPAD_DEV_WLAN; i <= IDEAPAD_DEV_KILLSW; i++) {
		if (!devs_present[i])
			continue;

312
		ideapad_register_rfkill(adevice, i);
D
David Woodhouse 已提交
313
	}
314
	ideapad_sync_rfk_state(adevice);
D
David Woodhouse 已提交
315 316 317
	return 0;
}

318
static int ideapad_acpi_remove(struct acpi_device *adevice, int type)
D
David Woodhouse 已提交
319
{
320
	struct ideapad_private *priv = dev_get_drvdata(&adevice->dev);
D
David Woodhouse 已提交
321
	int i;
322 323 324 325 326 327 328 329

	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);
D
David Woodhouse 已提交
330 331 332
	return 0;
}

333
static void ideapad_acpi_notify(struct acpi_device *adevice, u32 event)
D
David Woodhouse 已提交
334
{
335 336 337 338 339 340 341 342 343 344 345 346 347 348 349
	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);
		}
	}
D
David Woodhouse 已提交
350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382
}

static struct acpi_driver ideapad_acpi_driver = {
	.name = "ideapad_acpi",
	.class = "IdeaPad",
	.ids = ideapad_device_ids,
	.ops.add = ideapad_acpi_add,
	.ops.remove = ideapad_acpi_remove,
	.ops.notify = ideapad_acpi_notify,
	.owner = THIS_MODULE,
};


static int __init ideapad_acpi_module_init(void)
{
	acpi_bus_register_driver(&ideapad_acpi_driver);

	return 0;
}


static void __exit ideapad_acpi_module_exit(void)
{
	acpi_bus_unregister_driver(&ideapad_acpi_driver);

}

MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>");
MODULE_DESCRIPTION("IdeaPad ACPI Extras");
MODULE_LICENSE("GPL");

module_init(ideapad_acpi_module_init);
module_exit(ideapad_acpi_module_exit);