blob: 1887e2f166a43edeb449ae2851c8f77a8a63bcfc [file] [log] [blame]
Cezary Jackiewicz54115522008-06-09 16:22:22 -07001/*-*-linux-c-*-*/
2
3/*
4 Copyright (C) 2008 Cezary Jackiewicz <cezary.jackiewicz (at) gmail.com>
5
6 based on MSI driver
7
8 Copyright (C) 2006 Lennart Poettering <mzxreary (at) 0pointer (dot) de>
9
10 This program is free software; you can redistribute it and/or modify
11 it under the terms of the GNU General Public License as published by
12 the Free Software Foundation; either version 2 of the License, or
13 (at your option) any later version.
14
15 This program is distributed in the hope that it will be useful, but
16 WITHOUT ANY WARRANTY; without even the implied warranty of
17 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
18 General Public License for more details.
19
20 You should have received a copy of the GNU General Public License
21 along with this program; if not, write to the Free Software
22 Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
23 02110-1301, USA.
24 */
25
26/*
Roald Frederickx9be0fcb2010-07-20 15:19:39 -070027 * compal-laptop.c - Compal laptop support.
Cezary Jackiewicz54115522008-06-09 16:22:22 -070028 *
Roald Frederickx9be0fcb2010-07-20 15:19:39 -070029 * This driver exports a few files in /sys/devices/platform/compal-laptop/:
30 * wake_up_XXX Whether or not we listen to such wake up events (rw)
31 *
32 * In addition to these platform device attributes the driver
33 * registers itself in the Linux backlight control, power_supply, rfkill
34 * and hwmon subsystem and is available to userspace under:
35 *
36 * /sys/class/backlight/compal-laptop/
37 * /sys/class/power_supply/compal-laptop/
38 * /sys/class/rfkill/rfkillX/
39 * /sys/class/hwmon/hwmonX/
40 *
41 * Notes on the power_supply battery interface:
42 * - the "minimum" design voltage is *the* design voltage
43 * - the ambient temperature is the average battery temperature
44 * and the value is an educated guess (see commented code below)
45 *
Cezary Jackiewicz54115522008-06-09 16:22:22 -070046 *
47 * This driver might work on other laptops produced by Compal. If you
48 * want to try it you can pass force=1 as argument to the module which
49 * will force it to load even when the DMI data doesn't identify the
Roald Frederickx9be0fcb2010-07-20 15:19:39 -070050 * laptop as compatible.
51 *
52 * Lots of data available at:
53 * http://service1.marasst.com/Compal/JHL90_91/Service%20Manual/
54 * JHL90%20service%20manual-Final-0725.pdf
55 *
56 *
57 *
58 * Support for the Compal JHL90 added by Roald Frederickx
59 * (roald.frederickx@gmail.com):
60 * Driver got large revision. Added functionalities: backlight
61 * power, wake_on_XXX, a hwmon and power_supply interface.
62 *
63 * In case this gets merged into the kernel source: I want to dedicate this
64 * to Kasper Meerts, the awesome guy who showed me Linux and C!
Cezary Jackiewicz54115522008-06-09 16:22:22 -070065 */
66
Roald Frederickx9be0fcb2010-07-20 15:19:39 -070067/* NOTE: currently the wake_on_XXX, hwmon and power_supply interfaces are
68 * only enabled on a JHL90 board until it is verified that they work on the
69 * other boards too. See the extra_features variable. */
70
Joe Perchesb4a4bc02011-03-29 15:21:36 -070071#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
72
Cezary Jackiewicz54115522008-06-09 16:22:22 -070073#include <linux/module.h>
74#include <linux/kernel.h>
75#include <linux/init.h>
76#include <linux/acpi.h>
77#include <linux/dmi.h>
78#include <linux/backlight.h>
79#include <linux/platform_device.h>
Mario Limonciello493e9142009-08-25 10:30:13 -050080#include <linux/rfkill.h>
Roald Frederickx9be0fcb2010-07-20 15:19:39 -070081#include <linux/hwmon.h>
82#include <linux/hwmon-sysfs.h>
83#include <linux/power_supply.h>
84#include <linux/fb.h>
Cezary Jackiewicz54115522008-06-09 16:22:22 -070085
Cezary Jackiewicz54115522008-06-09 16:22:22 -070086
Roald Frederickx9be0fcb2010-07-20 15:19:39 -070087/* ======= */
88/* Defines */
89/* ======= */
90#define DRIVER_NAME "compal-laptop"
91#define DRIVER_VERSION "0.2.7"
Cezary Jackiewicz54115522008-06-09 16:22:22 -070092
Roald Frederickx9be0fcb2010-07-20 15:19:39 -070093#define BACKLIGHT_LEVEL_ADDR 0xB9
94#define BACKLIGHT_LEVEL_MAX 7
95#define BACKLIGHT_STATE_ADDR 0x59
96#define BACKLIGHT_STATE_ON_DATA 0xE1
97#define BACKLIGHT_STATE_OFF_DATA 0xE2
Cezary Jackiewicz54115522008-06-09 16:22:22 -070098
Roald Frederickx9be0fcb2010-07-20 15:19:39 -070099#define WAKE_UP_ADDR 0xA4
100#define WAKE_UP_PME (1 << 0)
101#define WAKE_UP_MODEM (1 << 1)
102#define WAKE_UP_LAN (1 << 2)
103#define WAKE_UP_WLAN (1 << 4)
104#define WAKE_UP_KEY (1 << 6)
105#define WAKE_UP_MOUSE (1 << 7)
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700106
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700107#define WIRELESS_ADDR 0xBB
108#define WIRELESS_WLAN (1 << 0)
109#define WIRELESS_BT (1 << 1)
110#define WIRELESS_WLAN_EXISTS (1 << 2)
111#define WIRELESS_BT_EXISTS (1 << 3)
112#define WIRELESS_KILLSWITCH (1 << 4)
Mario Limonciello493e9142009-08-25 10:30:13 -0500113
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700114#define PWM_ADDRESS 0x46
115#define PWM_DISABLE_ADDR 0x59
116#define PWM_DISABLE_DATA 0xA5
117#define PWM_ENABLE_ADDR 0x59
118#define PWM_ENABLE_DATA 0xA8
119
120#define FAN_ADDRESS 0x46
121#define FAN_DATA 0x81
122#define FAN_FULL_ON_CMD 0x59 /* Doesn't seem to work. Just */
123#define FAN_FULL_ON_ENABLE 0x76 /* force the pwm signal to its */
124#define FAN_FULL_ON_DISABLE 0x77 /* maximum value instead */
125
126#define TEMP_CPU 0xB0
127#define TEMP_CPU_LOCAL 0xB1
128#define TEMP_CPU_DTS 0xB5
129#define TEMP_NORTHBRIDGE 0xB6
130#define TEMP_VGA 0xB4
131#define TEMP_SKIN 0xB2
132
133#define BAT_MANUFACTURER_NAME_ADDR 0x10
134#define BAT_MANUFACTURER_NAME_LEN 9
135#define BAT_MODEL_NAME_ADDR 0x19
136#define BAT_MODEL_NAME_LEN 6
137#define BAT_SERIAL_NUMBER_ADDR 0xC4
138#define BAT_SERIAL_NUMBER_LEN 5
139#define BAT_CHARGE_NOW 0xC2
140#define BAT_CHARGE_DESIGN 0xCA
141#define BAT_VOLTAGE_NOW 0xC6
142#define BAT_VOLTAGE_DESIGN 0xC8
143#define BAT_CURRENT_NOW 0xD0
144#define BAT_CURRENT_AVG 0xD2
145#define BAT_POWER 0xD4
146#define BAT_CAPACITY 0xCE
147#define BAT_TEMP 0xD6
148#define BAT_TEMP_AVG 0xD7
149#define BAT_STATUS0 0xC1
150#define BAT_STATUS1 0xF0
151#define BAT_STATUS2 0xF1
152#define BAT_STOP_CHARGE1 0xF2
153#define BAT_STOP_CHARGE2 0xF3
154
155#define BAT_S0_DISCHARGE (1 << 0)
156#define BAT_S0_DISCHRG_CRITICAL (1 << 2)
157#define BAT_S0_LOW (1 << 3)
158#define BAT_S0_CHARGING (1 << 1)
159#define BAT_S0_AC (1 << 7)
160#define BAT_S1_EXISTS (1 << 0)
161#define BAT_S1_FULL (1 << 1)
162#define BAT_S1_EMPTY (1 << 2)
163#define BAT_S1_LiION_OR_NiMH (1 << 7)
164#define BAT_S2_LOW_LOW (1 << 0)
165#define BAT_STOP_CHRG1_BAD_CELL (1 << 1)
166#define BAT_STOP_CHRG1_COMM_FAIL (1 << 2)
167#define BAT_STOP_CHRG1_OVERVOLTAGE (1 << 6)
168#define BAT_STOP_CHRG1_OVERTEMPERATURE (1 << 7)
169
170
171/* ======= */
172/* Structs */
173/* ======= */
174struct compal_data{
175 /* Fan control */
176 struct device *hwmon_dev;
177 int pwm_enable; /* 0:full on, 1:set by pwm1, 2:control by moterboard */
178 unsigned char curr_pwm;
179
180 /* Power supply */
181 struct power_supply psy;
182 struct power_supply_info psy_info;
183 char bat_model_name[BAT_MODEL_NAME_LEN + 1];
184 char bat_manufacturer_name[BAT_MANUFACTURER_NAME_LEN + 1];
185 char bat_serial_number[BAT_SERIAL_NUMBER_LEN + 1];
186};
187
188
189/* =============== */
190/* General globals */
191/* =============== */
Rusty Russell90ab5ee2012-01-13 09:32:20 +1030192static bool force;
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700193module_param(force, bool, 0);
194MODULE_PARM_DESC(force, "Force driver load, ignore DMI data");
195
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700196/* Support for the wake_on_XXX, hwmon and power_supply interface. Currently
197 * only gets enabled on a JHL90 board. Might work with the others too */
198static bool extra_features;
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700199
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700200/* Nasty stuff. For some reason the fan control is very un-linear. I've
201 * come up with these values by looping through the possible inputs and
202 * watching the output of address 0x4F (do an ec_transaction writing 0x33
203 * into 0x4F and read a few bytes from the output, like so:
204 * u8 writeData = 0x33;
Thomas Renninger1cb7b1e2011-03-31 13:36:38 +0200205 * ec_transaction(0x4F, &writeData, 1, buffer, 32);
Len Brown751516f2011-05-29 04:40:39 -0400206 * That address is labeled "fan1 table information" in the service manual.
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700207 * It should be clear which value in 'buffer' changes). This seems to be
208 * related to fan speed. It isn't a proper 'realtime' fan speed value
209 * though, because physically stopping or speeding up the fan doesn't
210 * change it. It might be the average voltage or current of the pwm output.
211 * Nevertheless, it is more fine-grained than the actual RPM reading */
212static const unsigned char pwm_lookup_table[256] = {
213 0, 0, 0, 1, 1, 1, 2, 253, 254, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6,
214 7, 7, 7, 8, 86, 86, 9, 9, 9, 10, 10, 10, 11, 92, 92, 12, 12, 95,
215 13, 66, 66, 14, 14, 98, 15, 15, 15, 16, 16, 67, 17, 17, 72, 18, 70,
216 75, 19, 90, 90, 73, 73, 73, 21, 21, 91, 91, 91, 96, 23, 94, 94, 94,
217 94, 94, 94, 94, 94, 94, 94, 141, 141, 238, 223, 192, 139, 139, 139,
218 139, 139, 142, 142, 142, 142, 142, 78, 78, 78, 78, 78, 76, 76, 76,
219 76, 76, 79, 79, 79, 79, 79, 79, 79, 20, 20, 20, 20, 20, 22, 22, 22,
220 22, 22, 24, 24, 24, 24, 24, 24, 219, 219, 219, 219, 219, 219, 219,
221 219, 27, 27, 188, 188, 28, 28, 28, 29, 186, 186, 186, 186, 186,
222 186, 186, 186, 186, 186, 31, 31, 31, 31, 31, 32, 32, 32, 41, 33,
223 33, 33, 33, 33, 252, 252, 34, 34, 34, 43, 35, 35, 35, 36, 36, 38,
224 206, 206, 206, 206, 206, 206, 206, 206, 206, 37, 37, 37, 46, 46,
225 47, 47, 232, 232, 232, 232, 232, 232, 232, 232, 232, 232, 48, 48,
226 48, 48, 48, 40, 40, 40, 49, 42, 42, 42, 42, 42, 42, 42, 42, 44,
227 189, 189, 189, 189, 54, 54, 45, 45, 45, 45, 45, 45, 45, 45, 251,
228 191, 199, 199, 199, 199, 199, 215, 215, 215, 215, 187, 187, 187,
229 187, 187, 193, 50
230};
231
232
233
234
235/* ========================= */
236/* Hardware access functions */
237/* ========================= */
238/* General access */
239static u8 ec_read_u8(u8 addr)
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700240{
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700241 u8 value;
242 ec_read(addr, &value);
243 return value;
244}
245
246static s8 ec_read_s8(u8 addr)
247{
248 return (s8)ec_read_u8(addr);
249}
250
251static u16 ec_read_u16(u8 addr)
252{
253 int hi, lo;
254 lo = ec_read_u8(addr);
255 hi = ec_read_u8(addr + 1);
256 return (hi << 8) + lo;
257}
258
259static s16 ec_read_s16(u8 addr)
260{
261 return (s16) ec_read_u16(addr);
262}
263
264static void ec_read_sequence(u8 addr, u8 *buf, int len)
265{
266 int i;
267 for (i = 0; i < len; i++)
268 ec_read(addr + i, buf + i);
269}
270
271
272/* Backlight access */
273static int set_backlight_level(int level)
274{
275 if (level < 0 || level > BACKLIGHT_LEVEL_MAX)
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700276 return -EINVAL;
277
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700278 ec_write(BACKLIGHT_LEVEL_ADDR, level);
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700279
Axel Lin0e4510f2011-03-14 18:53:14 +0800280 return 0;
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700281}
282
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700283static int get_backlight_level(void)
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700284{
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700285 return (int) ec_read_u8(BACKLIGHT_LEVEL_ADDR);
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700286}
287
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700288static void set_backlight_state(bool on)
289{
290 u8 data = on ? BACKLIGHT_STATE_ON_DATA : BACKLIGHT_STATE_OFF_DATA;
Thomas Renninger1cb7b1e2011-03-31 13:36:38 +0200291 ec_transaction(BACKLIGHT_STATE_ADDR, &data, 1, NULL, 0);
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700292}
293
294
295/* Fan control access */
296static void pwm_enable_control(void)
297{
298 unsigned char writeData = PWM_ENABLE_DATA;
Thomas Renninger1cb7b1e2011-03-31 13:36:38 +0200299 ec_transaction(PWM_ENABLE_ADDR, &writeData, 1, NULL, 0);
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700300}
301
302static void pwm_disable_control(void)
303{
304 unsigned char writeData = PWM_DISABLE_DATA;
Thomas Renninger1cb7b1e2011-03-31 13:36:38 +0200305 ec_transaction(PWM_DISABLE_ADDR, &writeData, 1, NULL, 0);
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700306}
307
308static void set_pwm(int pwm)
309{
Thomas Renninger1cb7b1e2011-03-31 13:36:38 +0200310 ec_transaction(PWM_ADDRESS, &pwm_lookup_table[pwm], 1, NULL, 0);
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700311}
312
313static int get_fan_rpm(void)
314{
315 u8 value, data = FAN_DATA;
Thomas Renninger1cb7b1e2011-03-31 13:36:38 +0200316 ec_transaction(FAN_ADDRESS, &data, 1, &value, 1);
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700317 return 100 * (int)value;
318}
319
320
321
322
323/* =================== */
324/* Interface functions */
325/* =================== */
326
327/* Backlight interface */
328static int bl_get_brightness(struct backlight_device *b)
329{
330 return get_backlight_level();
331}
332
333static int bl_update_status(struct backlight_device *b)
334{
335 int ret = set_backlight_level(b->props.brightness);
336 if (ret)
337 return ret;
338
339 set_backlight_state((b->props.power == FB_BLANK_UNBLANK)
340 && !(b->props.state & BL_CORE_SUSPENDED)
341 && !(b->props.state & BL_CORE_FBBLANK));
342 return 0;
343}
344
345static const struct backlight_ops compalbl_ops = {
346 .get_brightness = bl_get_brightness,
347 .update_status = bl_update_status,
348};
349
350
351/* Wireless interface */
Mario Limonciello493e9142009-08-25 10:30:13 -0500352static int compal_rfkill_set(void *data, bool blocked)
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700353{
Mario Limonciello493e9142009-08-25 10:30:13 -0500354 unsigned long radio = (unsigned long) data;
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700355 u8 result = ec_read_u8(WIRELESS_ADDR);
356 u8 value;
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700357
Mario Limonciello493e9142009-08-25 10:30:13 -0500358 if (!blocked)
359 value = (u8) (result | radio);
360 else
361 value = (u8) (result & ~radio);
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700362 ec_write(WIRELESS_ADDR, value);
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700363
364 return 0;
365}
366
Mario Limonciello493e9142009-08-25 10:30:13 -0500367static void compal_rfkill_poll(struct rfkill *rfkill, void *data)
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700368{
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700369 u8 result = ec_read_u8(WIRELESS_ADDR);
370 bool hw_blocked = !(result & WIRELESS_KILLSWITCH);
Mario Limonciello493e9142009-08-25 10:30:13 -0500371 rfkill_set_hw_state(rfkill, hw_blocked);
372}
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700373
Mario Limonciello493e9142009-08-25 10:30:13 -0500374static const struct rfkill_ops compal_rfkill_ops = {
375 .poll = compal_rfkill_poll,
376 .set_block = compal_rfkill_set,
377};
378
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700379
380/* Wake_up interface */
381#define SIMPLE_MASKED_STORE_SHOW(NAME, ADDR, MASK) \
382static ssize_t NAME##_show(struct device *dev, \
383 struct device_attribute *attr, char *buf) \
384{ \
385 return sprintf(buf, "%d\n", ((ec_read_u8(ADDR) & MASK) != 0)); \
386} \
387static ssize_t NAME##_store(struct device *dev, \
388 struct device_attribute *attr, const char *buf, size_t count) \
389{ \
390 int state; \
391 u8 old_val = ec_read_u8(ADDR); \
392 if (sscanf(buf, "%d", &state) != 1 || (state < 0 || state > 1)) \
393 return -EINVAL; \
394 ec_write(ADDR, state ? (old_val | MASK) : (old_val & ~MASK)); \
395 return count; \
396}
397
398SIMPLE_MASKED_STORE_SHOW(wake_up_pme, WAKE_UP_ADDR, WAKE_UP_PME)
399SIMPLE_MASKED_STORE_SHOW(wake_up_modem, WAKE_UP_ADDR, WAKE_UP_MODEM)
400SIMPLE_MASKED_STORE_SHOW(wake_up_lan, WAKE_UP_ADDR, WAKE_UP_LAN)
401SIMPLE_MASKED_STORE_SHOW(wake_up_wlan, WAKE_UP_ADDR, WAKE_UP_WLAN)
402SIMPLE_MASKED_STORE_SHOW(wake_up_key, WAKE_UP_ADDR, WAKE_UP_KEY)
403SIMPLE_MASKED_STORE_SHOW(wake_up_mouse, WAKE_UP_ADDR, WAKE_UP_MOUSE)
404
405
406/* General hwmon interface */
407static ssize_t hwmon_name_show(struct device *dev,
408 struct device_attribute *attr, char *buf)
Mario Limonciello493e9142009-08-25 10:30:13 -0500409{
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700410 return sprintf(buf, "%s\n", DRIVER_NAME);
411}
Mario Limonciello493e9142009-08-25 10:30:13 -0500412
Mario Limonciello493e9142009-08-25 10:30:13 -0500413
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700414/* Fan control interface */
415static ssize_t pwm_enable_show(struct device *dev,
416 struct device_attribute *attr, char *buf)
417{
418 struct compal_data *data = dev_get_drvdata(dev);
419 return sprintf(buf, "%d\n", data->pwm_enable);
420}
Mario Limonciello493e9142009-08-25 10:30:13 -0500421
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700422static ssize_t pwm_enable_store(struct device *dev,
423 struct device_attribute *attr, const char *buf, size_t count)
424{
425 struct compal_data *data = dev_get_drvdata(dev);
426 long val;
427 int err;
428 err = strict_strtol(buf, 10, &val);
429 if (err)
430 return err;
431 if (val < 0)
432 return -EINVAL;
433
434 data->pwm_enable = val;
435
436 switch (val) {
437 case 0: /* Full speed */
438 pwm_enable_control();
439 set_pwm(255);
440 break;
441 case 1: /* As set by pwm1 */
442 pwm_enable_control();
443 set_pwm(data->curr_pwm);
444 break;
445 default: /* Control by motherboard */
446 pwm_disable_control();
447 break;
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700448 }
449
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700450 return count;
451}
452
453static ssize_t pwm_show(struct device *dev, struct device_attribute *attr,
454 char *buf)
455{
456 struct compal_data *data = dev_get_drvdata(dev);
457 return sprintf(buf, "%hhu\n", data->curr_pwm);
458}
459
460static ssize_t pwm_store(struct device *dev, struct device_attribute *attr,
461 const char *buf, size_t count)
462{
463 struct compal_data *data = dev_get_drvdata(dev);
464 long val;
465 int err;
466 err = strict_strtol(buf, 10, &val);
467 if (err)
468 return err;
469 if (val < 0 || val > 255)
470 return -EINVAL;
471
472 data->curr_pwm = val;
473
474 if (data->pwm_enable != 1)
475 return count;
476 set_pwm(val);
477
478 return count;
479}
480
481static ssize_t fan_show(struct device *dev, struct device_attribute *attr,
482 char *buf)
483{
484 return sprintf(buf, "%d\n", get_fan_rpm());
485}
486
487
488/* Temperature interface */
489#define TEMPERATURE_SHOW_TEMP_AND_LABEL(POSTFIX, ADDRESS, LABEL) \
490static ssize_t temp_##POSTFIX(struct device *dev, \
491 struct device_attribute *attr, char *buf) \
492{ \
493 return sprintf(buf, "%d\n", 1000 * (int)ec_read_s8(ADDRESS)); \
494} \
495static ssize_t label_##POSTFIX(struct device *dev, \
496 struct device_attribute *attr, char *buf) \
497{ \
498 return sprintf(buf, "%s\n", LABEL); \
499}
500
501/* Labels as in service guide */
502TEMPERATURE_SHOW_TEMP_AND_LABEL(cpu, TEMP_CPU, "CPU_TEMP");
503TEMPERATURE_SHOW_TEMP_AND_LABEL(cpu_local, TEMP_CPU_LOCAL, "CPU_TEMP_LOCAL");
504TEMPERATURE_SHOW_TEMP_AND_LABEL(cpu_DTS, TEMP_CPU_DTS, "CPU_DTS");
505TEMPERATURE_SHOW_TEMP_AND_LABEL(northbridge,TEMP_NORTHBRIDGE,"NorthBridge");
506TEMPERATURE_SHOW_TEMP_AND_LABEL(vga, TEMP_VGA, "VGA_TEMP");
507TEMPERATURE_SHOW_TEMP_AND_LABEL(SKIN, TEMP_SKIN, "SKIN_TEMP90");
508
509
510/* Power supply interface */
511static int bat_status(void)
512{
513 u8 status0 = ec_read_u8(BAT_STATUS0);
514 u8 status1 = ec_read_u8(BAT_STATUS1);
515
516 if (status0 & BAT_S0_CHARGING)
517 return POWER_SUPPLY_STATUS_CHARGING;
518 if (status0 & BAT_S0_DISCHARGE)
519 return POWER_SUPPLY_STATUS_DISCHARGING;
520 if (status1 & BAT_S1_FULL)
521 return POWER_SUPPLY_STATUS_FULL;
522 return POWER_SUPPLY_STATUS_NOT_CHARGING;
523}
524
525static int bat_health(void)
526{
527 u8 status = ec_read_u8(BAT_STOP_CHARGE1);
528
529 if (status & BAT_STOP_CHRG1_OVERTEMPERATURE)
530 return POWER_SUPPLY_HEALTH_OVERHEAT;
531 if (status & BAT_STOP_CHRG1_OVERVOLTAGE)
532 return POWER_SUPPLY_HEALTH_OVERVOLTAGE;
533 if (status & BAT_STOP_CHRG1_BAD_CELL)
534 return POWER_SUPPLY_HEALTH_DEAD;
535 if (status & BAT_STOP_CHRG1_COMM_FAIL)
536 return POWER_SUPPLY_HEALTH_UNKNOWN;
537 return POWER_SUPPLY_HEALTH_GOOD;
538}
539
540static int bat_is_present(void)
541{
542 u8 status = ec_read_u8(BAT_STATUS2);
543 return ((status & BAT_S1_EXISTS) != 0);
544}
545
546static int bat_technology(void)
547{
548 u8 status = ec_read_u8(BAT_STATUS1);
549
550 if (status & BAT_S1_LiION_OR_NiMH)
551 return POWER_SUPPLY_TECHNOLOGY_LION;
552 return POWER_SUPPLY_TECHNOLOGY_NiMH;
553}
554
555static int bat_capacity_level(void)
556{
557 u8 status0 = ec_read_u8(BAT_STATUS0);
558 u8 status1 = ec_read_u8(BAT_STATUS1);
559 u8 status2 = ec_read_u8(BAT_STATUS2);
560
561 if (status0 & BAT_S0_DISCHRG_CRITICAL
562 || status1 & BAT_S1_EMPTY
563 || status2 & BAT_S2_LOW_LOW)
564 return POWER_SUPPLY_CAPACITY_LEVEL_CRITICAL;
565 if (status0 & BAT_S0_LOW)
566 return POWER_SUPPLY_CAPACITY_LEVEL_LOW;
567 if (status1 & BAT_S1_FULL)
568 return POWER_SUPPLY_CAPACITY_LEVEL_FULL;
569 return POWER_SUPPLY_CAPACITY_LEVEL_NORMAL;
570}
571
572static int bat_get_property(struct power_supply *psy,
573 enum power_supply_property psp,
574 union power_supply_propval *val)
575{
576 struct compal_data *data;
577 data = container_of(psy, struct compal_data, psy);
578
579 switch (psp) {
580 case POWER_SUPPLY_PROP_STATUS:
581 val->intval = bat_status();
582 break;
583 case POWER_SUPPLY_PROP_HEALTH:
584 val->intval = bat_health();
585 break;
586 case POWER_SUPPLY_PROP_PRESENT:
587 val->intval = bat_is_present();
588 break;
589 case POWER_SUPPLY_PROP_TECHNOLOGY:
590 val->intval = bat_technology();
591 break;
592 case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN: /* THE design voltage... */
593 val->intval = ec_read_u16(BAT_VOLTAGE_DESIGN) * 1000;
594 break;
595 case POWER_SUPPLY_PROP_VOLTAGE_NOW:
596 val->intval = ec_read_u16(BAT_VOLTAGE_NOW) * 1000;
597 break;
598 case POWER_SUPPLY_PROP_CURRENT_NOW:
599 val->intval = ec_read_s16(BAT_CURRENT_NOW) * 1000;
600 break;
601 case POWER_SUPPLY_PROP_CURRENT_AVG:
602 val->intval = ec_read_s16(BAT_CURRENT_AVG) * 1000;
603 break;
604 case POWER_SUPPLY_PROP_POWER_NOW:
605 val->intval = ec_read_u8(BAT_POWER) * 1000000;
606 break;
607 case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
608 val->intval = ec_read_u16(BAT_CHARGE_DESIGN) * 1000;
609 break;
610 case POWER_SUPPLY_PROP_CHARGE_NOW:
611 val->intval = ec_read_u16(BAT_CHARGE_NOW) * 1000;
612 break;
613 case POWER_SUPPLY_PROP_CAPACITY:
614 val->intval = ec_read_u8(BAT_CAPACITY);
615 break;
616 case POWER_SUPPLY_PROP_CAPACITY_LEVEL:
617 val->intval = bat_capacity_level();
618 break;
619 /* It smees that BAT_TEMP_AVG is a (2's complement?) value showing
620 * the number of degrees, whereas BAT_TEMP is somewhat more
621 * complicated. It looks like this is a negative nember with a
622 * 100/256 divider and an offset of 222. Both were determined
623 * experimentally by comparing BAT_TEMP and BAT_TEMP_AVG. */
624 case POWER_SUPPLY_PROP_TEMP:
625 val->intval = ((222 - (int)ec_read_u8(BAT_TEMP)) * 1000) >> 8;
626 break;
627 case POWER_SUPPLY_PROP_TEMP_AMBIENT: /* Ambient, Avg, ... same thing */
628 val->intval = ec_read_s8(BAT_TEMP_AVG) * 10;
629 break;
630 /* Neither the model name nor manufacturer name work for me. */
631 case POWER_SUPPLY_PROP_MODEL_NAME:
632 val->strval = data->bat_model_name;
633 break;
634 case POWER_SUPPLY_PROP_MANUFACTURER:
635 val->strval = data->bat_manufacturer_name;
636 break;
637 case POWER_SUPPLY_PROP_SERIAL_NUMBER:
638 val->strval = data->bat_serial_number;
639 break;
640 default:
641 break;
642 }
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700643 return 0;
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700644}
645
646
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700647
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700648
649
650/* ============== */
651/* Driver Globals */
652/* ============== */
653static DEVICE_ATTR(wake_up_pme,
654 0644, wake_up_pme_show, wake_up_pme_store);
655static DEVICE_ATTR(wake_up_modem,
656 0644, wake_up_modem_show, wake_up_modem_store);
657static DEVICE_ATTR(wake_up_lan,
658 0644, wake_up_lan_show, wake_up_lan_store);
659static DEVICE_ATTR(wake_up_wlan,
660 0644, wake_up_wlan_show, wake_up_wlan_store);
661static DEVICE_ATTR(wake_up_key,
662 0644, wake_up_key_show, wake_up_key_store);
663static DEVICE_ATTR(wake_up_mouse,
664 0644, wake_up_mouse_show, wake_up_mouse_store);
665
666static SENSOR_DEVICE_ATTR(name, S_IRUGO, hwmon_name_show, NULL, 1);
667static SENSOR_DEVICE_ATTR(fan1_input, S_IRUGO, fan_show, NULL, 1);
668static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, temp_cpu, NULL, 1);
669static SENSOR_DEVICE_ATTR(temp2_input, S_IRUGO, temp_cpu_local, NULL, 1);
670static SENSOR_DEVICE_ATTR(temp3_input, S_IRUGO, temp_cpu_DTS, NULL, 1);
671static SENSOR_DEVICE_ATTR(temp4_input, S_IRUGO, temp_northbridge, NULL, 1);
672static SENSOR_DEVICE_ATTR(temp5_input, S_IRUGO, temp_vga, NULL, 1);
673static SENSOR_DEVICE_ATTR(temp6_input, S_IRUGO, temp_SKIN, NULL, 1);
674static SENSOR_DEVICE_ATTR(temp1_label, S_IRUGO, label_cpu, NULL, 1);
675static SENSOR_DEVICE_ATTR(temp2_label, S_IRUGO, label_cpu_local, NULL, 1);
676static SENSOR_DEVICE_ATTR(temp3_label, S_IRUGO, label_cpu_DTS, NULL, 1);
677static SENSOR_DEVICE_ATTR(temp4_label, S_IRUGO, label_northbridge, NULL, 1);
678static SENSOR_DEVICE_ATTR(temp5_label, S_IRUGO, label_vga, NULL, 1);
679static SENSOR_DEVICE_ATTR(temp6_label, S_IRUGO, label_SKIN, NULL, 1);
680static SENSOR_DEVICE_ATTR(pwm1, S_IRUGO | S_IWUSR, pwm_show, pwm_store, 1);
681static SENSOR_DEVICE_ATTR(pwm1_enable,
682 S_IRUGO | S_IWUSR, pwm_enable_show, pwm_enable_store, 0);
683
684static struct attribute *compal_attributes[] = {
685 &dev_attr_wake_up_pme.attr,
686 &dev_attr_wake_up_modem.attr,
687 &dev_attr_wake_up_lan.attr,
688 &dev_attr_wake_up_wlan.attr,
689 &dev_attr_wake_up_key.attr,
690 &dev_attr_wake_up_mouse.attr,
691 /* Maybe put the sensor-stuff in a separate hwmon-driver? That way,
692 * the hwmon sysfs won't be cluttered with the above files. */
693 &sensor_dev_attr_name.dev_attr.attr,
694 &sensor_dev_attr_pwm1_enable.dev_attr.attr,
695 &sensor_dev_attr_pwm1.dev_attr.attr,
696 &sensor_dev_attr_fan1_input.dev_attr.attr,
697 &sensor_dev_attr_temp1_input.dev_attr.attr,
698 &sensor_dev_attr_temp2_input.dev_attr.attr,
699 &sensor_dev_attr_temp3_input.dev_attr.attr,
700 &sensor_dev_attr_temp4_input.dev_attr.attr,
701 &sensor_dev_attr_temp5_input.dev_attr.attr,
702 &sensor_dev_attr_temp6_input.dev_attr.attr,
703 &sensor_dev_attr_temp1_label.dev_attr.attr,
704 &sensor_dev_attr_temp2_label.dev_attr.attr,
705 &sensor_dev_attr_temp3_label.dev_attr.attr,
706 &sensor_dev_attr_temp4_label.dev_attr.attr,
707 &sensor_dev_attr_temp5_label.dev_attr.attr,
708 &sensor_dev_attr_temp6_label.dev_attr.attr,
709 NULL
710};
711
712static struct attribute_group compal_attribute_group = {
713 .attrs = compal_attributes
714};
715
716static int __devinit compal_probe(struct platform_device *);
717static int __devexit compal_remove(struct platform_device *);
718static struct platform_driver compal_driver = {
719 .driver = {
720 .name = DRIVER_NAME,
721 .owner = THIS_MODULE,
722 },
723 .probe = compal_probe,
724 .remove = __devexit_p(compal_remove)
725};
726
727static enum power_supply_property compal_bat_properties[] = {
728 POWER_SUPPLY_PROP_STATUS,
729 POWER_SUPPLY_PROP_HEALTH,
730 POWER_SUPPLY_PROP_PRESENT,
731 POWER_SUPPLY_PROP_TECHNOLOGY,
732 POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN,
733 POWER_SUPPLY_PROP_VOLTAGE_NOW,
734 POWER_SUPPLY_PROP_CURRENT_NOW,
735 POWER_SUPPLY_PROP_CURRENT_AVG,
736 POWER_SUPPLY_PROP_POWER_NOW,
737 POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
738 POWER_SUPPLY_PROP_CHARGE_NOW,
739 POWER_SUPPLY_PROP_CAPACITY,
740 POWER_SUPPLY_PROP_CAPACITY_LEVEL,
741 POWER_SUPPLY_PROP_TEMP,
742 POWER_SUPPLY_PROP_TEMP_AMBIENT,
743 POWER_SUPPLY_PROP_MODEL_NAME,
744 POWER_SUPPLY_PROP_MANUFACTURER,
745 POWER_SUPPLY_PROP_SERIAL_NUMBER,
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700746};
747
748static struct backlight_device *compalbl_device;
749
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700750static struct platform_device *compal_device;
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700751
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700752static struct rfkill *wifi_rfkill;
753static struct rfkill *bt_rfkill;
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700754
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700755
756
757
758
759/* =================================== */
760/* Initialization & clean-up functions */
761/* =================================== */
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700762
763static int dmi_check_cb(const struct dmi_system_id *id)
764{
Joe Perchesb4a4bc02011-03-29 15:21:36 -0700765 pr_info("Identified laptop model '%s'\n", id->ident);
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700766 extra_features = false;
Axel Lin0e4510f2011-03-14 18:53:14 +0800767 return 1;
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700768}
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700769
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700770static int dmi_check_cb_extra(const struct dmi_system_id *id)
771{
Joe Perchesb4a4bc02011-03-29 15:21:36 -0700772 pr_info("Identified laptop model '%s', enabling extra features\n",
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700773 id->ident);
774 extra_features = true;
Axel Lin0e4510f2011-03-14 18:53:14 +0800775 return 1;
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700776}
777
778static struct dmi_system_id __initdata compal_dmi_table[] = {
779 {
780 .ident = "FL90/IFL90",
781 .matches = {
782 DMI_MATCH(DMI_BOARD_NAME, "IFL90"),
783 DMI_MATCH(DMI_BOARD_VERSION, "IFT00"),
784 },
785 .callback = dmi_check_cb
786 },
787 {
788 .ident = "FL90/IFL90",
789 .matches = {
790 DMI_MATCH(DMI_BOARD_NAME, "IFL90"),
791 DMI_MATCH(DMI_BOARD_VERSION, "REFERENCE"),
792 },
793 .callback = dmi_check_cb
794 },
795 {
796 .ident = "FL91/IFL91",
797 .matches = {
798 DMI_MATCH(DMI_BOARD_NAME, "IFL91"),
799 DMI_MATCH(DMI_BOARD_VERSION, "IFT00"),
800 },
801 .callback = dmi_check_cb
802 },
803 {
804 .ident = "FL92/JFL92",
805 .matches = {
806 DMI_MATCH(DMI_BOARD_NAME, "JFL92"),
807 DMI_MATCH(DMI_BOARD_VERSION, "IFT00"),
808 },
809 .callback = dmi_check_cb
810 },
811 {
812 .ident = "FT00/IFT00",
813 .matches = {
814 DMI_MATCH(DMI_BOARD_NAME, "IFT00"),
815 DMI_MATCH(DMI_BOARD_VERSION, "IFT00"),
816 },
817 .callback = dmi_check_cb
818 },
Mario Limonciello34325b92009-08-24 16:00:47 -0500819 {
820 .ident = "Dell Mini 9",
821 .matches = {
822 DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
823 DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron 910"),
824 },
825 .callback = dmi_check_cb
826 },
827 {
828 .ident = "Dell Mini 10",
829 .matches = {
830 DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
831 DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron 1010"),
832 },
833 .callback = dmi_check_cb
834 },
835 {
836 .ident = "Dell Mini 10v",
837 .matches = {
838 DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
839 DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron 1011"),
840 },
841 .callback = dmi_check_cb
842 },
843 {
Victor van den Elzenc3f755e2010-08-15 01:19:33 +0200844 .ident = "Dell Mini 1012",
845 .matches = {
846 DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
847 DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron 1012"),
848 },
849 .callback = dmi_check_cb
850 },
851 {
Mario Limonciello34325b92009-08-24 16:00:47 -0500852 .ident = "Dell Inspiron 11z",
853 .matches = {
854 DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
855 DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron 1110"),
856 },
857 .callback = dmi_check_cb
858 },
859 {
860 .ident = "Dell Mini 12",
861 .matches = {
862 DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
863 DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron 1210"),
864 },
865 .callback = dmi_check_cb
866 },
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700867 {
868 .ident = "JHL90",
869 .matches = {
870 DMI_MATCH(DMI_BOARD_NAME, "JHL90"),
871 DMI_MATCH(DMI_BOARD_VERSION, "REFERENCE"),
872 },
873 .callback = dmi_check_cb_extra
874 },
Albert Astals Cid4a198be2011-01-07 17:29:44 -0500875 {
876 .ident = "KHLB2",
877 .matches = {
878 DMI_MATCH(DMI_BOARD_NAME, "KHLB2"),
879 DMI_MATCH(DMI_BOARD_VERSION, "REFERENCE"),
880 },
881 .callback = dmi_check_cb_extra
882 },
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700883 { }
884};
Dmitry Torokhov4585aba2011-11-14 00:25:54 -0800885MODULE_DEVICE_TABLE(dmi, compal_dmi_table);
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700886
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700887static void initialize_power_supply_data(struct compal_data *data)
888{
889 data->psy.name = DRIVER_NAME;
890 data->psy.type = POWER_SUPPLY_TYPE_BATTERY;
891 data->psy.properties = compal_bat_properties;
892 data->psy.num_properties = ARRAY_SIZE(compal_bat_properties);
893 data->psy.get_property = bat_get_property;
894
895 ec_read_sequence(BAT_MANUFACTURER_NAME_ADDR,
896 data->bat_manufacturer_name,
897 BAT_MANUFACTURER_NAME_LEN);
898 data->bat_manufacturer_name[BAT_MANUFACTURER_NAME_LEN] = 0;
899
900 ec_read_sequence(BAT_MODEL_NAME_ADDR,
901 data->bat_model_name,
902 BAT_MODEL_NAME_LEN);
903 data->bat_model_name[BAT_MODEL_NAME_LEN] = 0;
904
905 scnprintf(data->bat_serial_number, BAT_SERIAL_NUMBER_LEN + 1, "%d",
906 ec_read_u16(BAT_SERIAL_NUMBER_ADDR));
907}
908
909static void initialize_fan_control_data(struct compal_data *data)
910{
911 data->pwm_enable = 2; /* Keep motherboard in control for now */
912 data->curr_pwm = 255; /* Try not to cause a CPU_on_fire exception
913 if we take over... */
914}
915
916static int setup_rfkill(void)
917{
918 int ret;
919
920 wifi_rfkill = rfkill_alloc("compal-wifi", &compal_device->dev,
921 RFKILL_TYPE_WLAN, &compal_rfkill_ops,
922 (void *) WIRELESS_WLAN);
923 if (!wifi_rfkill)
924 return -ENOMEM;
925
926 ret = rfkill_register(wifi_rfkill);
927 if (ret)
928 goto err_wifi;
929
930 bt_rfkill = rfkill_alloc("compal-bluetooth", &compal_device->dev,
931 RFKILL_TYPE_BLUETOOTH, &compal_rfkill_ops,
932 (void *) WIRELESS_BT);
933 if (!bt_rfkill) {
934 ret = -ENOMEM;
935 goto err_allocate_bt;
936 }
937 ret = rfkill_register(bt_rfkill);
938 if (ret)
939 goto err_register_bt;
940
941 return 0;
942
943err_register_bt:
944 rfkill_destroy(bt_rfkill);
945
946err_allocate_bt:
947 rfkill_unregister(wifi_rfkill);
948
949err_wifi:
950 rfkill_destroy(wifi_rfkill);
951
952 return ret;
953}
954
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700955static int __init compal_init(void)
956{
957 int ret;
958
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700959 if (acpi_disabled) {
Joe Perchesb4a4bc02011-03-29 15:21:36 -0700960 pr_err("ACPI needs to be enabled for this driver to work!\n");
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700961 return -ENODEV;
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700962 }
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700963
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700964 if (!force && !dmi_check_system(compal_dmi_table)) {
Joe Perchesb4a4bc02011-03-29 15:21:36 -0700965 pr_err("Motherboard not recognized (You could try the module's force-parameter)\n");
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700966 return -ENODEV;
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700967 }
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700968
Thomas Renninger29454f12008-08-01 17:37:58 +0200969 if (!acpi_video_backlight_support()) {
Matthew Garretta19a6ee2010-02-17 16:39:44 -0500970 struct backlight_properties props;
971 memset(&props, 0, sizeof(struct backlight_properties));
Matthew Garrettbb7ca742011-03-22 16:30:21 -0700972 props.type = BACKLIGHT_PLATFORM;
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700973 props.max_brightness = BACKLIGHT_LEVEL_MAX;
974 compalbl_device = backlight_device_register(DRIVER_NAME,
Matthew Garretta19a6ee2010-02-17 16:39:44 -0500975 NULL, NULL,
976 &compalbl_ops,
977 &props);
Thomas Renninger29454f12008-08-01 17:37:58 +0200978 if (IS_ERR(compalbl_device))
979 return PTR_ERR(compalbl_device);
Thomas Renninger29454f12008-08-01 17:37:58 +0200980 }
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700981
982 ret = platform_driver_register(&compal_driver);
983 if (ret)
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700984 goto err_backlight;
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700985
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700986 compal_device = platform_device_alloc(DRIVER_NAME, -1);
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700987 if (!compal_device) {
988 ret = -ENOMEM;
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700989 goto err_platform_driver;
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700990 }
991
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700992 ret = platform_device_add(compal_device); /* This calls compal_probe */
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700993 if (ret)
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700994 goto err_platform_device;
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700995
Mario Limonciello493e9142009-08-25 10:30:13 -0500996 ret = setup_rfkill();
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700997 if (ret)
Roald Frederickx9be0fcb2010-07-20 15:19:39 -0700998 goto err_rfkill;
Cezary Jackiewicz54115522008-06-09 16:22:22 -0700999
Joe Perchesb4a4bc02011-03-29 15:21:36 -07001000 pr_info("Driver " DRIVER_VERSION " successfully loaded\n");
Cezary Jackiewicz54115522008-06-09 16:22:22 -07001001 return 0;
1002
Roald Frederickx9be0fcb2010-07-20 15:19:39 -07001003err_rfkill:
Cezary Jackiewicz54115522008-06-09 16:22:22 -07001004 platform_device_del(compal_device);
1005
Roald Frederickx9be0fcb2010-07-20 15:19:39 -07001006err_platform_device:
Cezary Jackiewicz54115522008-06-09 16:22:22 -07001007 platform_device_put(compal_device);
1008
Roald Frederickx9be0fcb2010-07-20 15:19:39 -07001009err_platform_driver:
Cezary Jackiewicz54115522008-06-09 16:22:22 -07001010 platform_driver_unregister(&compal_driver);
1011
Roald Frederickx9be0fcb2010-07-20 15:19:39 -07001012err_backlight:
Cezary Jackiewicz54115522008-06-09 16:22:22 -07001013 backlight_device_unregister(compalbl_device);
1014
1015 return ret;
1016}
1017
Roald Frederickx9be0fcb2010-07-20 15:19:39 -07001018static int __devinit compal_probe(struct platform_device *pdev)
1019{
1020 int err;
1021 struct compal_data *data;
1022
1023 if (!extra_features)
1024 return 0;
1025
1026 /* Fan control */
1027 data = kzalloc(sizeof(struct compal_data), GFP_KERNEL);
1028 if (!data)
1029 return -ENOMEM;
1030
1031 initialize_fan_control_data(data);
1032
1033 err = sysfs_create_group(&pdev->dev.kobj, &compal_attribute_group);
Andre Bartke96b269c2011-06-03 20:55:43 +02001034 if (err) {
1035 kfree(data);
Roald Frederickx9be0fcb2010-07-20 15:19:39 -07001036 return err;
Andre Bartke96b269c2011-06-03 20:55:43 +02001037 }
Roald Frederickx9be0fcb2010-07-20 15:19:39 -07001038
1039 data->hwmon_dev = hwmon_device_register(&pdev->dev);
1040 if (IS_ERR(data->hwmon_dev)) {
1041 err = PTR_ERR(data->hwmon_dev);
1042 sysfs_remove_group(&pdev->dev.kobj,
1043 &compal_attribute_group);
1044 kfree(data);
1045 return err;
1046 }
1047
1048 /* Power supply */
1049 initialize_power_supply_data(data);
1050 power_supply_register(&compal_device->dev, &data->psy);
1051
1052 platform_set_drvdata(pdev, data);
1053
1054 return 0;
1055}
1056
Cezary Jackiewicz54115522008-06-09 16:22:22 -07001057static void __exit compal_cleanup(void)
1058{
Cezary Jackiewicz54115522008-06-09 16:22:22 -07001059 platform_device_unregister(compal_device);
1060 platform_driver_unregister(&compal_driver);
1061 backlight_device_unregister(compalbl_device);
Mario Limonciello493e9142009-08-25 10:30:13 -05001062 rfkill_unregister(wifi_rfkill);
Mario Limonciello493e9142009-08-25 10:30:13 -05001063 rfkill_unregister(bt_rfkill);
Roald Frederickx9be0fcb2010-07-20 15:19:39 -07001064 rfkill_destroy(wifi_rfkill);
Mario Limonciello493e9142009-08-25 10:30:13 -05001065 rfkill_destroy(bt_rfkill);
Cezary Jackiewicz54115522008-06-09 16:22:22 -07001066
Joe Perchesb4a4bc02011-03-29 15:21:36 -07001067 pr_info("Driver unloaded\n");
Cezary Jackiewicz54115522008-06-09 16:22:22 -07001068}
1069
Roald Frederickx9be0fcb2010-07-20 15:19:39 -07001070static int __devexit compal_remove(struct platform_device *pdev)
1071{
1072 struct compal_data *data;
1073
1074 if (!extra_features)
1075 return 0;
1076
Joe Perchesb4a4bc02011-03-29 15:21:36 -07001077 pr_info("Unloading: resetting fan control to motherboard\n");
Roald Frederickx9be0fcb2010-07-20 15:19:39 -07001078 pwm_disable_control();
1079
1080 data = platform_get_drvdata(pdev);
1081 hwmon_device_unregister(data->hwmon_dev);
1082 power_supply_unregister(&data->psy);
1083
1084 platform_set_drvdata(pdev, NULL);
1085 kfree(data);
1086
1087 sysfs_remove_group(&pdev->dev.kobj, &compal_attribute_group);
1088
1089 return 0;
1090}
1091
1092
Cezary Jackiewicz54115522008-06-09 16:22:22 -07001093module_init(compal_init);
1094module_exit(compal_cleanup);
1095
1096MODULE_AUTHOR("Cezary Jackiewicz");
Roald Frederickx9be0fcb2010-07-20 15:19:39 -07001097MODULE_AUTHOR("Roald Frederickx (roald.frederickx@gmail.com)");
Cezary Jackiewicz54115522008-06-09 16:22:22 -07001098MODULE_DESCRIPTION("Compal Laptop Support");
Roald Frederickx9be0fcb2010-07-20 15:19:39 -07001099MODULE_VERSION(DRIVER_VERSION);
Cezary Jackiewicz54115522008-06-09 16:22:22 -07001100MODULE_LICENSE("GPL");