video.c 57.9 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5
/*
 *  video.c - ACPI Video Driver ($Revision:$)
 *
 *  Copyright (C) 2004 Luming Yu <luming.yu@intel.com>
 *  Copyright (C) 2004 Bruno Ducrot <ducrot@poupinou.org>
6
 *  Copyright (C) 2006 Thomas Tuttle <linux-kernel@ttuttle.net>
L
Linus Torvalds 已提交
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
 *
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 *
 *  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.,
 *  59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
 *
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/types.h>
#include <linux/list.h>
32
#include <linux/mutex.h>
L
Linus Torvalds 已提交
33 34
#include <linux/proc_fs.h>
#include <linux/seq_file.h>
35
#include <linux/input.h>
36
#include <linux/backlight.h>
37
#include <linux/thermal.h>
38
#include <linux/video_output.h>
39
#include <linux/sort.h>
40 41
#include <linux/pci.h>
#include <linux/pci_ids.h>
L
Linus Torvalds 已提交
42 43 44 45 46 47 48 49 50 51 52 53 54 55
#include <asm/uaccess.h>

#include <acpi/acpi_bus.h>
#include <acpi/acpi_drivers.h>

#define ACPI_VIDEO_CLASS		"video"
#define ACPI_VIDEO_BUS_NAME		"Video Bus"
#define ACPI_VIDEO_DEVICE_NAME		"Video Device"
#define ACPI_VIDEO_NOTIFY_SWITCH	0x80
#define ACPI_VIDEO_NOTIFY_PROBE		0x81
#define ACPI_VIDEO_NOTIFY_CYCLE		0x82
#define ACPI_VIDEO_NOTIFY_NEXT_OUTPUT	0x83
#define ACPI_VIDEO_NOTIFY_PREV_OUTPUT	0x84

56 57 58 59 60
#define ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS	0x85
#define	ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS	0x86
#define ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS	0x87
#define ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS	0x88
#define ACPI_VIDEO_NOTIFY_DISPLAY_OFF		0x89
L
Linus Torvalds 已提交
61

62
#define MAX_NAME_LEN	20
L
Linus Torvalds 已提交
63

64 65 66 67 68
#define ACPI_VIDEO_DISPLAY_CRT	1
#define ACPI_VIDEO_DISPLAY_TV	2
#define ACPI_VIDEO_DISPLAY_DVI	3
#define ACPI_VIDEO_DISPLAY_LCD	4

L
Linus Torvalds 已提交
69
#define _COMPONENT		ACPI_VIDEO_COMPONENT
70
ACPI_MODULE_NAME("video");
L
Linus Torvalds 已提交
71

72
MODULE_AUTHOR("Bruno Ducrot");
73
MODULE_DESCRIPTION("ACPI Video Driver");
L
Linus Torvalds 已提交
74 75
MODULE_LICENSE("GPL");

76 77 78
static int brightness_switch_enabled = 1;
module_param(brightness_switch_enabled, bool, 0644);

L
Len Brown 已提交
79 80
static int acpi_video_bus_add(struct acpi_device *device);
static int acpi_video_bus_remove(struct acpi_device *device, int type);
81
static int acpi_video_resume(struct acpi_device *device);
82
static void acpi_video_bus_notify(struct acpi_device *device, u32 event);
L
Linus Torvalds 已提交
83

84 85 86 87 88 89
static const struct acpi_device_id video_device_ids[] = {
	{ACPI_VIDEO_HID, 0},
	{"", 0},
};
MODULE_DEVICE_TABLE(acpi, video_device_ids);

L
Linus Torvalds 已提交
90
static struct acpi_driver acpi_video_bus = {
L
Len Brown 已提交
91
	.name = "video",
L
Linus Torvalds 已提交
92
	.class = ACPI_VIDEO_CLASS,
93
	.ids = video_device_ids,
L
Linus Torvalds 已提交
94 95 96
	.ops = {
		.add = acpi_video_bus_add,
		.remove = acpi_video_bus_remove,
97
		.resume = acpi_video_resume,
98
		.notify = acpi_video_bus_notify,
L
Len Brown 已提交
99
		},
L
Linus Torvalds 已提交
100 101 102
};

struct acpi_video_bus_flags {
L
Len Brown 已提交
103 104 105 106
	u8 multihead:1;		/* can switch video heads */
	u8 rom:1;		/* can retrieve a video rom */
	u8 post:1;		/* can configure the head to */
	u8 reserved:5;
L
Linus Torvalds 已提交
107 108 109
};

struct acpi_video_bus_cap {
L
Len Brown 已提交
110 111 112 113 114 115 116
	u8 _DOS:1;		/*Enable/Disable output switching */
	u8 _DOD:1;		/*Enumerate all devices attached to display adapter */
	u8 _ROM:1;		/*Get ROM Data */
	u8 _GPD:1;		/*Get POST Device */
	u8 _SPD:1;		/*Set POST Device */
	u8 _VPO:1;		/*Video POST Options */
	u8 reserved:2;
L
Linus Torvalds 已提交
117 118
};

L
Len Brown 已提交
119 120
struct acpi_video_device_attrib {
	u32 display_index:4;	/* A zero-based instance of the Display */
121
	u32 display_port_attachment:4;	/*This field differentiates the display type */
L
Len Brown 已提交
122
	u32 display_type:4;	/*Describe the specific type in use */
123
	u32 vendor_specific:4;	/*Chipset Vendor Specific */
L
Len Brown 已提交
124 125 126 127 128 129
	u32 bios_can_detect:1;	/*BIOS can detect the device */
	u32 depend_on_vga:1;	/*Non-VGA output device whose power is related to 
				   the VGA device. */
	u32 pipe_id:3;		/*For VGA multiple-head devices. */
	u32 reserved:10;	/*Must be 0 */
	u32 device_id_scheme:1;	/*Device ID Scheme */
L
Linus Torvalds 已提交
130 131 132 133 134
};

struct acpi_video_enumerated_device {
	union {
		u32 int_val;
L
Len Brown 已提交
135
		struct acpi_video_device_attrib attrib;
L
Linus Torvalds 已提交
136 137 138 139 140
	} value;
	struct acpi_video_device *bind_info;
};

struct acpi_video_bus {
141
	struct acpi_device *device;
L
Len Brown 已提交
142
	u8 dos_setting;
L
Linus Torvalds 已提交
143
	struct acpi_video_enumerated_device *attached_array;
L
Len Brown 已提交
144 145
	u8 attached_count;
	struct acpi_video_bus_cap cap;
L
Linus Torvalds 已提交
146
	struct acpi_video_bus_flags flags;
L
Len Brown 已提交
147
	struct list_head video_device_list;
148
	struct mutex device_list_lock;	/* protects video_device_list */
L
Len Brown 已提交
149
	struct proc_dir_entry *dir;
150 151
	struct input_dev *input;
	char phys[32];	/* for input device */
L
Linus Torvalds 已提交
152 153 154
};

struct acpi_video_device_flags {
L
Len Brown 已提交
155 156 157
	u8 crt:1;
	u8 lcd:1;
	u8 tvout:1;
158
	u8 dvi:1;
L
Len Brown 已提交
159 160
	u8 bios:1;
	u8 unknown:1;
161
	u8 reserved:2;
L
Linus Torvalds 已提交
162 163 164
};

struct acpi_video_device_cap {
L
Len Brown 已提交
165 166 167
	u8 _ADR:1;		/*Return the unique ID */
	u8 _BCL:1;		/*Query list of brightness control levels supported */
	u8 _BCM:1;		/*Set the brightness level */
168
	u8 _BQC:1;		/* Get current brightness level */
169
	u8 _BCQ:1;		/* Some buggy BIOS uses _BCQ instead of _BQC */
L
Len Brown 已提交
170 171 172 173
	u8 _DDC:1;		/*Return the EDID for this device */
	u8 _DCS:1;		/*Return status of output device */
	u8 _DGS:1;		/*Query graphics state */
	u8 _DSS:1;		/*Device state set */
L
Linus Torvalds 已提交
174 175
};

176 177
struct acpi_video_brightness_flags {
	u8 _BCL_no_ac_battery_levels:1;	/* no AC/Battery levels in _BCL */
178
	u8 _BCL_reversed:1;		/* _BCL package is in a reversed order*/
179 180 181
	u8 _BCL_use_index:1;		/* levels in _BCL are index values */
	u8 _BCM_use_index:1;		/* input of _BCM is an index value */
	u8 _BQC_use_index:1;		/* _BQC returns an index value */
182 183
};

L
Linus Torvalds 已提交
184
struct acpi_video_device_brightness {
L
Len Brown 已提交
185 186 187
	int curr;
	int count;
	int *levels;
188
	struct acpi_video_brightness_flags flags;
L
Linus Torvalds 已提交
189 190 191
};

struct acpi_video_device {
L
Len Brown 已提交
192 193 194 195 196 197
	unsigned long device_id;
	struct acpi_video_device_flags flags;
	struct acpi_video_device_cap cap;
	struct list_head entry;
	struct acpi_video_bus *video;
	struct acpi_device *dev;
L
Linus Torvalds 已提交
198
	struct acpi_video_device_brightness *brightness;
199
	struct backlight_device *backlight;
200
	struct thermal_cooling_device *cdev;
201
	struct output_device *output_dev;
L
Linus Torvalds 已提交
202 203 204 205
};

/* bus */
static int acpi_video_bus_info_open_fs(struct inode *inode, struct file *file);
J
Jan Engelhardt 已提交
206
static const struct file_operations acpi_video_bus_info_fops = {
207
	.owner = THIS_MODULE,
L
Len Brown 已提交
208 209 210 211
	.open = acpi_video_bus_info_open_fs,
	.read = seq_read,
	.llseek = seq_lseek,
	.release = single_release,
L
Linus Torvalds 已提交
212 213 214
};

static int acpi_video_bus_ROM_open_fs(struct inode *inode, struct file *file);
J
Jan Engelhardt 已提交
215
static const struct file_operations acpi_video_bus_ROM_fops = {
216
	.owner = THIS_MODULE,
L
Len Brown 已提交
217 218 219 220
	.open = acpi_video_bus_ROM_open_fs,
	.read = seq_read,
	.llseek = seq_lseek,
	.release = single_release,
L
Linus Torvalds 已提交
221 222
};

L
Len Brown 已提交
223 224
static int acpi_video_bus_POST_info_open_fs(struct inode *inode,
					    struct file *file);
J
Jan Engelhardt 已提交
225
static const struct file_operations acpi_video_bus_POST_info_fops = {
226
	.owner = THIS_MODULE,
L
Len Brown 已提交
227 228 229 230
	.open = acpi_video_bus_POST_info_open_fs,
	.read = seq_read,
	.llseek = seq_lseek,
	.release = single_release,
L
Linus Torvalds 已提交
231 232 233
};

static int acpi_video_bus_POST_open_fs(struct inode *inode, struct file *file);
L
Len Brown 已提交
234
static ssize_t acpi_video_bus_write_POST(struct file *file,
J
Jan Engelhardt 已提交
235 236
	const char __user *buffer, size_t count, loff_t *data);
static const struct file_operations acpi_video_bus_POST_fops = {
237
	.owner = THIS_MODULE,
L
Len Brown 已提交
238 239
	.open = acpi_video_bus_POST_open_fs,
	.read = seq_read,
J
Jan Engelhardt 已提交
240
	.write = acpi_video_bus_write_POST,
L
Len Brown 已提交
241 242
	.llseek = seq_lseek,
	.release = single_release,
L
Linus Torvalds 已提交
243 244 245
};

static int acpi_video_bus_DOS_open_fs(struct inode *inode, struct file *file);
L
Len Brown 已提交
246
static ssize_t acpi_video_bus_write_DOS(struct file *file,
J
Jan Engelhardt 已提交
247 248
	const char __user *buffer, size_t count, loff_t *data);
static const struct file_operations acpi_video_bus_DOS_fops = {
249
	.owner = THIS_MODULE,
L
Len Brown 已提交
250 251
	.open = acpi_video_bus_DOS_open_fs,
	.read = seq_read,
J
Jan Engelhardt 已提交
252
	.write = acpi_video_bus_write_DOS,
L
Len Brown 已提交
253 254
	.llseek = seq_lseek,
	.release = single_release,
L
Linus Torvalds 已提交
255 256 257
};

/* device */
L
Len Brown 已提交
258 259
static int acpi_video_device_info_open_fs(struct inode *inode,
					  struct file *file);
J
Jan Engelhardt 已提交
260
static const struct file_operations acpi_video_device_info_fops = {
261
	.owner = THIS_MODULE,
L
Len Brown 已提交
262 263 264 265
	.open = acpi_video_device_info_open_fs,
	.read = seq_read,
	.llseek = seq_lseek,
	.release = single_release,
L
Linus Torvalds 已提交
266 267
};

L
Len Brown 已提交
268 269
static int acpi_video_device_state_open_fs(struct inode *inode,
					   struct file *file);
L
Len Brown 已提交
270
static ssize_t acpi_video_device_write_state(struct file *file,
J
Jan Engelhardt 已提交
271 272
	const char __user *buffer, size_t count, loff_t *data);
static const struct file_operations acpi_video_device_state_fops = {
273
	.owner = THIS_MODULE,
L
Len Brown 已提交
274 275
	.open = acpi_video_device_state_open_fs,
	.read = seq_read,
J
Jan Engelhardt 已提交
276
	.write = acpi_video_device_write_state,
L
Len Brown 已提交
277 278
	.llseek = seq_lseek,
	.release = single_release,
L
Linus Torvalds 已提交
279 280
};

L
Len Brown 已提交
281 282
static int acpi_video_device_brightness_open_fs(struct inode *inode,
						struct file *file);
L
Len Brown 已提交
283
static ssize_t acpi_video_device_write_brightness(struct file *file,
J
Jan Engelhardt 已提交
284
	const char __user *buffer, size_t count, loff_t *data);
L
Linus Torvalds 已提交
285
static struct file_operations acpi_video_device_brightness_fops = {
286
	.owner = THIS_MODULE,
L
Len Brown 已提交
287 288
	.open = acpi_video_device_brightness_open_fs,
	.read = seq_read,
J
Jan Engelhardt 已提交
289
	.write = acpi_video_device_write_brightness,
L
Len Brown 已提交
290 291
	.llseek = seq_lseek,
	.release = single_release,
L
Linus Torvalds 已提交
292 293
};

L
Len Brown 已提交
294 295
static int acpi_video_device_EDID_open_fs(struct inode *inode,
					  struct file *file);
J
Jan Engelhardt 已提交
296
static const struct file_operations acpi_video_device_EDID_fops = {
297
	.owner = THIS_MODULE,
L
Len Brown 已提交
298 299 300 301
	.open = acpi_video_device_EDID_open_fs,
	.read = seq_read,
	.llseek = seq_lseek,
	.release = single_release,
L
Linus Torvalds 已提交
302 303
};

J
Jan Engelhardt 已提交
304
static const char device_decode[][30] = {
L
Linus Torvalds 已提交
305 306 307 308 309 310
	"motherboard VGA device",
	"PCI VGA device",
	"AGP VGA device",
	"UNKNOWN",
};

L
Len Brown 已提交
311 312 313 314
static void acpi_video_device_notify(acpi_handle handle, u32 event, void *data);
static void acpi_video_device_rebind(struct acpi_video_bus *video);
static void acpi_video_device_bind(struct acpi_video_bus *video,
				   struct acpi_video_device *device);
L
Linus Torvalds 已提交
315
static int acpi_video_device_enumerate(struct acpi_video_bus *video);
316 317 318 319
static int acpi_video_device_lcd_set_level(struct acpi_video_device *device,
			int level);
static int acpi_video_device_lcd_get_level_current(
			struct acpi_video_device *device,
320
			unsigned long long *level);
L
Len Brown 已提交
321 322
static int acpi_video_get_next_level(struct acpi_video_device *device,
				     u32 level_current, u32 event);
323
static int acpi_video_switch_brightness(struct acpi_video_device *device,
L
Len Brown 已提交
324
					 int event);
325
static int acpi_video_device_get_state(struct acpi_video_device *device,
326
			    unsigned long long *state);
327 328
static int acpi_video_output_get(struct output_device *od);
static int acpi_video_device_set_state(struct acpi_video_device *device, int state);
L
Linus Torvalds 已提交
329

330 331 332
/*backlight device sysfs support*/
static int acpi_video_get_brightness(struct backlight_device *bd)
{
333
	unsigned long long cur_level;
334
	int i;
335
	struct acpi_video_device *vd =
336
		(struct acpi_video_device *)bl_get_data(bd);
337 338 339

	if (acpi_video_device_lcd_get_level_current(vd, &cur_level))
		return -EINVAL;
340 341 342 343 344 345 346
	for (i = 2; i < vd->brightness->count; i++) {
		if (vd->brightness->levels[i] == cur_level)
			/* The first two entries are special - see page 575
			   of the ACPI spec 3.0 */
			return i-2;
	}
	return 0;
347 348 349 350
}

static int acpi_video_set_brightness(struct backlight_device *bd)
{
351
	int request_level = bd->props.brightness + 2;
352
	struct acpi_video_device *vd =
353
		(struct acpi_video_device *)bl_get_data(bd);
354 355 356

	return acpi_video_device_lcd_set_level(vd,
				vd->brightness->levels[request_level]);
357 358
}

359 360 361 362 363
static struct backlight_ops acpi_backlight_ops = {
	.get_brightness = acpi_video_get_brightness,
	.update_status  = acpi_video_set_brightness,
};

364 365 366
/*video output device sysfs support*/
static int acpi_video_output_get(struct output_device *od)
{
367
	unsigned long long state;
368
	struct acpi_video_device *vd =
369
		(struct acpi_video_device *)dev_get_drvdata(&od->dev);
370 371 372 373 374 375 376 377
	acpi_video_device_get_state(vd, &state);
	return (int)state;
}

static int acpi_video_output_set(struct output_device *od)
{
	unsigned long state = od->request_state;
	struct acpi_video_device *vd=
378
		(struct acpi_video_device *)dev_get_drvdata(&od->dev);
379 380 381 382 383 384 385
	return acpi_video_device_set_state(vd, state);
}

static struct output_properties acpi_output_properties = {
	.set_state = acpi_video_output_set,
	.get_status = acpi_video_output_get,
};
386 387 388


/* thermal cooling device callbacks */
389 390
static int video_get_max_state(struct thermal_cooling_device *cdev, unsigned
			       long *state)
391 392 393 394
{
	struct acpi_device *device = cdev->devdata;
	struct acpi_video_device *video = acpi_driver_data(device);

395 396
	*state = video->brightness->count - 3;
	return 0;
397 398
}

399 400
static int video_get_cur_state(struct thermal_cooling_device *cdev, unsigned
			       long *state)
401 402 403
{
	struct acpi_device *device = cdev->devdata;
	struct acpi_video_device *video = acpi_driver_data(device);
404
	unsigned long long level;
405
	int offset;
406

407 408
	if (acpi_video_device_lcd_get_level_current(video, &level))
		return -EINVAL;
409 410 411 412 413
	for (offset = 2; offset < video->brightness->count; offset++)
		if (level == video->brightness->levels[offset]) {
			*state = video->brightness->count - offset - 1;
			return 0;
		}
414 415 416 417 418

	return -EINVAL;
}

static int
419
video_set_cur_state(struct thermal_cooling_device *cdev, unsigned long state)
420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438
{
	struct acpi_device *device = cdev->devdata;
	struct acpi_video_device *video = acpi_driver_data(device);
	int level;

	if ( state >= video->brightness->count - 2)
		return -EINVAL;

	state = video->brightness->count - state;
	level = video->brightness->levels[state -1];
	return acpi_video_device_lcd_set_level(video, level);
}

static struct thermal_cooling_device_ops video_cooling_ops = {
	.get_max_state = video_get_max_state,
	.get_cur_state = video_get_cur_state,
	.set_cur_state = video_set_cur_state,
};

L
Linus Torvalds 已提交
439 440 441 442 443 444 445
/* --------------------------------------------------------------------------
                               Video Management
   -------------------------------------------------------------------------- */

/* device */

static int
446
acpi_video_device_query(struct acpi_video_device *device, unsigned long long *state)
L
Linus Torvalds 已提交
447
{
L
Len Brown 已提交
448
	int status;
449 450

	status = acpi_evaluate_integer(device->dev->handle, "_DGS", NULL, state);
L
Linus Torvalds 已提交
451

452
	return status;
L
Linus Torvalds 已提交
453 454 455
}

static int
L
Len Brown 已提交
456
acpi_video_device_get_state(struct acpi_video_device *device,
457
			    unsigned long long *state)
L
Linus Torvalds 已提交
458
{
L
Len Brown 已提交
459
	int status;
L
Linus Torvalds 已提交
460

461
	status = acpi_evaluate_integer(device->dev->handle, "_DCS", NULL, state);
L
Linus Torvalds 已提交
462

463
	return status;
L
Linus Torvalds 已提交
464 465 466
}

static int
L
Len Brown 已提交
467
acpi_video_device_set_state(struct acpi_video_device *device, int state)
L
Linus Torvalds 已提交
468
{
L
Len Brown 已提交
469 470 471
	int status;
	union acpi_object arg0 = { ACPI_TYPE_INTEGER };
	struct acpi_object_list args = { 1, &arg0 };
472
	unsigned long long ret;
L
Linus Torvalds 已提交
473 474 475


	arg0.integer.value = state;
476
	status = acpi_evaluate_integer(device->dev->handle, "_DSS", &args, &ret);
L
Linus Torvalds 已提交
477

478
	return status;
L
Linus Torvalds 已提交
479 480 481
}

static int
L
Len Brown 已提交
482 483
acpi_video_device_lcd_query_levels(struct acpi_video_device *device,
				   union acpi_object **levels)
L
Linus Torvalds 已提交
484
{
L
Len Brown 已提交
485 486 487
	int status;
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	union acpi_object *obj;
L
Linus Torvalds 已提交
488 489 490 491


	*levels = NULL;

492
	status = acpi_evaluate_object(device->dev->handle, "_BCL", NULL, &buffer);
L
Linus Torvalds 已提交
493
	if (!ACPI_SUCCESS(status))
494
		return status;
L
Len Brown 已提交
495
	obj = (union acpi_object *)buffer.pointer;
496
	if (!obj || (obj->type != ACPI_TYPE_PACKAGE)) {
497
		printk(KERN_ERR PREFIX "Invalid _BCL data\n");
L
Linus Torvalds 已提交
498 499 500 501 502 503
		status = -EFAULT;
		goto err;
	}

	*levels = obj;

504
	return 0;
L
Linus Torvalds 已提交
505

L
Len Brown 已提交
506
      err:
507
	kfree(buffer.pointer);
L
Linus Torvalds 已提交
508

509
	return status;
L
Linus Torvalds 已提交
510 511 512
}

static int
L
Len Brown 已提交
513
acpi_video_device_lcd_set_level(struct acpi_video_device *device, int level)
L
Linus Torvalds 已提交
514
{
515
	int status;
L
Len Brown 已提交
516 517
	union acpi_object arg0 = { ACPI_TYPE_INTEGER };
	struct acpi_object_list args = { 1, &arg0 };
518
	int state;
L
Linus Torvalds 已提交
519 520 521

	arg0.integer.value = level;

522 523 524 525 526 527 528
	status = acpi_evaluate_object(device->dev->handle, "_BCM",
				      &args, NULL);
	if (ACPI_FAILURE(status)) {
		ACPI_ERROR((AE_INFO, "Evaluating _BCM failed"));
		return -EIO;
	}

529
	device->brightness->curr = level;
530
	for (state = 2; state < device->brightness->count; state++)
531
		if (level == device->brightness->levels[state]) {
532 533
			if (device->backlight)
				device->backlight->props.brightness = state - 2;
534 535
			return 0;
		}
536

537 538
	ACPI_ERROR((AE_INFO, "Current brightness invalid"));
	return -EINVAL;
L
Linus Torvalds 已提交
539 540 541
}

static int
L
Len Brown 已提交
542
acpi_video_device_lcd_get_level_current(struct acpi_video_device *device,
543
					unsigned long long *level)
L
Linus Torvalds 已提交
544
{
545 546
	acpi_status status = AE_OK;

547 548 549 550
	if (device->cap._BQC || device->cap._BCQ) {
		char *buf = device->cap._BQC ? "_BQC" : "_BCQ";

		status = acpi_evaluate_integer(device->dev->handle, buf,
551 552
						NULL, level);
		if (ACPI_SUCCESS(status)) {
553 554 555 556 557 558 559
			if (device->brightness->flags._BQC_use_index) {
				if (device->brightness->flags._BCL_reversed)
					*level = device->brightness->count
								 - 3 - (*level);
				*level = device->brightness->levels[*level + 2];

			}
560 561 562 563 564 565 566 567 568 569
			device->brightness->curr = *level;
			return 0;
		} else {
			/* Fixme:
			 * should we return an error or ignore this failure?
			 * dev->brightness->curr is a cached value which stores
			 * the correct current backlight level in most cases.
			 * ACPI video backlight still works w/ buggy _BQC.
			 * http://bugzilla.kernel.org/show_bug.cgi?id=12233
			 */
570 571
			ACPI_WARNING((AE_INFO, "Evaluating %s failed", buf));
			device->cap._BQC = device->cap._BCQ = 0;
572 573 574
		}
	}

575
	*level = device->brightness->curr;
576
	return 0;
L
Linus Torvalds 已提交
577 578 579
}

static int
L
Len Brown 已提交
580 581
acpi_video_device_EDID(struct acpi_video_device *device,
		       union acpi_object **edid, ssize_t length)
L
Linus Torvalds 已提交
582
{
L
Len Brown 已提交
583 584 585 586 587
	int status;
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	union acpi_object *obj;
	union acpi_object arg0 = { ACPI_TYPE_INTEGER };
	struct acpi_object_list args = { 1, &arg0 };
L
Linus Torvalds 已提交
588 589 590 591 592


	*edid = NULL;

	if (!device)
593
		return -ENODEV;
L
Linus Torvalds 已提交
594 595 596 597 598
	if (length == 128)
		arg0.integer.value = 1;
	else if (length == 256)
		arg0.integer.value = 2;
	else
599
		return -EINVAL;
L
Linus Torvalds 已提交
600

601
	status = acpi_evaluate_object(device->dev->handle, "_DDC", &args, &buffer);
L
Linus Torvalds 已提交
602
	if (ACPI_FAILURE(status))
603
		return -ENODEV;
L
Linus Torvalds 已提交
604

605
	obj = buffer.pointer;
L
Linus Torvalds 已提交
606 607 608 609

	if (obj && obj->type == ACPI_TYPE_BUFFER)
		*edid = obj;
	else {
610
		printk(KERN_ERR PREFIX "Invalid _DDC data\n");
L
Linus Torvalds 已提交
611 612 613 614
		status = -EFAULT;
		kfree(obj);
	}

615
	return status;
L
Linus Torvalds 已提交
616 617 618 619 620
}

/* bus */

static int
L
Len Brown 已提交
621
acpi_video_bus_set_POST(struct acpi_video_bus *video, unsigned long option)
L
Linus Torvalds 已提交
622
{
L
Len Brown 已提交
623
	int status;
624
	unsigned long long tmp;
L
Len Brown 已提交
625 626
	union acpi_object arg0 = { ACPI_TYPE_INTEGER };
	struct acpi_object_list args = { 1, &arg0 };
L
Linus Torvalds 已提交
627 628 629 630


	arg0.integer.value = option;

631
	status = acpi_evaluate_integer(video->device->handle, "_SPD", &args, &tmp);
L
Linus Torvalds 已提交
632
	if (ACPI_SUCCESS(status))
L
Len Brown 已提交
633
		status = tmp ? (-EINVAL) : (AE_OK);
L
Linus Torvalds 已提交
634

635
	return status;
L
Linus Torvalds 已提交
636 637 638
}

static int
639
acpi_video_bus_get_POST(struct acpi_video_bus *video, unsigned long long *id)
L
Linus Torvalds 已提交
640 641 642
{
	int status;

643
	status = acpi_evaluate_integer(video->device->handle, "_GPD", NULL, id);
L
Linus Torvalds 已提交
644

645
	return status;
L
Linus Torvalds 已提交
646 647 648
}

static int
L
Len Brown 已提交
649
acpi_video_bus_POST_options(struct acpi_video_bus *video,
650
			    unsigned long long *options)
L
Linus Torvalds 已提交
651
{
L
Len Brown 已提交
652
	int status;
L
Linus Torvalds 已提交
653

654
	status = acpi_evaluate_integer(video->device->handle, "_VPO", NULL, options);
L
Linus Torvalds 已提交
655 656
	*options &= 3;

657
	return status;
L
Linus Torvalds 已提交
658 659 660 661 662 663 664 665 666
}

/*
 *  Arg:
 *  	video		: video bus device pointer
 *	bios_flag	: 
 *		0.	The system BIOS should NOT automatically switch(toggle)
 *			the active display output.
 *		1.	The system BIOS should automatically switch (toggle) the
667
 *			active display output. No switch event.
L
Linus Torvalds 已提交
668 669 670 671 672 673
 *		2.	The _DGS value should be locked.
 *		3.	The system BIOS should not automatically switch (toggle) the
 *			active display output, but instead generate the display switch
 *			event notify code.
 *	lcd_flag	:
 *		0.	The system BIOS should automatically control the brightness level
674
 *			of the LCD when the power changes from AC to DC
L
Linus Torvalds 已提交
675
 *		1. 	The system BIOS should NOT automatically control the brightness 
676
 *			level of the LCD when the power changes from AC to DC.
L
Linus Torvalds 已提交
677 678 679 680 681
 * Return Value:
 * 		-1	wrong arg.
 */

static int
L
Len Brown 已提交
682
acpi_video_bus_DOS(struct acpi_video_bus *video, int bios_flag, int lcd_flag)
L
Linus Torvalds 已提交
683
{
L
Len Brown 已提交
684 685 686
	acpi_integer status = 0;
	union acpi_object arg0 = { ACPI_TYPE_INTEGER };
	struct acpi_object_list args = { 1, &arg0 };
L
Linus Torvalds 已提交
687 688


L
Len Brown 已提交
689
	if (bios_flag < 0 || bios_flag > 3 || lcd_flag < 0 || lcd_flag > 1) {
L
Linus Torvalds 已提交
690 691 692 693 694
		status = -1;
		goto Failed;
	}
	arg0.integer.value = (lcd_flag << 2) | bios_flag;
	video->dos_setting = arg0.integer.value;
695
	acpi_evaluate_object(video->device->handle, "_DOS", &args, NULL);
L
Linus Torvalds 已提交
696

L
Len Brown 已提交
697
      Failed:
698
	return status;
L
Linus Torvalds 已提交
699 700
}

701 702 703 704 705 706 707 708 709 710
/*
 * Simple comparison function used to sort backlight levels.
 */

static int
acpi_video_cmp_level(const void *a, const void *b)
{
	return *(int *)a - *(int *)b;
}

L
Linus Torvalds 已提交
711 712 713 714 715
/*
 *  Arg:	
 *  	device	: video output device (LCD, CRT, ..)
 *
 *  Return Value:
716 717 718 719 720 721 722 723 724
 *	Maximum brightness level
 *
 *  Allocate and initialize device->brightness.
 */

static int
acpi_video_init_brightness(struct acpi_video_device *device)
{
	union acpi_object *obj = NULL;
725
	int i, max_level = 0, count = 0, level_ac_battery = 0;
726
	unsigned long long level, level_old;
727 728
	union acpi_object *o;
	struct acpi_video_device_brightness *br = NULL;
729
	int result = -EINVAL;
730 731 732 733 734 735 736 737 738 739 740 741 742

	if (!ACPI_SUCCESS(acpi_video_device_lcd_query_levels(device, &obj))) {
		ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Could not query available "
						"LCD brightness level\n"));
		goto out;
	}

	if (obj->package.count < 2)
		goto out;

	br = kzalloc(sizeof(*br), GFP_KERNEL);
	if (!br) {
		printk(KERN_ERR "can't allocate memory\n");
743
		result = -ENOMEM;
744 745 746
		goto out;
	}

747
	br->levels = kmalloc((obj->package.count + 2) * sizeof *(br->levels),
748
				GFP_KERNEL);
749 750
	if (!br->levels) {
		result = -ENOMEM;
751
		goto out_free;
752
	}
753 754 755 756 757 758 759 760 761 762 763 764 765 766

	for (i = 0; i < obj->package.count; i++) {
		o = (union acpi_object *)&obj->package.elements[i];
		if (o->type != ACPI_TYPE_INTEGER) {
			printk(KERN_ERR PREFIX "Invalid data\n");
			continue;
		}
		br->levels[count] = (u32) o->integer.value;

		if (br->levels[count] > max_level)
			max_level = br->levels[count];
		count++;
	}

767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786
	/*
	 * some buggy BIOS don't export the levels
	 * when machine is on AC/Battery in _BCL package.
	 * In this case, the first two elements in _BCL packages
	 * are also supported brightness levels that OS should take care of.
	 */
	for (i = 2; i < count; i++)
		if (br->levels[i] == br->levels[0] ||
		    br->levels[i] == br->levels[1])
			level_ac_battery++;

	if (level_ac_battery < 2) {
		level_ac_battery = 2 - level_ac_battery;
		br->flags._BCL_no_ac_battery_levels = 1;
		for (i = (count - 1 + level_ac_battery); i >= 2; i--)
			br->levels[i] = br->levels[i - level_ac_battery];
		count += level_ac_battery;
	} else if (level_ac_battery > 2)
		ACPI_ERROR((AE_INFO, "Too many duplicates in _BCL package\n"));

787 788 789 790 791 792 793 794
	/* Check if the _BCL package is in a reversed order */
	if (max_level == br->levels[2]) {
		br->flags._BCL_reversed = 1;
		sort(&br->levels[2], count - 2, sizeof(br->levels[2]),
			acpi_video_cmp_level, NULL);
	} else if (max_level != br->levels[count - 1])
		ACPI_ERROR((AE_INFO,
			    "Found unordered _BCL package\n"));
795 796 797

	br->count = count;
	device->brightness = br;
798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842

	/* Check the input/output of _BQC/_BCL/_BCM */
	if ((max_level < 100) && (max_level <= (count - 2)))
		br->flags._BCL_use_index = 1;

	/*
	 * _BCM is always consistent with _BCL,
	 * at least for all the laptops we have ever seen.
	 */
	br->flags._BCM_use_index = br->flags._BCL_use_index;

	/* _BQC uses INDEX while _BCL uses VALUE in some laptops */
	br->curr = max_level;
	result = acpi_video_device_lcd_get_level_current(device, &level_old);
	if (result)
		goto out_free_levels;

	result = acpi_video_device_lcd_set_level(device, br->curr);
	if (result)
		goto out_free_levels;

	result = acpi_video_device_lcd_get_level_current(device, &level);
	if (result)
		goto out_free_levels;

	if ((level != level_old) && !br->flags._BCM_use_index) {
		/* Note:
		 * This piece of code does not work correctly if the current
		 * brightness levels is 0.
		 * But I guess boxes that boot with such a dark screen are rare
		 * and no more code is needed to cover this specifial case.
		 */

		if (level_ac_battery != 2) {
			/*
			 * For now, we don't support the _BCL like this:
			 * 16, 15, 0, 1, 2, 3, ..., 14, 15, 16
			 * because we may mess up the index returned by _BQC.
			 * Plus: we have not got a box like this.
			 */
			ACPI_ERROR((AE_INFO, "_BCL not supported\n"));
		}
		br->flags._BQC_use_index = 1;
	}

843 844
	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
			  "found %d brightness levels\n", count - 2));
845
	kfree(obj);
846
	return result;
847 848 849 850 851 852 853 854

out_free_levels:
	kfree(br->levels);
out_free:
	kfree(br);
out:
	device->brightness = NULL;
	kfree(obj);
855
	return result;
856 857 858 859 860 861 862
}

/*
 *  Arg:
 *	device	: video output device (LCD, CRT, ..)
 *
 *  Return Value:
L
Linus Torvalds 已提交
863 864
 *  	None
 *
865
 *  Find out all required AML methods defined under the output
L
Linus Torvalds 已提交
866 867 868
 *  device.
 */

L
Len Brown 已提交
869
static void acpi_video_device_find_cap(struct acpi_video_device *device)
L
Linus Torvalds 已提交
870 871 872 873
{
	acpi_handle h_dummy1;


874
	memset(&device->cap, 0, sizeof(device->cap));
L
Linus Torvalds 已提交
875

876
	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_ADR", &h_dummy1))) {
L
Linus Torvalds 已提交
877 878
		device->cap._ADR = 1;
	}
879
	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCL", &h_dummy1))) {
L
Len Brown 已提交
880
		device->cap._BCL = 1;
L
Linus Torvalds 已提交
881
	}
882
	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCM", &h_dummy1))) {
L
Len Brown 已提交
883
		device->cap._BCM = 1;
L
Linus Torvalds 已提交
884
	}
885 886
	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle,"_BQC",&h_dummy1)))
		device->cap._BQC = 1;
887 888 889 890 891 892
	else if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCQ",
				&h_dummy1))) {
		printk(KERN_WARNING FW_BUG "_BCQ is used instead of _BQC\n");
		device->cap._BCQ = 1;
	}

893
	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_DDC", &h_dummy1))) {
L
Len Brown 已提交
894
		device->cap._DDC = 1;
L
Linus Torvalds 已提交
895
	}
896
	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_DCS", &h_dummy1))) {
L
Linus Torvalds 已提交
897 898
		device->cap._DCS = 1;
	}
899
	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_DGS", &h_dummy1))) {
L
Linus Torvalds 已提交
900 901
		device->cap._DGS = 1;
	}
902
	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_DSS", &h_dummy1))) {
L
Linus Torvalds 已提交
903 904 905
		device->cap._DSS = 1;
	}

906
	if (acpi_video_backlight_support()) {
907
		int result;
908 909
		static int count = 0;
		char *name;
910 911 912 913

		result = acpi_video_init_brightness(device);
		if (result)
			return;
914 915 916 917 918 919
		name = kzalloc(MAX_NAME_LEN, GFP_KERNEL);
		if (!name)
			return;

		sprintf(name, "acpi_video%d", count++);
		device->backlight = backlight_device_register(name,
920
			NULL, device, &acpi_backlight_ops);
921
		device->backlight->props.max_brightness = device->brightness->count-3;
922
		kfree(name);
923 924 925

		device->cdev = thermal_cooling_device_register("LCD",
					device->dev, &video_cooling_ops);
926 927 928
		if (IS_ERR(device->cdev))
			return;

929 930
		dev_info(&device->dev->dev, "registered as cooling_device%d\n",
			 device->cdev->id);
931 932 933 934 935 936 937 938 939 940
		result = sysfs_create_link(&device->dev->dev.kobj,
				&device->cdev->device.kobj,
				"thermal_cooling");
		if (result)
			printk(KERN_ERR PREFIX "Create sysfs link\n");
		result = sysfs_create_link(&device->cdev->device.kobj,
				&device->dev->dev.kobj, "device");
		if (result)
			printk(KERN_ERR PREFIX "Create sysfs link\n");

941
	}
942 943 944 945 946 947 948 949 950 951 952 953 954 955

	if (acpi_video_display_switch_support()) {

		if (device->cap._DCS && device->cap._DSS) {
			static int count;
			char *name;
			name = kzalloc(MAX_NAME_LEN, GFP_KERNEL);
			if (!name)
				return;
			sprintf(name, "acpi_video%d", count++);
			device->output_dev = video_output_register(name,
					NULL, device, &acpi_output_properties);
			kfree(name);
		}
956
	}
L
Linus Torvalds 已提交
957 958 959 960 961 962 963 964 965
}

/*
 *  Arg:	
 *  	device	: video output device (VGA)
 *
 *  Return Value:
 *  	None
 *
966
 *  Find out all required AML methods defined under the video bus device.
L
Linus Torvalds 已提交
967 968
 */

L
Len Brown 已提交
969
static void acpi_video_bus_find_cap(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
970
{
L
Len Brown 已提交
971
	acpi_handle h_dummy1;
L
Linus Torvalds 已提交
972

973
	memset(&video->cap, 0, sizeof(video->cap));
974
	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_DOS", &h_dummy1))) {
L
Linus Torvalds 已提交
975 976
		video->cap._DOS = 1;
	}
977
	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_DOD", &h_dummy1))) {
L
Linus Torvalds 已提交
978 979
		video->cap._DOD = 1;
	}
980
	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_ROM", &h_dummy1))) {
L
Linus Torvalds 已提交
981 982
		video->cap._ROM = 1;
	}
983
	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_GPD", &h_dummy1))) {
L
Linus Torvalds 已提交
984 985
		video->cap._GPD = 1;
	}
986
	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_SPD", &h_dummy1))) {
L
Linus Torvalds 已提交
987 988
		video->cap._SPD = 1;
	}
989
	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_VPO", &h_dummy1))) {
L
Linus Torvalds 已提交
990 991 992 993 994 995 996 997 998
		video->cap._VPO = 1;
	}
}

/*
 * Check whether the video bus device has required AML method to
 * support the desired features
 */

L
Len Brown 已提交
999
static int acpi_video_bus_check(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
1000
{
L
Len Brown 已提交
1001
	acpi_status status = -ENOENT;
1002
	struct device *dev;
L
Linus Torvalds 已提交
1003 1004

	if (!video)
1005
		return -EINVAL;
L
Linus Torvalds 已提交
1006

1007 1008 1009 1010 1011
	dev = acpi_get_physical_pci_device(video->device->handle);
	if (!dev)
		return -ENODEV;
	put_device(dev);

L
Linus Torvalds 已提交
1012 1013 1014 1015
	/* Since there is no HID, CID and so on for VGA driver, we have
	 * to check well known required nodes.
	 */

1016
	/* Does this device support video switching? */
L
Len Brown 已提交
1017
	if (video->cap._DOS) {
L
Linus Torvalds 已提交
1018 1019 1020 1021
		video->flags.multihead = 1;
		status = 0;
	}

1022
	/* Does this device support retrieving a video ROM? */
L
Len Brown 已提交
1023
	if (video->cap._ROM) {
L
Linus Torvalds 已提交
1024 1025 1026 1027
		video->flags.rom = 1;
		status = 0;
	}

1028
	/* Does this device support configuring which video device to POST? */
L
Len Brown 已提交
1029
	if (video->cap._GPD && video->cap._SPD && video->cap._VPO) {
L
Linus Torvalds 已提交
1030 1031 1032 1033
		video->flags.post = 1;
		status = 0;
	}

1034
	return status;
L
Linus Torvalds 已提交
1035 1036 1037 1038 1039 1040
}

/* --------------------------------------------------------------------------
                              FS Interface (/proc)
   -------------------------------------------------------------------------- */

L
Len Brown 已提交
1041
static struct proc_dir_entry *acpi_video_dir;
L
Linus Torvalds 已提交
1042 1043 1044

/* video devices */

L
Len Brown 已提交
1045
static int acpi_video_device_info_seq_show(struct seq_file *seq, void *offset)
L
Linus Torvalds 已提交
1046
{
1047
	struct acpi_video_device *dev = seq->private;
L
Linus Torvalds 已提交
1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060


	if (!dev)
		goto end;

	seq_printf(seq, "device_id:    0x%04x\n", (u32) dev->device_id);
	seq_printf(seq, "type:         ");
	if (dev->flags.crt)
		seq_printf(seq, "CRT\n");
	else if (dev->flags.lcd)
		seq_printf(seq, "LCD\n");
	else if (dev->flags.tvout)
		seq_printf(seq, "TVOUT\n");
1061 1062
	else if (dev->flags.dvi)
		seq_printf(seq, "DVI\n");
L
Linus Torvalds 已提交
1063 1064 1065
	else
		seq_printf(seq, "UNKNOWN\n");

L
Len Brown 已提交
1066
	seq_printf(seq, "known by bios: %s\n", dev->flags.bios ? "yes" : "no");
L
Linus Torvalds 已提交
1067

L
Len Brown 已提交
1068
      end:
1069
	return 0;
L
Linus Torvalds 已提交
1070 1071 1072
}

static int
L
Len Brown 已提交
1073
acpi_video_device_info_open_fs(struct inode *inode, struct file *file)
L
Linus Torvalds 已提交
1074 1075 1076 1077 1078
{
	return single_open(file, acpi_video_device_info_seq_show,
			   PDE(inode)->data);
}

L
Len Brown 已提交
1079
static int acpi_video_device_state_seq_show(struct seq_file *seq, void *offset)
L
Linus Torvalds 已提交
1080
{
L
Len Brown 已提交
1081
	int status;
1082
	struct acpi_video_device *dev = seq->private;
1083
	unsigned long long state;
L
Linus Torvalds 已提交
1084 1085 1086 1087 1088 1089 1090 1091


	if (!dev)
		goto end;

	status = acpi_video_device_get_state(dev, &state);
	seq_printf(seq, "state:     ");
	if (ACPI_SUCCESS(status))
1092
		seq_printf(seq, "0x%02llx\n", state);
L
Linus Torvalds 已提交
1093 1094 1095 1096 1097 1098
	else
		seq_printf(seq, "<not supported>\n");

	status = acpi_video_device_query(dev, &state);
	seq_printf(seq, "query:     ");
	if (ACPI_SUCCESS(status))
1099
		seq_printf(seq, "0x%02llx\n", state);
L
Linus Torvalds 已提交
1100 1101 1102
	else
		seq_printf(seq, "<not supported>\n");

L
Len Brown 已提交
1103
      end:
1104
	return 0;
L
Linus Torvalds 已提交
1105 1106 1107
}

static int
L
Len Brown 已提交
1108
acpi_video_device_state_open_fs(struct inode *inode, struct file *file)
L
Linus Torvalds 已提交
1109 1110 1111 1112 1113 1114
{
	return single_open(file, acpi_video_device_state_seq_show,
			   PDE(inode)->data);
}

static ssize_t
L
Len Brown 已提交
1115 1116 1117
acpi_video_device_write_state(struct file *file,
			      const char __user * buffer,
			      size_t count, loff_t * data)
L
Linus Torvalds 已提交
1118
{
L
Len Brown 已提交
1119
	int status;
1120 1121
	struct seq_file *m = file->private_data;
	struct acpi_video_device *dev = m->private;
L
Len Brown 已提交
1122 1123
	char str[12] = { 0 };
	u32 state = 0;
L
Linus Torvalds 已提交
1124 1125 1126


	if (!dev || count + 1 > sizeof str)
1127
		return -EINVAL;
L
Linus Torvalds 已提交
1128 1129

	if (copy_from_user(str, buffer, count))
1130
		return -EFAULT;
L
Linus Torvalds 已提交
1131 1132 1133

	str[count] = 0;
	state = simple_strtoul(str, NULL, 0);
L
Len Brown 已提交
1134
	state &= ((1ul << 31) | (1ul << 30) | (1ul << 0));
L
Linus Torvalds 已提交
1135 1136 1137 1138

	status = acpi_video_device_set_state(dev, state);

	if (status)
1139
		return -EFAULT;
L
Linus Torvalds 已提交
1140

1141
	return count;
L
Linus Torvalds 已提交
1142 1143 1144
}

static int
L
Len Brown 已提交
1145
acpi_video_device_brightness_seq_show(struct seq_file *seq, void *offset)
L
Linus Torvalds 已提交
1146
{
1147
	struct acpi_video_device *dev = seq->private;
L
Len Brown 已提交
1148
	int i;
L
Linus Torvalds 已提交
1149 1150 1151 1152


	if (!dev || !dev->brightness) {
		seq_printf(seq, "<not supported>\n");
1153
		return 0;
L
Linus Torvalds 已提交
1154 1155 1156
	}

	seq_printf(seq, "levels: ");
1157
	for (i = 2; i < dev->brightness->count; i++)
L
Linus Torvalds 已提交
1158 1159 1160
		seq_printf(seq, " %d", dev->brightness->levels[i]);
	seq_printf(seq, "\ncurrent: %d\n", dev->brightness->curr);

1161
	return 0;
L
Linus Torvalds 已提交
1162 1163 1164
}

static int
L
Len Brown 已提交
1165
acpi_video_device_brightness_open_fs(struct inode *inode, struct file *file)
L
Linus Torvalds 已提交
1166 1167 1168 1169 1170 1171
{
	return single_open(file, acpi_video_device_brightness_seq_show,
			   PDE(inode)->data);
}

static ssize_t
L
Len Brown 已提交
1172 1173 1174
acpi_video_device_write_brightness(struct file *file,
				   const char __user * buffer,
				   size_t count, loff_t * data)
L
Linus Torvalds 已提交
1175
{
1176 1177
	struct seq_file *m = file->private_data;
	struct acpi_video_device *dev = m->private;
1178
	char str[5] = { 0 };
L
Len Brown 已提交
1179 1180
	unsigned int level = 0;
	int i;
L
Linus Torvalds 已提交
1181 1182


1183
	if (!dev || !dev->brightness || count + 1 > sizeof str)
1184
		return -EINVAL;
L
Linus Torvalds 已提交
1185 1186

	if (copy_from_user(str, buffer, count))
1187
		return -EFAULT;
L
Linus Torvalds 已提交
1188 1189 1190

	str[count] = 0;
	level = simple_strtoul(str, NULL, 0);
L
Len Brown 已提交
1191

L
Linus Torvalds 已提交
1192
	if (level > 100)
1193
		return -EFAULT;
L
Linus Torvalds 已提交
1194

1195
	/* validate through the list of available levels */
1196
	for (i = 2; i < dev->brightness->count; i++)
L
Linus Torvalds 已提交
1197
		if (level == dev->brightness->levels[i]) {
1198 1199
			if (!acpi_video_device_lcd_set_level(dev, level))
				return count;
L
Linus Torvalds 已提交
1200 1201 1202
			break;
		}

1203
	return -EINVAL;
L
Linus Torvalds 已提交
1204 1205
}

L
Len Brown 已提交
1206
static int acpi_video_device_EDID_seq_show(struct seq_file *seq, void *offset)
L
Linus Torvalds 已提交
1207
{
1208
	struct acpi_video_device *dev = seq->private;
L
Len Brown 已提交
1209 1210 1211
	int status;
	int i;
	union acpi_object *edid = NULL;
L
Linus Torvalds 已提交
1212 1213 1214 1215 1216


	if (!dev)
		goto out;

L
Len Brown 已提交
1217
	status = acpi_video_device_EDID(dev, &edid, 128);
L
Linus Torvalds 已提交
1218
	if (ACPI_FAILURE(status)) {
L
Len Brown 已提交
1219
		status = acpi_video_device_EDID(dev, &edid, 256);
L
Linus Torvalds 已提交
1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230
	}

	if (ACPI_FAILURE(status)) {
		goto out;
	}

	if (edid && edid->type == ACPI_TYPE_BUFFER) {
		for (i = 0; i < edid->buffer.length; i++)
			seq_putc(seq, edid->buffer.pointer[i]);
	}

L
Len Brown 已提交
1231
      out:
L
Linus Torvalds 已提交
1232 1233 1234 1235 1236
	if (!edid)
		seq_printf(seq, "<not supported>\n");
	else
		kfree(edid);

1237
	return 0;
L
Linus Torvalds 已提交
1238 1239 1240
}

static int
L
Len Brown 已提交
1241
acpi_video_device_EDID_open_fs(struct inode *inode, struct file *file)
L
Linus Torvalds 已提交
1242 1243 1244 1245 1246
{
	return single_open(file, acpi_video_device_EDID_seq_show,
			   PDE(inode)->data);
}

L
Len Brown 已提交
1247
static int acpi_video_device_add_fs(struct acpi_device *device)
L
Linus Torvalds 已提交
1248
{
1249
	struct proc_dir_entry *entry, *device_dir;
L
Linus Torvalds 已提交
1250 1251
	struct acpi_video_device *vid_dev;

1252
	vid_dev = acpi_driver_data(device);
L
Linus Torvalds 已提交
1253
	if (!vid_dev)
1254
		return -ENODEV;
L
Linus Torvalds 已提交
1255

1256 1257 1258 1259 1260
	device_dir = proc_mkdir(acpi_device_bid(device),
				vid_dev->video->dir);
	if (!device_dir)
		return -ENOMEM;

L
Linus Torvalds 已提交
1261
	/* 'info' [R] */
1262
	entry = proc_create_data("info", S_IRUGO, device_dir,
1263
			&acpi_video_device_info_fops, acpi_driver_data(device));
L
Linus Torvalds 已提交
1264
	if (!entry)
1265
		goto err_remove_dir;
L
Linus Torvalds 已提交
1266 1267

	/* 'state' [R/W] */
1268
	entry = proc_create_data("state", S_IFREG | S_IRUGO | S_IWUSR,
1269
				 device_dir,
1270 1271
				 &acpi_video_device_state_fops,
				 acpi_driver_data(device));
L
Linus Torvalds 已提交
1272
	if (!entry)
1273
		goto err_remove_info;
L
Linus Torvalds 已提交
1274 1275

	/* 'brightness' [R/W] */
1276
	entry = proc_create_data("brightness", S_IFREG | S_IRUGO | S_IWUSR,
1277
				 device_dir,
1278 1279
				 &acpi_video_device_brightness_fops,
				 acpi_driver_data(device));
L
Linus Torvalds 已提交
1280
	if (!entry)
1281
		goto err_remove_state;
L
Linus Torvalds 已提交
1282 1283

	/* 'EDID' [R] */
1284
	entry = proc_create_data("EDID", S_IRUGO, device_dir,
1285 1286
				 &acpi_video_device_EDID_fops,
				 acpi_driver_data(device));
L
Linus Torvalds 已提交
1287
	if (!entry)
1288
		goto err_remove_brightness;
L
Linus Torvalds 已提交
1289

1290 1291
	acpi_device_dir(device) = device_dir;

1292
	return 0;
1293 1294 1295 1296 1297 1298 1299 1300 1301 1302

 err_remove_brightness:
	remove_proc_entry("brightness", device_dir);
 err_remove_state:
	remove_proc_entry("state", device_dir);
 err_remove_info:
	remove_proc_entry("info", device_dir);
 err_remove_dir:
	remove_proc_entry(acpi_device_bid(device), vid_dev->video->dir);
	return -ENOMEM;
L
Linus Torvalds 已提交
1303 1304
}

L
Len Brown 已提交
1305
static int acpi_video_device_remove_fs(struct acpi_device *device)
L
Linus Torvalds 已提交
1306 1307
{
	struct acpi_video_device *vid_dev;
1308
	struct proc_dir_entry *device_dir;
L
Linus Torvalds 已提交
1309

1310
	vid_dev = acpi_driver_data(device);
L
Linus Torvalds 已提交
1311
	if (!vid_dev || !vid_dev->video || !vid_dev->video->dir)
1312
		return -ENODEV;
L
Linus Torvalds 已提交
1313

1314 1315 1316 1317 1318 1319
	device_dir = acpi_device_dir(device);
	if (device_dir) {
		remove_proc_entry("info", device_dir);
		remove_proc_entry("state", device_dir);
		remove_proc_entry("brightness", device_dir);
		remove_proc_entry("EDID", device_dir);
L
Len Brown 已提交
1320
		remove_proc_entry(acpi_device_bid(device), vid_dev->video->dir);
L
Linus Torvalds 已提交
1321 1322 1323
		acpi_device_dir(device) = NULL;
	}

1324
	return 0;
L
Linus Torvalds 已提交
1325 1326 1327
}

/* video bus */
L
Len Brown 已提交
1328
static int acpi_video_bus_info_seq_show(struct seq_file *seq, void *offset)
L
Linus Torvalds 已提交
1329
{
1330
	struct acpi_video_bus *video = seq->private;
L
Linus Torvalds 已提交
1331 1332 1333 1334 1335 1336


	if (!video)
		goto end;

	seq_printf(seq, "Switching heads:              %s\n",
L
Len Brown 已提交
1337
		   video->flags.multihead ? "yes" : "no");
L
Linus Torvalds 已提交
1338
	seq_printf(seq, "Video ROM:                    %s\n",
L
Len Brown 已提交
1339
		   video->flags.rom ? "yes" : "no");
L
Linus Torvalds 已提交
1340
	seq_printf(seq, "Device to be POSTed on boot:  %s\n",
L
Len Brown 已提交
1341
		   video->flags.post ? "yes" : "no");
L
Linus Torvalds 已提交
1342

L
Len Brown 已提交
1343
      end:
1344
	return 0;
L
Linus Torvalds 已提交
1345 1346
}

L
Len Brown 已提交
1347
static int acpi_video_bus_info_open_fs(struct inode *inode, struct file *file)
L
Linus Torvalds 已提交
1348
{
L
Len Brown 已提交
1349 1350
	return single_open(file, acpi_video_bus_info_seq_show,
			   PDE(inode)->data);
L
Linus Torvalds 已提交
1351 1352
}

L
Len Brown 已提交
1353
static int acpi_video_bus_ROM_seq_show(struct seq_file *seq, void *offset)
L
Linus Torvalds 已提交
1354
{
1355
	struct acpi_video_bus *video = seq->private;
L
Linus Torvalds 已提交
1356 1357 1358 1359 1360


	if (!video)
		goto end;

1361
	printk(KERN_INFO PREFIX "Please implement %s\n", __func__);
L
Linus Torvalds 已提交
1362 1363
	seq_printf(seq, "<TODO>\n");

L
Len Brown 已提交
1364
      end:
1365
	return 0;
L
Linus Torvalds 已提交
1366 1367
}

L
Len Brown 已提交
1368
static int acpi_video_bus_ROM_open_fs(struct inode *inode, struct file *file)
L
Linus Torvalds 已提交
1369 1370 1371 1372
{
	return single_open(file, acpi_video_bus_ROM_seq_show, PDE(inode)->data);
}

L
Len Brown 已提交
1373
static int acpi_video_bus_POST_info_seq_show(struct seq_file *seq, void *offset)
L
Linus Torvalds 已提交
1374
{
1375
	struct acpi_video_bus *video = seq->private;
1376
	unsigned long long options;
L
Len Brown 已提交
1377
	int status;
L
Linus Torvalds 已提交
1378 1379 1380 1381 1382 1383 1384 1385


	if (!video)
		goto end;

	status = acpi_video_bus_POST_options(video, &options);
	if (ACPI_SUCCESS(status)) {
		if (!(options & 1)) {
L
Len Brown 已提交
1386 1387 1388
			printk(KERN_WARNING PREFIX
			       "The motherboard VGA device is not listed as a possible POST device.\n");
			printk(KERN_WARNING PREFIX
1389
			       "This indicates a BIOS bug. Please contact the manufacturer.\n");
L
Linus Torvalds 已提交
1390
		}
1391
		printk(KERN_WARNING "%llx\n", options);
1392
		seq_printf(seq, "can POST: <integrated video>");
L
Linus Torvalds 已提交
1393 1394 1395 1396 1397 1398 1399
		if (options & 2)
			seq_printf(seq, " <PCI video>");
		if (options & 4)
			seq_printf(seq, " <AGP video>");
		seq_putc(seq, '\n');
	} else
		seq_printf(seq, "<not supported>\n");
L
Len Brown 已提交
1400
      end:
1401
	return 0;
L
Linus Torvalds 已提交
1402 1403 1404
}

static int
L
Len Brown 已提交
1405
acpi_video_bus_POST_info_open_fs(struct inode *inode, struct file *file)
L
Linus Torvalds 已提交
1406
{
L
Len Brown 已提交
1407 1408
	return single_open(file, acpi_video_bus_POST_info_seq_show,
			   PDE(inode)->data);
L
Linus Torvalds 已提交
1409 1410
}

L
Len Brown 已提交
1411
static int acpi_video_bus_POST_seq_show(struct seq_file *seq, void *offset)
L
Linus Torvalds 已提交
1412
{
1413
	struct acpi_video_bus *video = seq->private;
L
Len Brown 已提交
1414
	int status;
1415
	unsigned long long id;
L
Linus Torvalds 已提交
1416 1417 1418 1419 1420


	if (!video)
		goto end;

L
Len Brown 已提交
1421
	status = acpi_video_bus_get_POST(video, &id);
L
Linus Torvalds 已提交
1422 1423 1424 1425
	if (!ACPI_SUCCESS(status)) {
		seq_printf(seq, "<not supported>\n");
		goto end;
	}
1426
	seq_printf(seq, "device POSTed is <%s>\n", device_decode[id & 3]);
L
Linus Torvalds 已提交
1427

L
Len Brown 已提交
1428
      end:
1429
	return 0;
L
Linus Torvalds 已提交
1430 1431
}

L
Len Brown 已提交
1432
static int acpi_video_bus_DOS_seq_show(struct seq_file *seq, void *offset)
L
Linus Torvalds 已提交
1433
{
1434
	struct acpi_video_bus *video = seq->private;
L
Linus Torvalds 已提交
1435 1436


L
Len Brown 已提交
1437
	seq_printf(seq, "DOS setting: <%d>\n", video->dos_setting);
L
Linus Torvalds 已提交
1438

1439
	return 0;
L
Linus Torvalds 已提交
1440 1441
}

L
Len Brown 已提交
1442
static int acpi_video_bus_POST_open_fs(struct inode *inode, struct file *file)
L
Linus Torvalds 已提交
1443
{
L
Len Brown 已提交
1444 1445
	return single_open(file, acpi_video_bus_POST_seq_show,
			   PDE(inode)->data);
L
Linus Torvalds 已提交
1446 1447
}

L
Len Brown 已提交
1448
static int acpi_video_bus_DOS_open_fs(struct inode *inode, struct file *file)
L
Linus Torvalds 已提交
1449 1450 1451 1452 1453
{
	return single_open(file, acpi_video_bus_DOS_seq_show, PDE(inode)->data);
}

static ssize_t
L
Len Brown 已提交
1454 1455 1456
acpi_video_bus_write_POST(struct file *file,
			  const char __user * buffer,
			  size_t count, loff_t * data)
L
Linus Torvalds 已提交
1457
{
L
Len Brown 已提交
1458
	int status;
1459 1460
	struct seq_file *m = file->private_data;
	struct acpi_video_bus *video = m->private;
L
Len Brown 已提交
1461
	char str[12] = { 0 };
1462
	unsigned long long opt, options;
L
Linus Torvalds 已提交
1463 1464 1465


	if (!video || count + 1 > sizeof str)
1466
		return -EINVAL;
L
Linus Torvalds 已提交
1467 1468 1469

	status = acpi_video_bus_POST_options(video, &options);
	if (!ACPI_SUCCESS(status))
1470
		return -EINVAL;
L
Linus Torvalds 已提交
1471 1472

	if (copy_from_user(str, buffer, count))
1473
		return -EFAULT;
L
Linus Torvalds 已提交
1474 1475 1476 1477

	str[count] = 0;
	opt = strtoul(str, NULL, 0);
	if (opt > 3)
1478
		return -EFAULT;
L
Linus Torvalds 已提交
1479

1480
	/* just in case an OEM 'forgot' the motherboard... */
L
Linus Torvalds 已提交
1481 1482 1483
	options |= 1;

	if (options & (1ul << opt)) {
L
Len Brown 已提交
1484
		status = acpi_video_bus_set_POST(video, opt);
L
Linus Torvalds 已提交
1485
		if (!ACPI_SUCCESS(status))
1486
			return -EFAULT;
L
Linus Torvalds 已提交
1487 1488 1489

	}

1490
	return count;
L
Linus Torvalds 已提交
1491 1492 1493
}

static ssize_t
L
Len Brown 已提交
1494 1495 1496
acpi_video_bus_write_DOS(struct file *file,
			 const char __user * buffer,
			 size_t count, loff_t * data)
L
Linus Torvalds 已提交
1497
{
L
Len Brown 已提交
1498
	int status;
1499 1500
	struct seq_file *m = file->private_data;
	struct acpi_video_bus *video = m->private;
L
Len Brown 已提交
1501 1502
	char str[12] = { 0 };
	unsigned long opt;
L
Linus Torvalds 已提交
1503 1504 1505


	if (!video || count + 1 > sizeof str)
1506
		return -EINVAL;
L
Linus Torvalds 已提交
1507 1508

	if (copy_from_user(str, buffer, count))
1509
		return -EFAULT;
L
Linus Torvalds 已提交
1510 1511 1512 1513

	str[count] = 0;
	opt = strtoul(str, NULL, 0);
	if (opt > 7)
1514
		return -EFAULT;
L
Linus Torvalds 已提交
1515

L
Len Brown 已提交
1516
	status = acpi_video_bus_DOS(video, opt & 0x3, (opt & 0x4) >> 2);
L
Linus Torvalds 已提交
1517 1518

	if (!ACPI_SUCCESS(status))
1519
		return -EFAULT;
L
Linus Torvalds 已提交
1520

1521
	return count;
L
Linus Torvalds 已提交
1522 1523
}

L
Len Brown 已提交
1524
static int acpi_video_bus_add_fs(struct acpi_device *device)
L
Linus Torvalds 已提交
1525
{
1526 1527 1528
	struct acpi_video_bus *video = acpi_driver_data(device);
	struct proc_dir_entry *device_dir;
	struct proc_dir_entry *entry;
L
Linus Torvalds 已提交
1529

1530 1531 1532
	device_dir = proc_mkdir(acpi_device_bid(device), acpi_video_dir);
	if (!device_dir)
		return -ENOMEM;
L
Linus Torvalds 已提交
1533 1534

	/* 'info' [R] */
1535
	entry = proc_create_data("info", S_IRUGO, device_dir,
1536 1537
				 &acpi_video_bus_info_fops,
				 acpi_driver_data(device));
L
Linus Torvalds 已提交
1538
	if (!entry)
1539
		goto err_remove_dir;
L
Linus Torvalds 已提交
1540 1541

	/* 'ROM' [R] */
1542
	entry = proc_create_data("ROM", S_IRUGO, device_dir,
1543 1544
				 &acpi_video_bus_ROM_fops,
				 acpi_driver_data(device));
L
Linus Torvalds 已提交
1545
	if (!entry)
1546
		goto err_remove_info;
L
Linus Torvalds 已提交
1547 1548

	/* 'POST_info' [R] */
1549
	entry = proc_create_data("POST_info", S_IRUGO, device_dir,
1550 1551
				 &acpi_video_bus_POST_info_fops,
				 acpi_driver_data(device));
L
Linus Torvalds 已提交
1552
	if (!entry)
1553
		goto err_remove_rom;
L
Linus Torvalds 已提交
1554 1555

	/* 'POST' [R/W] */
1556
	entry = proc_create_data("POST", S_IFREG | S_IRUGO | S_IWUSR,
1557
				 device_dir,
1558 1559
				 &acpi_video_bus_POST_fops,
				 acpi_driver_data(device));
L
Linus Torvalds 已提交
1560
	if (!entry)
1561
		goto err_remove_post_info;
L
Linus Torvalds 已提交
1562 1563

	/* 'DOS' [R/W] */
1564
	entry = proc_create_data("DOS", S_IFREG | S_IRUGO | S_IWUSR,
1565
				 device_dir,
1566 1567
				 &acpi_video_bus_DOS_fops,
				 acpi_driver_data(device));
L
Linus Torvalds 已提交
1568
	if (!entry)
1569
		goto err_remove_post;
L
Linus Torvalds 已提交
1570

1571
	video->dir = acpi_device_dir(device) = device_dir;
1572
	return 0;
1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584

 err_remove_post:
	remove_proc_entry("POST", device_dir);
 err_remove_post_info:
	remove_proc_entry("POST_info", device_dir);
 err_remove_rom:
	remove_proc_entry("ROM", device_dir);
 err_remove_info:
	remove_proc_entry("info", device_dir);
 err_remove_dir:
	remove_proc_entry(acpi_device_bid(device), acpi_video_dir);
	return -ENOMEM;
L
Linus Torvalds 已提交
1585 1586
}

L
Len Brown 已提交
1587
static int acpi_video_bus_remove_fs(struct acpi_device *device)
L
Linus Torvalds 已提交
1588
{
1589 1590 1591 1592 1593 1594 1595 1596
	struct proc_dir_entry *device_dir = acpi_device_dir(device);

	if (device_dir) {
		remove_proc_entry("info", device_dir);
		remove_proc_entry("ROM", device_dir);
		remove_proc_entry("POST_info", device_dir);
		remove_proc_entry("POST", device_dir);
		remove_proc_entry("DOS", device_dir);
L
Len Brown 已提交
1597
		remove_proc_entry(acpi_device_bid(device), acpi_video_dir);
L
Linus Torvalds 已提交
1598 1599 1600
		acpi_device_dir(device) = NULL;
	}

1601
	return 0;
L
Linus Torvalds 已提交
1602 1603 1604 1605 1606 1607 1608
}

/* --------------------------------------------------------------------------
                                 Driver Interface
   -------------------------------------------------------------------------- */

/* device interface */
1609 1610 1611
static struct acpi_video_device_attrib*
acpi_video_get_device_attr(struct acpi_video_bus *video, unsigned long device_id)
{
1612 1613 1614 1615 1616 1617 1618 1619
	struct acpi_video_enumerated_device *ids;
	int i;

	for (i = 0; i < video->attached_count; i++) {
		ids = &video->attached_array[i];
		if ((ids->value.int_val & 0xffff) == device_id)
			return &ids->value.attrib;
	}
1620 1621 1622

	return NULL;
}
L
Linus Torvalds 已提交
1623 1624

static int
L
Len Brown 已提交
1625 1626
acpi_video_bus_get_one_device(struct acpi_device *device,
			      struct acpi_video_bus *video)
L
Linus Torvalds 已提交
1627
{
1628
	unsigned long long device_id;
1629
	int status;
L
Len Brown 已提交
1630
	struct acpi_video_device *data;
1631
	struct acpi_video_device_attrib* attribute;
L
Linus Torvalds 已提交
1632 1633

	if (!device || !video)
1634
		return -EINVAL;
L
Linus Torvalds 已提交
1635

L
Len Brown 已提交
1636 1637
	status =
	    acpi_evaluate_integer(device->handle, "_ADR", NULL, &device_id);
L
Linus Torvalds 已提交
1638 1639
	if (ACPI_SUCCESS(status)) {

1640
		data = kzalloc(sizeof(struct acpi_video_device), GFP_KERNEL);
L
Linus Torvalds 已提交
1641
		if (!data)
1642
			return -ENOMEM;
L
Linus Torvalds 已提交
1643 1644 1645

		strcpy(acpi_device_name(device), ACPI_VIDEO_DEVICE_NAME);
		strcpy(acpi_device_class(device), ACPI_VIDEO_CLASS);
1646
		device->driver_data = data;
L
Linus Torvalds 已提交
1647 1648 1649 1650 1651

		data->device_id = device_id;
		data->video = video;
		data->dev = device;

1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674
		attribute = acpi_video_get_device_attr(video, device_id);

		if((attribute != NULL) && attribute->device_id_scheme) {
			switch (attribute->display_type) {
			case ACPI_VIDEO_DISPLAY_CRT:
				data->flags.crt = 1;
				break;
			case ACPI_VIDEO_DISPLAY_TV:
				data->flags.tvout = 1;
				break;
			case ACPI_VIDEO_DISPLAY_DVI:
				data->flags.dvi = 1;
				break;
			case ACPI_VIDEO_DISPLAY_LCD:
				data->flags.lcd = 1;
				break;
			default:
				data->flags.unknown = 1;
				break;
			}
			if(attribute->bios_can_detect)
				data->flags.bios = 1;
		} else
L
Linus Torvalds 已提交
1675
			data->flags.unknown = 1;
L
Len Brown 已提交
1676

L
Linus Torvalds 已提交
1677 1678 1679
		acpi_video_device_bind(video, data);
		acpi_video_device_find_cap(data);

1680
		status = acpi_install_notify_handler(device->handle,
L
Len Brown 已提交
1681 1682 1683
						     ACPI_DEVICE_NOTIFY,
						     acpi_video_device_notify,
						     data);
L
Linus Torvalds 已提交
1684
		if (ACPI_FAILURE(status)) {
1685 1686
			printk(KERN_ERR PREFIX
					  "Error installing notify handler\n");
1687 1688 1689 1690 1691
			if(data->brightness)
				kfree(data->brightness->levels);
			kfree(data->brightness);
			kfree(data);
			return -ENODEV;
L
Linus Torvalds 已提交
1692 1693
		}

1694
		mutex_lock(&video->device_list_lock);
L
Linus Torvalds 已提交
1695
		list_add_tail(&data->entry, &video->video_device_list);
1696
		mutex_unlock(&video->device_list_lock);
L
Linus Torvalds 已提交
1697 1698 1699

		acpi_video_device_add_fs(device);

1700
		return 0;
L
Linus Torvalds 已提交
1701 1702
	}

1703
	return -ENOENT;
L
Linus Torvalds 已提交
1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715
}

/*
 *  Arg:
 *  	video	: video bus device 
 *
 *  Return:
 *  	none
 *  
 *  Enumerate the video device list of the video bus, 
 *  bind the ids with the corresponding video devices
 *  under the video bus.
L
Len Brown 已提交
1716
 */
L
Linus Torvalds 已提交
1717

L
Len Brown 已提交
1718
static void acpi_video_device_rebind(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
1719
{
1720 1721
	struct acpi_video_device *dev;

1722
	mutex_lock(&video->device_list_lock);
1723 1724

	list_for_each_entry(dev, &video->video_device_list, entry)
L
Len Brown 已提交
1725
		acpi_video_device_bind(video, dev);
1726

1727
	mutex_unlock(&video->device_list_lock);
L
Linus Torvalds 已提交
1728 1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740
}

/*
 *  Arg:
 *  	video	: video bus device 
 *  	device	: video output device under the video 
 *  		bus
 *
 *  Return:
 *  	none
 *  
 *  Bind the ids with the corresponding video devices
 *  under the video bus.
L
Len Brown 已提交
1741
 */
L
Linus Torvalds 已提交
1742 1743

static void
L
Len Brown 已提交
1744 1745
acpi_video_device_bind(struct acpi_video_bus *video,
		       struct acpi_video_device *device)
L
Linus Torvalds 已提交
1746
{
1747
	struct acpi_video_enumerated_device *ids;
L
Len Brown 已提交
1748
	int i;
L
Linus Torvalds 已提交
1749

1750 1751 1752 1753
	for (i = 0; i < video->attached_count; i++) {
		ids = &video->attached_array[i];
		if (device->device_id == (ids->value.int_val & 0xffff)) {
			ids->bind_info = device;
L
Linus Torvalds 已提交
1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767
			ACPI_DEBUG_PRINT((ACPI_DB_INFO, "device_bind %d\n", i));
		}
	}
}

/*
 *  Arg:
 *  	video	: video bus device 
 *
 *  Return:
 *  	< 0	: error
 *  
 *  Call _DOD to enumerate all devices attached to display adapter
 *
L
Len Brown 已提交
1768
 */
L
Linus Torvalds 已提交
1769 1770 1771

static int acpi_video_device_enumerate(struct acpi_video_bus *video)
{
L
Len Brown 已提交
1772 1773 1774
	int status;
	int count;
	int i;
1775
	struct acpi_video_enumerated_device *active_list;
L
Len Brown 已提交
1776 1777 1778
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	union acpi_object *dod = NULL;
	union acpi_object *obj;
L
Linus Torvalds 已提交
1779

1780
	status = acpi_evaluate_object(video->device->handle, "_DOD", NULL, &buffer);
L
Linus Torvalds 已提交
1781
	if (!ACPI_SUCCESS(status)) {
1782
		ACPI_EXCEPTION((AE_INFO, status, "Evaluating _DOD"));
1783
		return status;
L
Linus Torvalds 已提交
1784 1785
	}

1786
	dod = buffer.pointer;
L
Linus Torvalds 已提交
1787
	if (!dod || (dod->type != ACPI_TYPE_PACKAGE)) {
1788
		ACPI_EXCEPTION((AE_INFO, status, "Invalid _DOD data"));
L
Linus Torvalds 已提交
1789 1790 1791 1792 1793
		status = -EFAULT;
		goto out;
	}

	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found %d video heads in _DOD\n",
L
Len Brown 已提交
1794
			  dod->package.count));
L
Linus Torvalds 已提交
1795

1796 1797 1798 1799
	active_list = kcalloc(1 + dod->package.count,
			      sizeof(struct acpi_video_enumerated_device),
			      GFP_KERNEL);
	if (!active_list) {
L
Linus Torvalds 已提交
1800 1801 1802 1803 1804 1805
		status = -ENOMEM;
		goto out;
	}

	count = 0;
	for (i = 0; i < dod->package.count; i++) {
1806
		obj = &dod->package.elements[i];
L
Linus Torvalds 已提交
1807 1808

		if (obj->type != ACPI_TYPE_INTEGER) {
1809 1810 1811
			printk(KERN_ERR PREFIX
				"Invalid _DOD data in element %d\n", i);
			continue;
L
Linus Torvalds 已提交
1812
		}
1813 1814 1815

		active_list[count].value.int_val = obj->integer.value;
		active_list[count].bind_info = NULL;
L
Len Brown 已提交
1816 1817
		ACPI_DEBUG_PRINT((ACPI_DB_INFO, "dod element[%d] = %d\n", i,
				  (int)obj->integer.value));
L
Linus Torvalds 已提交
1818 1819 1820
		count++;
	}

1821
	kfree(video->attached_array);
L
Len Brown 已提交
1822

1823
	video->attached_array = active_list;
L
Linus Torvalds 已提交
1824
	video->attached_count = count;
1825 1826

 out:
1827
	kfree(buffer.pointer);
1828
	return status;
L
Linus Torvalds 已提交
1829 1830
}

L
Len Brown 已提交
1831 1832 1833
static int
acpi_video_get_next_level(struct acpi_video_device *device,
			  u32 level_current, u32 event)
L
Linus Torvalds 已提交
1834
{
1835
	int min, max, min_above, max_below, i, l, delta = 255;
1836 1837
	max = max_below = 0;
	min = min_above = 255;
1838
	/* Find closest level to level_current */
1839
	for (i = 2; i < device->brightness->count; i++) {
1840 1841 1842 1843 1844 1845 1846 1847 1848
		l = device->brightness->levels[i];
		if (abs(l - level_current) < abs(delta)) {
			delta = l - level_current;
			if (!delta)
				break;
		}
	}
	/* Ajust level_current to closest available level */
	level_current += delta;
1849
	for (i = 2; i < device->brightness->count; i++) {
1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873
		l = device->brightness->levels[i];
		if (l < min)
			min = l;
		if (l > max)
			max = l;
		if (l < min_above && l > level_current)
			min_above = l;
		if (l > max_below && l < level_current)
			max_below = l;
	}

	switch (event) {
	case ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS:
		return (level_current < max) ? min_above : min;
	case ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS:
		return (level_current < max) ? min_above : max;
	case ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS:
		return (level_current > min) ? max_below : min;
	case ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS:
	case ACPI_VIDEO_NOTIFY_DISPLAY_OFF:
		return 0;
	default:
		return level_current;
	}
L
Linus Torvalds 已提交
1874 1875
}

1876
static int
L
Len Brown 已提交
1877
acpi_video_switch_brightness(struct acpi_video_device *device, int event)
L
Linus Torvalds 已提交
1878
{
1879
	unsigned long long level_current, level_next;
1880 1881
	int result = -EINVAL;

1882
	if (!device->brightness)
1883 1884 1885 1886 1887 1888 1889
		goto out;

	result = acpi_video_device_lcd_get_level_current(device,
							 &level_current);
	if (result)
		goto out;

L
Linus Torvalds 已提交
1890
	level_next = acpi_video_get_next_level(device, level_current, event);
1891

1892
	result = acpi_video_device_lcd_set_level(device, level_next);
1893 1894 1895 1896 1897 1898

out:
	if (result)
		printk(KERN_ERR PREFIX "Failed to switch the brightness\n");

	return result;
L
Linus Torvalds 已提交
1899 1900 1901
}

static int
L
Len Brown 已提交
1902 1903
acpi_video_bus_get_devices(struct acpi_video_bus *video,
			   struct acpi_device *device)
L
Linus Torvalds 已提交
1904
{
L
Len Brown 已提交
1905
	int status = 0;
1906
	struct acpi_device *dev;
L
Linus Torvalds 已提交
1907 1908 1909

	acpi_video_device_enumerate(video);

1910
	list_for_each_entry(dev, &device->children, node) {
L
Linus Torvalds 已提交
1911 1912 1913

		status = acpi_video_bus_get_one_device(dev, video);
		if (ACPI_FAILURE(status)) {
1914 1915
			printk(KERN_WARNING PREFIX
					"Cant attach device");
L
Linus Torvalds 已提交
1916 1917 1918
			continue;
		}
	}
1919
	return status;
L
Linus Torvalds 已提交
1920 1921
}

L
Len Brown 已提交
1922
static int acpi_video_bus_put_one_device(struct acpi_video_device *device)
L
Linus Torvalds 已提交
1923
{
1924
	acpi_status status;
L
Linus Torvalds 已提交
1925 1926 1927 1928
	struct acpi_video_bus *video;


	if (!device || !device->video)
1929
		return -ENOENT;
L
Linus Torvalds 已提交
1930 1931 1932 1933 1934

	video = device->video;

	acpi_video_device_remove_fs(device->dev);

1935
	status = acpi_remove_notify_handler(device->dev->handle,
L
Len Brown 已提交
1936 1937
					    ACPI_DEVICE_NOTIFY,
					    acpi_video_device_notify);
1938
	backlight_device_unregister(device->backlight);
1939 1940 1941 1942 1943 1944 1945 1946
	if (device->cdev) {
		sysfs_remove_link(&device->dev->dev.kobj,
				  "thermal_cooling");
		sysfs_remove_link(&device->cdev->device.kobj,
				  "device");
		thermal_cooling_device_unregister(device->cdev);
		device->cdev = NULL;
	}
1947
	video_output_unregister(device->output_dev);
1948

1949
	return 0;
L
Linus Torvalds 已提交
1950 1951
}

L
Len Brown 已提交
1952
static int acpi_video_bus_put_devices(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
1953
{
L
Len Brown 已提交
1954
	int status;
1955
	struct acpi_video_device *dev, *next;
L
Linus Torvalds 已提交
1956

1957
	mutex_lock(&video->device_list_lock);
L
Linus Torvalds 已提交
1958

1959
	list_for_each_entry_safe(dev, next, &video->video_device_list, entry) {
L
Linus Torvalds 已提交
1960

1961
		status = acpi_video_bus_put_one_device(dev);
L
Len Brown 已提交
1962 1963 1964
		if (ACPI_FAILURE(status))
			printk(KERN_WARNING PREFIX
			       "hhuuhhuu bug in acpi video driver.\n");
L
Linus Torvalds 已提交
1965

1966 1967 1968 1969 1970 1971
		if (dev->brightness) {
			kfree(dev->brightness->levels);
			kfree(dev->brightness);
		}
		list_del(&dev->entry);
		kfree(dev);
L
Linus Torvalds 已提交
1972 1973
	}

1974
	mutex_unlock(&video->device_list_lock);
1975

1976
	return 0;
L
Linus Torvalds 已提交
1977 1978 1979 1980
}

/* acpi_video interface */

L
Len Brown 已提交
1981
static int acpi_video_bus_start_devices(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
1982
{
1983
	return acpi_video_bus_DOS(video, 0, 0);
L
Linus Torvalds 已提交
1984 1985
}

L
Len Brown 已提交
1986
static int acpi_video_bus_stop_devices(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
1987 1988 1989 1990
{
	return acpi_video_bus_DOS(video, 0, 1);
}

1991
static void acpi_video_bus_notify(struct acpi_device *device, u32 event)
L
Linus Torvalds 已提交
1992
{
1993
	struct acpi_video_bus *video = acpi_driver_data(device);
1994 1995 1996
	struct input_dev *input;
	int keycode;

L
Linus Torvalds 已提交
1997
	if (!video)
1998
		return;
L
Linus Torvalds 已提交
1999

2000
	input = video->input;
L
Linus Torvalds 已提交
2001 2002

	switch (event) {
2003
	case ACPI_VIDEO_NOTIFY_SWITCH:	/* User requested a switch,
L
Linus Torvalds 已提交
2004
					 * most likely via hotkey. */
2005
		acpi_bus_generate_proc_event(device, event, 0);
2006
		keycode = KEY_SWITCHVIDEOMODE;
L
Linus Torvalds 已提交
2007 2008
		break;

2009
	case ACPI_VIDEO_NOTIFY_PROBE:	/* User plugged in or removed a video
L
Linus Torvalds 已提交
2010 2011 2012
					 * connector. */
		acpi_video_device_enumerate(video);
		acpi_video_device_rebind(video);
2013
		acpi_bus_generate_proc_event(device, event, 0);
2014
		keycode = KEY_SWITCHVIDEOMODE;
L
Linus Torvalds 已提交
2015 2016
		break;

L
Len Brown 已提交
2017
	case ACPI_VIDEO_NOTIFY_CYCLE:	/* Cycle Display output hotkey pressed. */
L
Len Brown 已提交
2018
		acpi_bus_generate_proc_event(device, event, 0);
2019 2020
		keycode = KEY_SWITCHVIDEOMODE;
		break;
L
Len Brown 已提交
2021
	case ACPI_VIDEO_NOTIFY_NEXT_OUTPUT:	/* Next Display output hotkey pressed. */
L
Len Brown 已提交
2022
		acpi_bus_generate_proc_event(device, event, 0);
2023 2024
		keycode = KEY_VIDEO_NEXT;
		break;
L
Len Brown 已提交
2025
	case ACPI_VIDEO_NOTIFY_PREV_OUTPUT:	/* previous Display output hotkey pressed. */
2026
		acpi_bus_generate_proc_event(device, event, 0);
2027
		keycode = KEY_VIDEO_PREV;
L
Linus Torvalds 已提交
2028 2029 2030
		break;

	default:
2031
		keycode = KEY_UNKNOWN;
L
Linus Torvalds 已提交
2032
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
L
Len Brown 已提交
2033
				  "Unsupported event [0x%x]\n", event));
L
Linus Torvalds 已提交
2034 2035 2036
		break;
	}

2037
	acpi_notifier_call_chain(device, event, 0);
2038 2039 2040 2041 2042
	input_report_key(input, keycode, 1);
	input_sync(input);
	input_report_key(input, keycode, 0);
	input_sync(input);

2043
	return;
L
Linus Torvalds 已提交
2044 2045
}

L
Len Brown 已提交
2046
static void acpi_video_device_notify(acpi_handle handle, u32 event, void *data)
L
Linus Torvalds 已提交
2047
{
2048
	struct acpi_video_device *video_device = data;
L
Len Brown 已提交
2049
	struct acpi_device *device = NULL;
2050 2051 2052
	struct acpi_video_bus *bus;
	struct input_dev *input;
	int keycode;
L
Linus Torvalds 已提交
2053 2054

	if (!video_device)
2055
		return;
L
Linus Torvalds 已提交
2056

2057
	device = video_device->dev;
2058 2059
	bus = video_device->video;
	input = bus->input;
L
Linus Torvalds 已提交
2060 2061

	switch (event) {
L
Len Brown 已提交
2062
	case ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS:	/* Cycle brightness */
2063 2064
		if (brightness_switch_enabled)
			acpi_video_switch_brightness(video_device, event);
2065
		acpi_bus_generate_proc_event(device, event, 0);
2066 2067
		keycode = KEY_BRIGHTNESS_CYCLE;
		break;
L
Len Brown 已提交
2068
	case ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS:	/* Increase brightness */
2069 2070
		if (brightness_switch_enabled)
			acpi_video_switch_brightness(video_device, event);
L
Len Brown 已提交
2071
		acpi_bus_generate_proc_event(device, event, 0);
2072 2073
		keycode = KEY_BRIGHTNESSUP;
		break;
L
Len Brown 已提交
2074
	case ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS:	/* Decrease brightness */
2075 2076
		if (brightness_switch_enabled)
			acpi_video_switch_brightness(video_device, event);
L
Len Brown 已提交
2077
		acpi_bus_generate_proc_event(device, event, 0);
2078 2079
		keycode = KEY_BRIGHTNESSDOWN;
		break;
L
Len Brown 已提交
2080
	case ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS:	/* zero brightnesss */
2081 2082
		if (brightness_switch_enabled)
			acpi_video_switch_brightness(video_device, event);
L
Len Brown 已提交
2083
		acpi_bus_generate_proc_event(device, event, 0);
2084 2085
		keycode = KEY_BRIGHTNESS_ZERO;
		break;
L
Len Brown 已提交
2086
	case ACPI_VIDEO_NOTIFY_DISPLAY_OFF:	/* display device off */
2087 2088
		if (brightness_switch_enabled)
			acpi_video_switch_brightness(video_device, event);
2089
		acpi_bus_generate_proc_event(device, event, 0);
2090
		keycode = KEY_DISPLAY_OFF;
L
Linus Torvalds 已提交
2091 2092
		break;
	default:
2093
		keycode = KEY_UNKNOWN;
L
Linus Torvalds 已提交
2094
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
L
Len Brown 已提交
2095
				  "Unsupported event [0x%x]\n", event));
L
Linus Torvalds 已提交
2096 2097
		break;
	}
2098

2099
	acpi_notifier_call_chain(device, event, 0);
2100 2101 2102 2103 2104
	input_report_key(input, keycode, 1);
	input_sync(input);
	input_report_key(input, keycode, 0);
	input_sync(input);

2105
	return;
L
Linus Torvalds 已提交
2106 2107
}

2108
static int instance;
2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127
static int acpi_video_resume(struct acpi_device *device)
{
	struct acpi_video_bus *video;
	struct acpi_video_device *video_device;
	int i;

	if (!device || !acpi_driver_data(device))
		return -EINVAL;

	video = acpi_driver_data(device);

	for (i = 0; i < video->attached_count; i++) {
		video_device = video->attached_array[i].bind_info;
		if (video_device && video_device->backlight)
			acpi_video_set_brightness(video_device->backlight);
	}
	return AE_OK;
}

L
Len Brown 已提交
2128
static int acpi_video_bus_add(struct acpi_device *device)
L
Linus Torvalds 已提交
2129
{
2130
	struct acpi_video_bus *video;
2131
	struct input_dev *input;
2132
	int error;
L
Linus Torvalds 已提交
2133

2134
	video = kzalloc(sizeof(struct acpi_video_bus), GFP_KERNEL);
L
Linus Torvalds 已提交
2135
	if (!video)
2136
		return -ENOMEM;
L
Linus Torvalds 已提交
2137

2138 2139 2140 2141 2142 2143
	/* a hack to fix the duplicate name "VID" problem on T61 */
	if (!strcmp(device->pnp.bus_id, "VID")) {
		if (instance)
			device->pnp.bus_id[3] = '0' + instance;
		instance ++;
	}
2144 2145 2146 2147 2148 2149
	/* a hack to fix the duplicate name "VGA" problem on Pa 3553 */
	if (!strcmp(device->pnp.bus_id, "VGA")) {
		if (instance)
			device->pnp.bus_id[3] = '0' + instance;
		instance++;
	}
2150

2151
	video->device = device;
L
Linus Torvalds 已提交
2152 2153
	strcpy(acpi_device_name(device), ACPI_VIDEO_BUS_NAME);
	strcpy(acpi_device_class(device), ACPI_VIDEO_CLASS);
2154
	device->driver_data = video;
L
Linus Torvalds 已提交
2155 2156

	acpi_video_bus_find_cap(video);
2157 2158 2159
	error = acpi_video_bus_check(video);
	if (error)
		goto err_free_video;
L
Linus Torvalds 已提交
2160

2161 2162 2163
	error = acpi_video_bus_add_fs(device);
	if (error)
		goto err_free_video;
L
Linus Torvalds 已提交
2164

2165
	mutex_init(&video->device_list_lock);
L
Linus Torvalds 已提交
2166 2167 2168 2169 2170
	INIT_LIST_HEAD(&video->video_device_list);

	acpi_video_bus_get_devices(video, device);
	acpi_video_bus_start_devices(video);

2171
	video->input = input = input_allocate_device();
2172 2173
	if (!input) {
		error = -ENOMEM;
2174
		goto err_stop_video;
2175
	}
2176 2177 2178 2179 2180 2181 2182 2183

	snprintf(video->phys, sizeof(video->phys),
		"%s/video/input0", acpi_device_hid(video->device));

	input->name = acpi_device_name(video->device);
	input->phys = video->phys;
	input->id.bustype = BUS_HOST;
	input->id.product = 0x06;
2184
	input->dev.parent = &device->dev;
2185 2186 2187 2188 2189 2190 2191 2192 2193 2194 2195
	input->evbit[0] = BIT(EV_KEY);
	set_bit(KEY_SWITCHVIDEOMODE, input->keybit);
	set_bit(KEY_VIDEO_NEXT, input->keybit);
	set_bit(KEY_VIDEO_PREV, input->keybit);
	set_bit(KEY_BRIGHTNESS_CYCLE, input->keybit);
	set_bit(KEY_BRIGHTNESSUP, input->keybit);
	set_bit(KEY_BRIGHTNESSDOWN, input->keybit);
	set_bit(KEY_BRIGHTNESS_ZERO, input->keybit);
	set_bit(KEY_DISPLAY_OFF, input->keybit);
	set_bit(KEY_UNKNOWN, input->keybit);

2196 2197 2198
	error = input_register_device(input);
	if (error)
		goto err_free_input_dev;
2199

L
Linus Torvalds 已提交
2200
	printk(KERN_INFO PREFIX "%s [%s] (multi-head: %s  rom: %s  post: %s)\n",
L
Len Brown 已提交
2201 2202 2203 2204
	       ACPI_VIDEO_DEVICE_NAME, acpi_device_bid(device),
	       video->flags.multihead ? "yes" : "no",
	       video->flags.rom ? "yes" : "no",
	       video->flags.post ? "yes" : "no");
L
Linus Torvalds 已提交
2205

2206 2207 2208 2209 2210 2211 2212 2213 2214 2215 2216
	return 0;

 err_free_input_dev:
	input_free_device(input);
 err_stop_video:
	acpi_video_bus_stop_devices(video);
	acpi_video_bus_put_devices(video);
	kfree(video->attached_array);
	acpi_video_bus_remove_fs(device);
 err_free_video:
	kfree(video);
2217
	device->driver_data = NULL;
L
Linus Torvalds 已提交
2218

2219
	return error;
L
Linus Torvalds 已提交
2220 2221
}

L
Len Brown 已提交
2222
static int acpi_video_bus_remove(struct acpi_device *device, int type)
L
Linus Torvalds 已提交
2223
{
L
Len Brown 已提交
2224
	struct acpi_video_bus *video = NULL;
L
Linus Torvalds 已提交
2225 2226 2227


	if (!device || !acpi_driver_data(device))
2228
		return -EINVAL;
L
Linus Torvalds 已提交
2229

2230
	video = acpi_driver_data(device);
L
Linus Torvalds 已提交
2231 2232 2233 2234 2235

	acpi_video_bus_stop_devices(video);
	acpi_video_bus_put_devices(video);
	acpi_video_bus_remove_fs(device);

2236
	input_unregister_device(video->input);
2237
	kfree(video->attached_array);
L
Linus Torvalds 已提交
2238 2239
	kfree(video);

2240
	return 0;
L
Linus Torvalds 已提交
2241 2242
}

2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253 2254 2255 2256 2257 2258 2259 2260 2261 2262 2263
static int __init intel_opregion_present(void)
{
#if defined(CONFIG_DRM_I915) || defined(CONFIG_DRM_I915_MODULE)
	struct pci_dev *dev = NULL;
	u32 address;

	for_each_pci_dev(dev) {
		if ((dev->class >> 8) != PCI_CLASS_DISPLAY_VGA)
			continue;
		if (dev->vendor != PCI_VENDOR_ID_INTEL)
			continue;
		pci_read_config_dword(dev, 0xfc, &address);
		if (!address)
			continue;
		return 1;
	}
#endif
	return 0;
}

int acpi_video_register(void)
L
Linus Torvalds 已提交
2264
{
L
Len Brown 已提交
2265
	int result = 0;
L
Linus Torvalds 已提交
2266 2267 2268

	acpi_video_dir = proc_mkdir(ACPI_VIDEO_CLASS, acpi_root_dir);
	if (!acpi_video_dir)
2269
		return -ENODEV;
L
Linus Torvalds 已提交
2270 2271 2272 2273

	result = acpi_bus_register_driver(&acpi_video_bus);
	if (result < 0) {
		remove_proc_entry(ACPI_VIDEO_CLASS, acpi_root_dir);
2274
		return -ENODEV;
L
Linus Torvalds 已提交
2275 2276
	}

2277
	return 0;
L
Linus Torvalds 已提交
2278
}
2279 2280 2281 2282 2283 2284 2285 2286 2287 2288 2289 2290 2291 2292 2293 2294
EXPORT_SYMBOL(acpi_video_register);

/*
 * This is kind of nasty. Hardware using Intel chipsets may require
 * the video opregion code to be run first in order to initialise
 * state before any ACPI video calls are made. To handle this we defer
 * registration of the video class until the opregion code has run.
 */

static int __init acpi_video_init(void)
{
	if (intel_opregion_present())
		return 0;

	return acpi_video_register();
}
L
Linus Torvalds 已提交
2295

L
Len Brown 已提交
2296
static void __exit acpi_video_exit(void)
L
Linus Torvalds 已提交
2297 2298 2299 2300 2301 2302
{

	acpi_bus_unregister_driver(&acpi_video_bus);

	remove_proc_entry(ACPI_VIDEO_CLASS, acpi_root_dir);

2303
	return;
L
Linus Torvalds 已提交
2304 2305 2306 2307
}

module_init(acpi_video_init);
module_exit(acpi_video_exit);