1140 lines
30 KiB
C
1140 lines
30 KiB
C
|
/*-*-linux-c-*-*/
|
||
|
|
||
|
/*
|
||
|
Copyright (C) 2008 Cezary Jackiewicz <cezary.jackiewicz (at) gmail.com>
|
||
|
|
||
|
based on MSI driver
|
||
|
|
||
|
Copyright (C) 2006 Lennart Poettering <mzxreary (at) 0pointer (dot) de>
|
||
|
|
||
|
This program is free software; you can redistribute it and/or modify
|
||
|
it under the terms of the GNU General Public License as published by
|
||
|
the Free Software Foundation; either version 2 of the License, or
|
||
|
(at your option) any later version.
|
||
|
|
||
|
This program is distributed in the hope that it will be useful, but
|
||
|
WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
||
|
General Public License for more details.
|
||
|
|
||
|
You should have received a copy of the GNU General Public License
|
||
|
along with this program; if not, write to the Free Software
|
||
|
Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
|
||
|
02110-1301, USA.
|
||
|
*/
|
||
|
|
||
|
/*
|
||
|
* compal-laptop.c - Compal laptop support.
|
||
|
*
|
||
|
* This driver exports a few files in /sys/devices/platform/compal-laptop/:
|
||
|
* wake_up_XXX Whether or not we listen to such wake up events (rw)
|
||
|
*
|
||
|
* In addition to these platform device attributes the driver
|
||
|
* registers itself in the Linux backlight control, power_supply, rfkill
|
||
|
* and hwmon subsystem and is available to userspace under:
|
||
|
*
|
||
|
* /sys/class/backlight/compal-laptop/
|
||
|
* /sys/class/power_supply/compal-laptop/
|
||
|
* /sys/class/rfkill/rfkillX/
|
||
|
* /sys/class/hwmon/hwmonX/
|
||
|
*
|
||
|
* Notes on the power_supply battery interface:
|
||
|
* - the "minimum" design voltage is *the* design voltage
|
||
|
* - the ambient temperature is the average battery temperature
|
||
|
* and the value is an educated guess (see commented code below)
|
||
|
*
|
||
|
*
|
||
|
* This driver might work on other laptops produced by Compal. If you
|
||
|
* want to try it you can pass force=1 as argument to the module which
|
||
|
* will force it to load even when the DMI data doesn't identify the
|
||
|
* laptop as compatible.
|
||
|
*
|
||
|
* Lots of data available at:
|
||
|
* http://service1.marasst.com/Compal/JHL90_91/Service%20Manual/
|
||
|
* JHL90%20service%20manual-Final-0725.pdf
|
||
|
*
|
||
|
*
|
||
|
*
|
||
|
* Support for the Compal JHL90 added by Roald Frederickx
|
||
|
* (roald.frederickx@gmail.com):
|
||
|
* Driver got large revision. Added functionalities: backlight
|
||
|
* power, wake_on_XXX, a hwmon and power_supply interface.
|
||
|
*
|
||
|
* In case this gets merged into the kernel source: I want to dedicate this
|
||
|
* to Kasper Meerts, the awesome guy who showed me Linux and C!
|
||
|
*/
|
||
|
|
||
|
/* NOTE: currently the wake_on_XXX, hwmon and power_supply interfaces are
|
||
|
* only enabled on a JHL90 board until it is verified that they work on the
|
||
|
* other boards too. See the extra_features variable. */
|
||
|
|
||
|
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
|
||
|
|
||
|
#include <linux/module.h>
|
||
|
#include <linux/kernel.h>
|
||
|
#include <linux/init.h>
|
||
|
#include <linux/acpi.h>
|
||
|
#include <linux/dmi.h>
|
||
|
#include <linux/backlight.h>
|
||
|
#include <linux/platform_device.h>
|
||
|
#include <linux/rfkill.h>
|
||
|
#include <linux/hwmon.h>
|
||
|
#include <linux/hwmon-sysfs.h>
|
||
|
#include <linux/power_supply.h>
|
||
|
#include <linux/fb.h>
|
||
|
#include <acpi/video.h>
|
||
|
|
||
|
/* ======= */
|
||
|
/* Defines */
|
||
|
/* ======= */
|
||
|
#define DRIVER_NAME "compal-laptop"
|
||
|
#define DRIVER_VERSION "0.2.7"
|
||
|
|
||
|
#define BACKLIGHT_LEVEL_ADDR 0xB9
|
||
|
#define BACKLIGHT_LEVEL_MAX 7
|
||
|
#define BACKLIGHT_STATE_ADDR 0x59
|
||
|
#define BACKLIGHT_STATE_ON_DATA 0xE1
|
||
|
#define BACKLIGHT_STATE_OFF_DATA 0xE2
|
||
|
|
||
|
#define WAKE_UP_ADDR 0xA4
|
||
|
#define WAKE_UP_PME (1 << 0)
|
||
|
#define WAKE_UP_MODEM (1 << 1)
|
||
|
#define WAKE_UP_LAN (1 << 2)
|
||
|
#define WAKE_UP_WLAN (1 << 4)
|
||
|
#define WAKE_UP_KEY (1 << 6)
|
||
|
#define WAKE_UP_MOUSE (1 << 7)
|
||
|
|
||
|
#define WIRELESS_ADDR 0xBB
|
||
|
#define WIRELESS_WLAN (1 << 0)
|
||
|
#define WIRELESS_BT (1 << 1)
|
||
|
#define WIRELESS_WLAN_EXISTS (1 << 2)
|
||
|
#define WIRELESS_BT_EXISTS (1 << 3)
|
||
|
#define WIRELESS_KILLSWITCH (1 << 4)
|
||
|
|
||
|
#define PWM_ADDRESS 0x46
|
||
|
#define PWM_DISABLE_ADDR 0x59
|
||
|
#define PWM_DISABLE_DATA 0xA5
|
||
|
#define PWM_ENABLE_ADDR 0x59
|
||
|
#define PWM_ENABLE_DATA 0xA8
|
||
|
|
||
|
#define FAN_ADDRESS 0x46
|
||
|
#define FAN_DATA 0x81
|
||
|
#define FAN_FULL_ON_CMD 0x59 /* Doesn't seem to work. Just */
|
||
|
#define FAN_FULL_ON_ENABLE 0x76 /* force the pwm signal to its */
|
||
|
#define FAN_FULL_ON_DISABLE 0x77 /* maximum value instead */
|
||
|
|
||
|
#define TEMP_CPU 0xB0
|
||
|
#define TEMP_CPU_LOCAL 0xB1
|
||
|
#define TEMP_CPU_DTS 0xB5
|
||
|
#define TEMP_NORTHBRIDGE 0xB6
|
||
|
#define TEMP_VGA 0xB4
|
||
|
#define TEMP_SKIN 0xB2
|
||
|
|
||
|
#define BAT_MANUFACTURER_NAME_ADDR 0x10
|
||
|
#define BAT_MANUFACTURER_NAME_LEN 9
|
||
|
#define BAT_MODEL_NAME_ADDR 0x19
|
||
|
#define BAT_MODEL_NAME_LEN 6
|
||
|
#define BAT_SERIAL_NUMBER_ADDR 0xC4
|
||
|
#define BAT_SERIAL_NUMBER_LEN 5
|
||
|
#define BAT_CHARGE_NOW 0xC2
|
||
|
#define BAT_CHARGE_DESIGN 0xCA
|
||
|
#define BAT_VOLTAGE_NOW 0xC6
|
||
|
#define BAT_VOLTAGE_DESIGN 0xC8
|
||
|
#define BAT_CURRENT_NOW 0xD0
|
||
|
#define BAT_CURRENT_AVG 0xD2
|
||
|
#define BAT_POWER 0xD4
|
||
|
#define BAT_CAPACITY 0xCE
|
||
|
#define BAT_TEMP 0xD6
|
||
|
#define BAT_TEMP_AVG 0xD7
|
||
|
#define BAT_STATUS0 0xC1
|
||
|
#define BAT_STATUS1 0xF0
|
||
|
#define BAT_STATUS2 0xF1
|
||
|
#define BAT_STOP_CHARGE1 0xF2
|
||
|
#define BAT_STOP_CHARGE2 0xF3
|
||
|
#define BAT_CHARGE_LIMIT 0x03
|
||
|
#define BAT_CHARGE_LIMIT_MAX 100
|
||
|
|
||
|
#define BAT_S0_DISCHARGE (1 << 0)
|
||
|
#define BAT_S0_DISCHRG_CRITICAL (1 << 2)
|
||
|
#define BAT_S0_LOW (1 << 3)
|
||
|
#define BAT_S0_CHARGING (1 << 1)
|
||
|
#define BAT_S0_AC (1 << 7)
|
||
|
#define BAT_S1_EXISTS (1 << 0)
|
||
|
#define BAT_S1_FULL (1 << 1)
|
||
|
#define BAT_S1_EMPTY (1 << 2)
|
||
|
#define BAT_S1_LiION_OR_NiMH (1 << 7)
|
||
|
#define BAT_S2_LOW_LOW (1 << 0)
|
||
|
#define BAT_STOP_CHRG1_BAD_CELL (1 << 1)
|
||
|
#define BAT_STOP_CHRG1_COMM_FAIL (1 << 2)
|
||
|
#define BAT_STOP_CHRG1_OVERVOLTAGE (1 << 6)
|
||
|
#define BAT_STOP_CHRG1_OVERTEMPERATURE (1 << 7)
|
||
|
|
||
|
|
||
|
/* ======= */
|
||
|
/* Structs */
|
||
|
/* ======= */
|
||
|
struct compal_data{
|
||
|
/* Fan control */
|
||
|
int pwm_enable; /* 0:full on, 1:set by pwm1, 2:control by motherboard */
|
||
|
unsigned char curr_pwm;
|
||
|
|
||
|
/* Power supply */
|
||
|
struct power_supply *psy;
|
||
|
struct power_supply_info psy_info;
|
||
|
char bat_model_name[BAT_MODEL_NAME_LEN + 1];
|
||
|
char bat_manufacturer_name[BAT_MANUFACTURER_NAME_LEN + 1];
|
||
|
char bat_serial_number[BAT_SERIAL_NUMBER_LEN + 1];
|
||
|
};
|
||
|
|
||
|
|
||
|
/* =============== */
|
||
|
/* General globals */
|
||
|
/* =============== */
|
||
|
static bool force;
|
||
|
module_param(force, bool, 0);
|
||
|
MODULE_PARM_DESC(force, "Force driver load, ignore DMI data");
|
||
|
|
||
|
/* Support for the wake_on_XXX, hwmon and power_supply interface. Currently
|
||
|
* only gets enabled on a JHL90 board. Might work with the others too */
|
||
|
static bool extra_features;
|
||
|
|
||
|
/* Nasty stuff. For some reason the fan control is very un-linear. I've
|
||
|
* come up with these values by looping through the possible inputs and
|
||
|
* watching the output of address 0x4F (do an ec_transaction writing 0x33
|
||
|
* into 0x4F and read a few bytes from the output, like so:
|
||
|
* u8 writeData = 0x33;
|
||
|
* ec_transaction(0x4F, &writeData, 1, buffer, 32);
|
||
|
* That address is labeled "fan1 table information" in the service manual.
|
||
|
* It should be clear which value in 'buffer' changes). This seems to be
|
||
|
* related to fan speed. It isn't a proper 'realtime' fan speed value
|
||
|
* though, because physically stopping or speeding up the fan doesn't
|
||
|
* change it. It might be the average voltage or current of the pwm output.
|
||
|
* Nevertheless, it is more fine-grained than the actual RPM reading */
|
||
|
static const unsigned char pwm_lookup_table[256] = {
|
||
|
0, 0, 0, 1, 1, 1, 2, 253, 254, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6,
|
||
|
7, 7, 7, 8, 86, 86, 9, 9, 9, 10, 10, 10, 11, 92, 92, 12, 12, 95,
|
||
|
13, 66, 66, 14, 14, 98, 15, 15, 15, 16, 16, 67, 17, 17, 72, 18, 70,
|
||
|
75, 19, 90, 90, 73, 73, 73, 21, 21, 91, 91, 91, 96, 23, 94, 94, 94,
|
||
|
94, 94, 94, 94, 94, 94, 94, 141, 141, 238, 223, 192, 139, 139, 139,
|
||
|
139, 139, 142, 142, 142, 142, 142, 78, 78, 78, 78, 78, 76, 76, 76,
|
||
|
76, 76, 79, 79, 79, 79, 79, 79, 79, 20, 20, 20, 20, 20, 22, 22, 22,
|
||
|
22, 22, 24, 24, 24, 24, 24, 24, 219, 219, 219, 219, 219, 219, 219,
|
||
|
219, 27, 27, 188, 188, 28, 28, 28, 29, 186, 186, 186, 186, 186,
|
||
|
186, 186, 186, 186, 186, 31, 31, 31, 31, 31, 32, 32, 32, 41, 33,
|
||
|
33, 33, 33, 33, 252, 252, 34, 34, 34, 43, 35, 35, 35, 36, 36, 38,
|
||
|
206, 206, 206, 206, 206, 206, 206, 206, 206, 37, 37, 37, 46, 46,
|
||
|
47, 47, 232, 232, 232, 232, 232, 232, 232, 232, 232, 232, 48, 48,
|
||
|
48, 48, 48, 40, 40, 40, 49, 42, 42, 42, 42, 42, 42, 42, 42, 44,
|
||
|
189, 189, 189, 189, 54, 54, 45, 45, 45, 45, 45, 45, 45, 45, 251,
|
||
|
191, 199, 199, 199, 199, 199, 215, 215, 215, 215, 187, 187, 187,
|
||
|
187, 187, 193, 50
|
||
|
};
|
||
|
|
||
|
|
||
|
|
||
|
|
||
|
/* ========================= */
|
||
|
/* Hardware access functions */
|
||
|
/* ========================= */
|
||
|
/* General access */
|
||
|
static u8 ec_read_u8(u8 addr)
|
||
|
{
|
||
|
u8 value;
|
||
|
ec_read(addr, &value);
|
||
|
return value;
|
||
|
}
|
||
|
|
||
|
static s8 ec_read_s8(u8 addr)
|
||
|
{
|
||
|
return (s8)ec_read_u8(addr);
|
||
|
}
|
||
|
|
||
|
static u16 ec_read_u16(u8 addr)
|
||
|
{
|
||
|
int hi, lo;
|
||
|
lo = ec_read_u8(addr);
|
||
|
hi = ec_read_u8(addr + 1);
|
||
|
return (hi << 8) + lo;
|
||
|
}
|
||
|
|
||
|
static s16 ec_read_s16(u8 addr)
|
||
|
{
|
||
|
return (s16) ec_read_u16(addr);
|
||
|
}
|
||
|
|
||
|
static void ec_read_sequence(u8 addr, u8 *buf, int len)
|
||
|
{
|
||
|
int i;
|
||
|
for (i = 0; i < len; i++)
|
||
|
ec_read(addr + i, buf + i);
|
||
|
}
|
||
|
|
||
|
|
||
|
/* Backlight access */
|
||
|
static int set_backlight_level(int level)
|
||
|
{
|
||
|
if (level < 0 || level > BACKLIGHT_LEVEL_MAX)
|
||
|
return -EINVAL;
|
||
|
|
||
|
ec_write(BACKLIGHT_LEVEL_ADDR, level);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int get_backlight_level(void)
|
||
|
{
|
||
|
return (int) ec_read_u8(BACKLIGHT_LEVEL_ADDR);
|
||
|
}
|
||
|
|
||
|
static void set_backlight_state(bool on)
|
||
|
{
|
||
|
u8 data = on ? BACKLIGHT_STATE_ON_DATA : BACKLIGHT_STATE_OFF_DATA;
|
||
|
ec_transaction(BACKLIGHT_STATE_ADDR, &data, 1, NULL, 0);
|
||
|
}
|
||
|
|
||
|
|
||
|
/* Fan control access */
|
||
|
static void pwm_enable_control(void)
|
||
|
{
|
||
|
unsigned char writeData = PWM_ENABLE_DATA;
|
||
|
ec_transaction(PWM_ENABLE_ADDR, &writeData, 1, NULL, 0);
|
||
|
}
|
||
|
|
||
|
static void pwm_disable_control(void)
|
||
|
{
|
||
|
unsigned char writeData = PWM_DISABLE_DATA;
|
||
|
ec_transaction(PWM_DISABLE_ADDR, &writeData, 1, NULL, 0);
|
||
|
}
|
||
|
|
||
|
static void set_pwm(int pwm)
|
||
|
{
|
||
|
ec_transaction(PWM_ADDRESS, &pwm_lookup_table[pwm], 1, NULL, 0);
|
||
|
}
|
||
|
|
||
|
static int get_fan_rpm(void)
|
||
|
{
|
||
|
u8 value, data = FAN_DATA;
|
||
|
ec_transaction(FAN_ADDRESS, &data, 1, &value, 1);
|
||
|
return 100 * (int)value;
|
||
|
}
|
||
|
|
||
|
|
||
|
|
||
|
|
||
|
/* =================== */
|
||
|
/* Interface functions */
|
||
|
/* =================== */
|
||
|
|
||
|
/* Backlight interface */
|
||
|
static int bl_get_brightness(struct backlight_device *b)
|
||
|
{
|
||
|
return get_backlight_level();
|
||
|
}
|
||
|
|
||
|
static int bl_update_status(struct backlight_device *b)
|
||
|
{
|
||
|
int ret = set_backlight_level(b->props.brightness);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
|
||
|
set_backlight_state((b->props.power == FB_BLANK_UNBLANK)
|
||
|
&& !(b->props.state & BL_CORE_SUSPENDED)
|
||
|
&& !(b->props.state & BL_CORE_FBBLANK));
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static const struct backlight_ops compalbl_ops = {
|
||
|
.get_brightness = bl_get_brightness,
|
||
|
.update_status = bl_update_status,
|
||
|
};
|
||
|
|
||
|
|
||
|
/* Wireless interface */
|
||
|
static int compal_rfkill_set(void *data, bool blocked)
|
||
|
{
|
||
|
unsigned long radio = (unsigned long) data;
|
||
|
u8 result = ec_read_u8(WIRELESS_ADDR);
|
||
|
u8 value;
|
||
|
|
||
|
if (!blocked)
|
||
|
value = (u8) (result | radio);
|
||
|
else
|
||
|
value = (u8) (result & ~radio);
|
||
|
ec_write(WIRELESS_ADDR, value);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static void compal_rfkill_poll(struct rfkill *rfkill, void *data)
|
||
|
{
|
||
|
u8 result = ec_read_u8(WIRELESS_ADDR);
|
||
|
bool hw_blocked = !(result & WIRELESS_KILLSWITCH);
|
||
|
rfkill_set_hw_state(rfkill, hw_blocked);
|
||
|
}
|
||
|
|
||
|
static const struct rfkill_ops compal_rfkill_ops = {
|
||
|
.poll = compal_rfkill_poll,
|
||
|
.set_block = compal_rfkill_set,
|
||
|
};
|
||
|
|
||
|
|
||
|
/* Wake_up interface */
|
||
|
#define SIMPLE_MASKED_STORE_SHOW(NAME, ADDR, MASK) \
|
||
|
static ssize_t NAME##_show(struct device *dev, \
|
||
|
struct device_attribute *attr, char *buf) \
|
||
|
{ \
|
||
|
return sprintf(buf, "%d\n", ((ec_read_u8(ADDR) & MASK) != 0)); \
|
||
|
} \
|
||
|
static ssize_t NAME##_store(struct device *dev, \
|
||
|
struct device_attribute *attr, const char *buf, size_t count) \
|
||
|
{ \
|
||
|
int state; \
|
||
|
u8 old_val = ec_read_u8(ADDR); \
|
||
|
if (sscanf(buf, "%d", &state) != 1 || (state < 0 || state > 1)) \
|
||
|
return -EINVAL; \
|
||
|
ec_write(ADDR, state ? (old_val | MASK) : (old_val & ~MASK)); \
|
||
|
return count; \
|
||
|
}
|
||
|
|
||
|
SIMPLE_MASKED_STORE_SHOW(wake_up_pme, WAKE_UP_ADDR, WAKE_UP_PME)
|
||
|
SIMPLE_MASKED_STORE_SHOW(wake_up_modem, WAKE_UP_ADDR, WAKE_UP_MODEM)
|
||
|
SIMPLE_MASKED_STORE_SHOW(wake_up_lan, WAKE_UP_ADDR, WAKE_UP_LAN)
|
||
|
SIMPLE_MASKED_STORE_SHOW(wake_up_wlan, WAKE_UP_ADDR, WAKE_UP_WLAN)
|
||
|
SIMPLE_MASKED_STORE_SHOW(wake_up_key, WAKE_UP_ADDR, WAKE_UP_KEY)
|
||
|
SIMPLE_MASKED_STORE_SHOW(wake_up_mouse, WAKE_UP_ADDR, WAKE_UP_MOUSE)
|
||
|
|
||
|
/* Fan control interface */
|
||
|
static ssize_t pwm_enable_show(struct device *dev,
|
||
|
struct device_attribute *attr, char *buf)
|
||
|
{
|
||
|
struct compal_data *data = dev_get_drvdata(dev);
|
||
|
return sprintf(buf, "%d\n", data->pwm_enable);
|
||
|
}
|
||
|
|
||
|
static ssize_t pwm_enable_store(struct device *dev,
|
||
|
struct device_attribute *attr, const char *buf, size_t count)
|
||
|
{
|
||
|
struct compal_data *data = dev_get_drvdata(dev);
|
||
|
long val;
|
||
|
int err;
|
||
|
|
||
|
err = kstrtol(buf, 10, &val);
|
||
|
if (err)
|
||
|
return err;
|
||
|
if (val < 0)
|
||
|
return -EINVAL;
|
||
|
|
||
|
data->pwm_enable = val;
|
||
|
|
||
|
switch (val) {
|
||
|
case 0: /* Full speed */
|
||
|
pwm_enable_control();
|
||
|
set_pwm(255);
|
||
|
break;
|
||
|
case 1: /* As set by pwm1 */
|
||
|
pwm_enable_control();
|
||
|
set_pwm(data->curr_pwm);
|
||
|
break;
|
||
|
default: /* Control by motherboard */
|
||
|
pwm_disable_control();
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
return count;
|
||
|
}
|
||
|
|
||
|
static ssize_t pwm_show(struct device *dev, struct device_attribute *attr,
|
||
|
char *buf)
|
||
|
{
|
||
|
struct compal_data *data = dev_get_drvdata(dev);
|
||
|
return sprintf(buf, "%hhu\n", data->curr_pwm);
|
||
|
}
|
||
|
|
||
|
static ssize_t pwm_store(struct device *dev, struct device_attribute *attr,
|
||
|
const char *buf, size_t count)
|
||
|
{
|
||
|
struct compal_data *data = dev_get_drvdata(dev);
|
||
|
long val;
|
||
|
int err;
|
||
|
|
||
|
err = kstrtol(buf, 10, &val);
|
||
|
if (err)
|
||
|
return err;
|
||
|
if (val < 0 || val > 255)
|
||
|
return -EINVAL;
|
||
|
|
||
|
data->curr_pwm = val;
|
||
|
|
||
|
if (data->pwm_enable != 1)
|
||
|
return count;
|
||
|
set_pwm(val);
|
||
|
|
||
|
return count;
|
||
|
}
|
||
|
|
||
|
static ssize_t fan_show(struct device *dev, struct device_attribute *attr,
|
||
|
char *buf)
|
||
|
{
|
||
|
return sprintf(buf, "%d\n", get_fan_rpm());
|
||
|
}
|
||
|
|
||
|
|
||
|
/* Temperature interface */
|
||
|
#define TEMPERATURE_SHOW_TEMP_AND_LABEL(POSTFIX, ADDRESS, LABEL) \
|
||
|
static ssize_t temp_##POSTFIX(struct device *dev, \
|
||
|
struct device_attribute *attr, char *buf) \
|
||
|
{ \
|
||
|
return sprintf(buf, "%d\n", 1000 * (int)ec_read_s8(ADDRESS)); \
|
||
|
} \
|
||
|
static ssize_t label_##POSTFIX(struct device *dev, \
|
||
|
struct device_attribute *attr, char *buf) \
|
||
|
{ \
|
||
|
return sprintf(buf, "%s\n", LABEL); \
|
||
|
}
|
||
|
|
||
|
/* Labels as in service guide */
|
||
|
TEMPERATURE_SHOW_TEMP_AND_LABEL(cpu, TEMP_CPU, "CPU_TEMP");
|
||
|
TEMPERATURE_SHOW_TEMP_AND_LABEL(cpu_local, TEMP_CPU_LOCAL, "CPU_TEMP_LOCAL");
|
||
|
TEMPERATURE_SHOW_TEMP_AND_LABEL(cpu_DTS, TEMP_CPU_DTS, "CPU_DTS");
|
||
|
TEMPERATURE_SHOW_TEMP_AND_LABEL(northbridge,TEMP_NORTHBRIDGE,"NorthBridge");
|
||
|
TEMPERATURE_SHOW_TEMP_AND_LABEL(vga, TEMP_VGA, "VGA_TEMP");
|
||
|
TEMPERATURE_SHOW_TEMP_AND_LABEL(SKIN, TEMP_SKIN, "SKIN_TEMP90");
|
||
|
|
||
|
|
||
|
/* Power supply interface */
|
||
|
static int bat_status(void)
|
||
|
{
|
||
|
u8 status0 = ec_read_u8(BAT_STATUS0);
|
||
|
u8 status1 = ec_read_u8(BAT_STATUS1);
|
||
|
|
||
|
if (status0 & BAT_S0_CHARGING)
|
||
|
return POWER_SUPPLY_STATUS_CHARGING;
|
||
|
if (status0 & BAT_S0_DISCHARGE)
|
||
|
return POWER_SUPPLY_STATUS_DISCHARGING;
|
||
|
if (status1 & BAT_S1_FULL)
|
||
|
return POWER_SUPPLY_STATUS_FULL;
|
||
|
return POWER_SUPPLY_STATUS_NOT_CHARGING;
|
||
|
}
|
||
|
|
||
|
static int bat_health(void)
|
||
|
{
|
||
|
u8 status = ec_read_u8(BAT_STOP_CHARGE1);
|
||
|
|
||
|
if (status & BAT_STOP_CHRG1_OVERTEMPERATURE)
|
||
|
return POWER_SUPPLY_HEALTH_OVERHEAT;
|
||
|
if (status & BAT_STOP_CHRG1_OVERVOLTAGE)
|
||
|
return POWER_SUPPLY_HEALTH_OVERVOLTAGE;
|
||
|
if (status & BAT_STOP_CHRG1_BAD_CELL)
|
||
|
return POWER_SUPPLY_HEALTH_DEAD;
|
||
|
if (status & BAT_STOP_CHRG1_COMM_FAIL)
|
||
|
return POWER_SUPPLY_HEALTH_UNKNOWN;
|
||
|
return POWER_SUPPLY_HEALTH_GOOD;
|
||
|
}
|
||
|
|
||
|
static int bat_is_present(void)
|
||
|
{
|
||
|
u8 status = ec_read_u8(BAT_STATUS2);
|
||
|
return ((status & BAT_S1_EXISTS) != 0);
|
||
|
}
|
||
|
|
||
|
static int bat_technology(void)
|
||
|
{
|
||
|
u8 status = ec_read_u8(BAT_STATUS1);
|
||
|
|
||
|
if (status & BAT_S1_LiION_OR_NiMH)
|
||
|
return POWER_SUPPLY_TECHNOLOGY_LION;
|
||
|
return POWER_SUPPLY_TECHNOLOGY_NiMH;
|
||
|
}
|
||
|
|
||
|
static int bat_capacity_level(void)
|
||
|
{
|
||
|
u8 status0 = ec_read_u8(BAT_STATUS0);
|
||
|
u8 status1 = ec_read_u8(BAT_STATUS1);
|
||
|
u8 status2 = ec_read_u8(BAT_STATUS2);
|
||
|
|
||
|
if (status0 & BAT_S0_DISCHRG_CRITICAL
|
||
|
|| status1 & BAT_S1_EMPTY
|
||
|
|| status2 & BAT_S2_LOW_LOW)
|
||
|
return POWER_SUPPLY_CAPACITY_LEVEL_CRITICAL;
|
||
|
if (status0 & BAT_S0_LOW)
|
||
|
return POWER_SUPPLY_CAPACITY_LEVEL_LOW;
|
||
|
if (status1 & BAT_S1_FULL)
|
||
|
return POWER_SUPPLY_CAPACITY_LEVEL_FULL;
|
||
|
return POWER_SUPPLY_CAPACITY_LEVEL_NORMAL;
|
||
|
}
|
||
|
|
||
|
static int bat_get_property(struct power_supply *psy,
|
||
|
enum power_supply_property psp,
|
||
|
union power_supply_propval *val)
|
||
|
{
|
||
|
struct compal_data *data = power_supply_get_drvdata(psy);
|
||
|
|
||
|
switch (psp) {
|
||
|
case POWER_SUPPLY_PROP_STATUS:
|
||
|
val->intval = bat_status();
|
||
|
break;
|
||
|
case POWER_SUPPLY_PROP_HEALTH:
|
||
|
val->intval = bat_health();
|
||
|
break;
|
||
|
case POWER_SUPPLY_PROP_PRESENT:
|
||
|
val->intval = bat_is_present();
|
||
|
break;
|
||
|
case POWER_SUPPLY_PROP_TECHNOLOGY:
|
||
|
val->intval = bat_technology();
|
||
|
break;
|
||
|
case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN: /* THE design voltage... */
|
||
|
val->intval = ec_read_u16(BAT_VOLTAGE_DESIGN) * 1000;
|
||
|
break;
|
||
|
case POWER_SUPPLY_PROP_VOLTAGE_NOW:
|
||
|
val->intval = ec_read_u16(BAT_VOLTAGE_NOW) * 1000;
|
||
|
break;
|
||
|
case POWER_SUPPLY_PROP_CURRENT_NOW:
|
||
|
val->intval = ec_read_s16(BAT_CURRENT_NOW) * 1000;
|
||
|
break;
|
||
|
case POWER_SUPPLY_PROP_CURRENT_AVG:
|
||
|
val->intval = ec_read_s16(BAT_CURRENT_AVG) * 1000;
|
||
|
break;
|
||
|
case POWER_SUPPLY_PROP_POWER_NOW:
|
||
|
val->intval = ec_read_u8(BAT_POWER) * 1000000;
|
||
|
break;
|
||
|
case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
|
||
|
val->intval = ec_read_u16(BAT_CHARGE_DESIGN) * 1000;
|
||
|
break;
|
||
|
case POWER_SUPPLY_PROP_CHARGE_NOW:
|
||
|
val->intval = ec_read_u16(BAT_CHARGE_NOW) * 1000;
|
||
|
break;
|
||
|
case POWER_SUPPLY_PROP_CHARGE_CONTROL_LIMIT:
|
||
|
val->intval = ec_read_u8(BAT_CHARGE_LIMIT);
|
||
|
break;
|
||
|
case POWER_SUPPLY_PROP_CHARGE_CONTROL_LIMIT_MAX:
|
||
|
val->intval = BAT_CHARGE_LIMIT_MAX;
|
||
|
break;
|
||
|
case POWER_SUPPLY_PROP_CAPACITY:
|
||
|
val->intval = ec_read_u8(BAT_CAPACITY);
|
||
|
break;
|
||
|
case POWER_SUPPLY_PROP_CAPACITY_LEVEL:
|
||
|
val->intval = bat_capacity_level();
|
||
|
break;
|
||
|
/* It smees that BAT_TEMP_AVG is a (2's complement?) value showing
|
||
|
* the number of degrees, whereas BAT_TEMP is somewhat more
|
||
|
* complicated. It looks like this is a negative nember with a
|
||
|
* 100/256 divider and an offset of 222. Both were determined
|
||
|
* experimentally by comparing BAT_TEMP and BAT_TEMP_AVG. */
|
||
|
case POWER_SUPPLY_PROP_TEMP:
|
||
|
val->intval = ((222 - (int)ec_read_u8(BAT_TEMP)) * 1000) >> 8;
|
||
|
break;
|
||
|
case POWER_SUPPLY_PROP_TEMP_AMBIENT: /* Ambient, Avg, ... same thing */
|
||
|
val->intval = ec_read_s8(BAT_TEMP_AVG) * 10;
|
||
|
break;
|
||
|
/* Neither the model name nor manufacturer name work for me. */
|
||
|
case POWER_SUPPLY_PROP_MODEL_NAME:
|
||
|
val->strval = data->bat_model_name;
|
||
|
break;
|
||
|
case POWER_SUPPLY_PROP_MANUFACTURER:
|
||
|
val->strval = data->bat_manufacturer_name;
|
||
|
break;
|
||
|
case POWER_SUPPLY_PROP_SERIAL_NUMBER:
|
||
|
val->strval = data->bat_serial_number;
|
||
|
break;
|
||
|
default:
|
||
|
break;
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int bat_set_property(struct power_supply *psy,
|
||
|
enum power_supply_property psp,
|
||
|
const union power_supply_propval *val)
|
||
|
{
|
||
|
int level;
|
||
|
|
||
|
switch (psp) {
|
||
|
case POWER_SUPPLY_PROP_CHARGE_CONTROL_LIMIT:
|
||
|
level = val->intval;
|
||
|
if (level < 0 || level > BAT_CHARGE_LIMIT_MAX)
|
||
|
return -EINVAL;
|
||
|
if (ec_write(BAT_CHARGE_LIMIT, level) < 0)
|
||
|
return -EIO;
|
||
|
break;
|
||
|
default:
|
||
|
break;
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int bat_writeable_property(struct power_supply *psy,
|
||
|
enum power_supply_property psp)
|
||
|
{
|
||
|
switch (psp) {
|
||
|
case POWER_SUPPLY_PROP_CHARGE_CONTROL_LIMIT:
|
||
|
return 1;
|
||
|
default:
|
||
|
return 0;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
|
||
|
|
||
|
|
||
|
/* ============== */
|
||
|
/* Driver Globals */
|
||
|
/* ============== */
|
||
|
static DEVICE_ATTR(wake_up_pme,
|
||
|
0644, wake_up_pme_show, wake_up_pme_store);
|
||
|
static DEVICE_ATTR(wake_up_modem,
|
||
|
0644, wake_up_modem_show, wake_up_modem_store);
|
||
|
static DEVICE_ATTR(wake_up_lan,
|
||
|
0644, wake_up_lan_show, wake_up_lan_store);
|
||
|
static DEVICE_ATTR(wake_up_wlan,
|
||
|
0644, wake_up_wlan_show, wake_up_wlan_store);
|
||
|
static DEVICE_ATTR(wake_up_key,
|
||
|
0644, wake_up_key_show, wake_up_key_store);
|
||
|
static DEVICE_ATTR(wake_up_mouse,
|
||
|
0644, wake_up_mouse_show, wake_up_mouse_store);
|
||
|
|
||
|
static DEVICE_ATTR(fan1_input, S_IRUGO, fan_show, NULL);
|
||
|
static DEVICE_ATTR(temp1_input, S_IRUGO, temp_cpu, NULL);
|
||
|
static DEVICE_ATTR(temp2_input, S_IRUGO, temp_cpu_local, NULL);
|
||
|
static DEVICE_ATTR(temp3_input, S_IRUGO, temp_cpu_DTS, NULL);
|
||
|
static DEVICE_ATTR(temp4_input, S_IRUGO, temp_northbridge, NULL);
|
||
|
static DEVICE_ATTR(temp5_input, S_IRUGO, temp_vga, NULL);
|
||
|
static DEVICE_ATTR(temp6_input, S_IRUGO, temp_SKIN, NULL);
|
||
|
static DEVICE_ATTR(temp1_label, S_IRUGO, label_cpu, NULL);
|
||
|
static DEVICE_ATTR(temp2_label, S_IRUGO, label_cpu_local, NULL);
|
||
|
static DEVICE_ATTR(temp3_label, S_IRUGO, label_cpu_DTS, NULL);
|
||
|
static DEVICE_ATTR(temp4_label, S_IRUGO, label_northbridge, NULL);
|
||
|
static DEVICE_ATTR(temp5_label, S_IRUGO, label_vga, NULL);
|
||
|
static DEVICE_ATTR(temp6_label, S_IRUGO, label_SKIN, NULL);
|
||
|
static DEVICE_ATTR(pwm1, S_IRUGO | S_IWUSR, pwm_show, pwm_store);
|
||
|
static DEVICE_ATTR(pwm1_enable,
|
||
|
S_IRUGO | S_IWUSR, pwm_enable_show, pwm_enable_store);
|
||
|
|
||
|
static struct attribute *compal_platform_attrs[] = {
|
||
|
&dev_attr_wake_up_pme.attr,
|
||
|
&dev_attr_wake_up_modem.attr,
|
||
|
&dev_attr_wake_up_lan.attr,
|
||
|
&dev_attr_wake_up_wlan.attr,
|
||
|
&dev_attr_wake_up_key.attr,
|
||
|
&dev_attr_wake_up_mouse.attr,
|
||
|
NULL
|
||
|
};
|
||
|
static struct attribute_group compal_platform_attr_group = {
|
||
|
.attrs = compal_platform_attrs
|
||
|
};
|
||
|
|
||
|
static struct attribute *compal_hwmon_attrs[] = {
|
||
|
&dev_attr_pwm1_enable.attr,
|
||
|
&dev_attr_pwm1.attr,
|
||
|
&dev_attr_fan1_input.attr,
|
||
|
&dev_attr_temp1_input.attr,
|
||
|
&dev_attr_temp2_input.attr,
|
||
|
&dev_attr_temp3_input.attr,
|
||
|
&dev_attr_temp4_input.attr,
|
||
|
&dev_attr_temp5_input.attr,
|
||
|
&dev_attr_temp6_input.attr,
|
||
|
&dev_attr_temp1_label.attr,
|
||
|
&dev_attr_temp2_label.attr,
|
||
|
&dev_attr_temp3_label.attr,
|
||
|
&dev_attr_temp4_label.attr,
|
||
|
&dev_attr_temp5_label.attr,
|
||
|
&dev_attr_temp6_label.attr,
|
||
|
NULL
|
||
|
};
|
||
|
ATTRIBUTE_GROUPS(compal_hwmon);
|
||
|
|
||
|
static int compal_probe(struct platform_device *);
|
||
|
static int compal_remove(struct platform_device *);
|
||
|
static struct platform_driver compal_driver = {
|
||
|
.driver = {
|
||
|
.name = DRIVER_NAME,
|
||
|
},
|
||
|
.probe = compal_probe,
|
||
|
.remove = compal_remove,
|
||
|
};
|
||
|
|
||
|
static enum power_supply_property compal_bat_properties[] = {
|
||
|
POWER_SUPPLY_PROP_STATUS,
|
||
|
POWER_SUPPLY_PROP_HEALTH,
|
||
|
POWER_SUPPLY_PROP_PRESENT,
|
||
|
POWER_SUPPLY_PROP_TECHNOLOGY,
|
||
|
POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN,
|
||
|
POWER_SUPPLY_PROP_VOLTAGE_NOW,
|
||
|
POWER_SUPPLY_PROP_CURRENT_NOW,
|
||
|
POWER_SUPPLY_PROP_CURRENT_AVG,
|
||
|
POWER_SUPPLY_PROP_POWER_NOW,
|
||
|
POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
|
||
|
POWER_SUPPLY_PROP_CHARGE_NOW,
|
||
|
POWER_SUPPLY_PROP_CHARGE_CONTROL_LIMIT,
|
||
|
POWER_SUPPLY_PROP_CHARGE_CONTROL_LIMIT_MAX,
|
||
|
POWER_SUPPLY_PROP_CAPACITY,
|
||
|
POWER_SUPPLY_PROP_CAPACITY_LEVEL,
|
||
|
POWER_SUPPLY_PROP_TEMP,
|
||
|
POWER_SUPPLY_PROP_TEMP_AMBIENT,
|
||
|
POWER_SUPPLY_PROP_MODEL_NAME,
|
||
|
POWER_SUPPLY_PROP_MANUFACTURER,
|
||
|
POWER_SUPPLY_PROP_SERIAL_NUMBER,
|
||
|
};
|
||
|
|
||
|
static struct backlight_device *compalbl_device;
|
||
|
|
||
|
static struct platform_device *compal_device;
|
||
|
|
||
|
static struct rfkill *wifi_rfkill;
|
||
|
static struct rfkill *bt_rfkill;
|
||
|
|
||
|
|
||
|
|
||
|
|
||
|
|
||
|
/* =================================== */
|
||
|
/* Initialization & clean-up functions */
|
||
|
/* =================================== */
|
||
|
|
||
|
static int dmi_check_cb(const struct dmi_system_id *id)
|
||
|
{
|
||
|
pr_info("Identified laptop model '%s'\n", id->ident);
|
||
|
extra_features = false;
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
static int dmi_check_cb_extra(const struct dmi_system_id *id)
|
||
|
{
|
||
|
pr_info("Identified laptop model '%s', enabling extra features\n",
|
||
|
id->ident);
|
||
|
extra_features = true;
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
static struct dmi_system_id __initdata compal_dmi_table[] = {
|
||
|
{
|
||
|
.ident = "FL90/IFL90",
|
||
|
.matches = {
|
||
|
DMI_MATCH(DMI_BOARD_NAME, "IFL90"),
|
||
|
DMI_MATCH(DMI_BOARD_VERSION, "IFT00"),
|
||
|
},
|
||
|
.callback = dmi_check_cb
|
||
|
},
|
||
|
{
|
||
|
.ident = "FL90/IFL90",
|
||
|
.matches = {
|
||
|
DMI_MATCH(DMI_BOARD_NAME, "IFL90"),
|
||
|
DMI_MATCH(DMI_BOARD_VERSION, "REFERENCE"),
|
||
|
},
|
||
|
.callback = dmi_check_cb
|
||
|
},
|
||
|
{
|
||
|
.ident = "FL91/IFL91",
|
||
|
.matches = {
|
||
|
DMI_MATCH(DMI_BOARD_NAME, "IFL91"),
|
||
|
DMI_MATCH(DMI_BOARD_VERSION, "IFT00"),
|
||
|
},
|
||
|
.callback = dmi_check_cb
|
||
|
},
|
||
|
{
|
||
|
.ident = "FL92/JFL92",
|
||
|
.matches = {
|
||
|
DMI_MATCH(DMI_BOARD_NAME, "JFL92"),
|
||
|
DMI_MATCH(DMI_BOARD_VERSION, "IFT00"),
|
||
|
},
|
||
|
.callback = dmi_check_cb
|
||
|
},
|
||
|
{
|
||
|
.ident = "FT00/IFT00",
|
||
|
.matches = {
|
||
|
DMI_MATCH(DMI_BOARD_NAME, "IFT00"),
|
||
|
DMI_MATCH(DMI_BOARD_VERSION, "IFT00"),
|
||
|
},
|
||
|
.callback = dmi_check_cb
|
||
|
},
|
||
|
{
|
||
|
.ident = "Dell Mini 9",
|
||
|
.matches = {
|
||
|
DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
|
||
|
DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron 910"),
|
||
|
},
|
||
|
.callback = dmi_check_cb
|
||
|
},
|
||
|
{
|
||
|
.ident = "Dell Mini 10",
|
||
|
.matches = {
|
||
|
DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
|
||
|
DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron 1010"),
|
||
|
},
|
||
|
.callback = dmi_check_cb
|
||
|
},
|
||
|
{
|
||
|
.ident = "Dell Mini 10v",
|
||
|
.matches = {
|
||
|
DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
|
||
|
DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron 1011"),
|
||
|
},
|
||
|
.callback = dmi_check_cb
|
||
|
},
|
||
|
{
|
||
|
.ident = "Dell Mini 1012",
|
||
|
.matches = {
|
||
|
DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
|
||
|
DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron 1012"),
|
||
|
},
|
||
|
.callback = dmi_check_cb
|
||
|
},
|
||
|
{
|
||
|
.ident = "Dell Inspiron 11z",
|
||
|
.matches = {
|
||
|
DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
|
||
|
DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron 1110"),
|
||
|
},
|
||
|
.callback = dmi_check_cb
|
||
|
},
|
||
|
{
|
||
|
.ident = "Dell Mini 12",
|
||
|
.matches = {
|
||
|
DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
|
||
|
DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron 1210"),
|
||
|
},
|
||
|
.callback = dmi_check_cb
|
||
|
},
|
||
|
{
|
||
|
.ident = "JHL90",
|
||
|
.matches = {
|
||
|
DMI_MATCH(DMI_BOARD_NAME, "JHL90"),
|
||
|
DMI_MATCH(DMI_BOARD_VERSION, "REFERENCE"),
|
||
|
},
|
||
|
.callback = dmi_check_cb_extra
|
||
|
},
|
||
|
{
|
||
|
.ident = "KHLB2",
|
||
|
.matches = {
|
||
|
DMI_MATCH(DMI_BOARD_NAME, "KHLB2"),
|
||
|
DMI_MATCH(DMI_BOARD_VERSION, "REFERENCE"),
|
||
|
},
|
||
|
.callback = dmi_check_cb_extra
|
||
|
},
|
||
|
{ }
|
||
|
};
|
||
|
MODULE_DEVICE_TABLE(dmi, compal_dmi_table);
|
||
|
|
||
|
static const struct power_supply_desc psy_bat_desc = {
|
||
|
.name = DRIVER_NAME,
|
||
|
.type = POWER_SUPPLY_TYPE_BATTERY,
|
||
|
.properties = compal_bat_properties,
|
||
|
.num_properties = ARRAY_SIZE(compal_bat_properties),
|
||
|
.get_property = bat_get_property,
|
||
|
.set_property = bat_set_property,
|
||
|
.property_is_writeable = bat_writeable_property,
|
||
|
};
|
||
|
|
||
|
static void initialize_power_supply_data(struct compal_data *data)
|
||
|
{
|
||
|
ec_read_sequence(BAT_MANUFACTURER_NAME_ADDR,
|
||
|
data->bat_manufacturer_name,
|
||
|
BAT_MANUFACTURER_NAME_LEN);
|
||
|
data->bat_manufacturer_name[BAT_MANUFACTURER_NAME_LEN] = 0;
|
||
|
|
||
|
ec_read_sequence(BAT_MODEL_NAME_ADDR,
|
||
|
data->bat_model_name,
|
||
|
BAT_MODEL_NAME_LEN);
|
||
|
data->bat_model_name[BAT_MODEL_NAME_LEN] = 0;
|
||
|
|
||
|
scnprintf(data->bat_serial_number, BAT_SERIAL_NUMBER_LEN + 1, "%d",
|
||
|
ec_read_u16(BAT_SERIAL_NUMBER_ADDR));
|
||
|
}
|
||
|
|
||
|
static void initialize_fan_control_data(struct compal_data *data)
|
||
|
{
|
||
|
data->pwm_enable = 2; /* Keep motherboard in control for now */
|
||
|
data->curr_pwm = 255; /* Try not to cause a CPU_on_fire exception
|
||
|
if we take over... */
|
||
|
}
|
||
|
|
||
|
static int setup_rfkill(void)
|
||
|
{
|
||
|
int ret;
|
||
|
|
||
|
wifi_rfkill = rfkill_alloc("compal-wifi", &compal_device->dev,
|
||
|
RFKILL_TYPE_WLAN, &compal_rfkill_ops,
|
||
|
(void *) WIRELESS_WLAN);
|
||
|
if (!wifi_rfkill)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
ret = rfkill_register(wifi_rfkill);
|
||
|
if (ret)
|
||
|
goto err_wifi;
|
||
|
|
||
|
bt_rfkill = rfkill_alloc("compal-bluetooth", &compal_device->dev,
|
||
|
RFKILL_TYPE_BLUETOOTH, &compal_rfkill_ops,
|
||
|
(void *) WIRELESS_BT);
|
||
|
if (!bt_rfkill) {
|
||
|
ret = -ENOMEM;
|
||
|
goto err_allocate_bt;
|
||
|
}
|
||
|
ret = rfkill_register(bt_rfkill);
|
||
|
if (ret)
|
||
|
goto err_register_bt;
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
err_register_bt:
|
||
|
rfkill_destroy(bt_rfkill);
|
||
|
|
||
|
err_allocate_bt:
|
||
|
rfkill_unregister(wifi_rfkill);
|
||
|
|
||
|
err_wifi:
|
||
|
rfkill_destroy(wifi_rfkill);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int __init compal_init(void)
|
||
|
{
|
||
|
int ret;
|
||
|
|
||
|
if (acpi_disabled) {
|
||
|
pr_err("ACPI needs to be enabled for this driver to work!\n");
|
||
|
return -ENODEV;
|
||
|
}
|
||
|
|
||
|
if (!force && !dmi_check_system(compal_dmi_table)) {
|
||
|
pr_err("Motherboard not recognized (You could try the module's force-parameter)\n");
|
||
|
return -ENODEV;
|
||
|
}
|
||
|
|
||
|
if (acpi_video_get_backlight_type() == acpi_backlight_vendor) {
|
||
|
struct backlight_properties props;
|
||
|
memset(&props, 0, sizeof(struct backlight_properties));
|
||
|
props.type = BACKLIGHT_PLATFORM;
|
||
|
props.max_brightness = BACKLIGHT_LEVEL_MAX;
|
||
|
compalbl_device = backlight_device_register(DRIVER_NAME,
|
||
|
NULL, NULL,
|
||
|
&compalbl_ops,
|
||
|
&props);
|
||
|
if (IS_ERR(compalbl_device))
|
||
|
return PTR_ERR(compalbl_device);
|
||
|
}
|
||
|
|
||
|
ret = platform_driver_register(&compal_driver);
|
||
|
if (ret)
|
||
|
goto err_backlight;
|
||
|
|
||
|
compal_device = platform_device_alloc(DRIVER_NAME, -1);
|
||
|
if (!compal_device) {
|
||
|
ret = -ENOMEM;
|
||
|
goto err_platform_driver;
|
||
|
}
|
||
|
|
||
|
ret = platform_device_add(compal_device); /* This calls compal_probe */
|
||
|
if (ret)
|
||
|
goto err_platform_device;
|
||
|
|
||
|
ret = setup_rfkill();
|
||
|
if (ret)
|
||
|
goto err_rfkill;
|
||
|
|
||
|
pr_info("Driver " DRIVER_VERSION " successfully loaded\n");
|
||
|
return 0;
|
||
|
|
||
|
err_rfkill:
|
||
|
platform_device_del(compal_device);
|
||
|
|
||
|
err_platform_device:
|
||
|
platform_device_put(compal_device);
|
||
|
|
||
|
err_platform_driver:
|
||
|
platform_driver_unregister(&compal_driver);
|
||
|
|
||
|
err_backlight:
|
||
|
backlight_device_unregister(compalbl_device);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int compal_probe(struct platform_device *pdev)
|
||
|
{
|
||
|
int err;
|
||
|
struct compal_data *data;
|
||
|
struct device *hwmon_dev;
|
||
|
struct power_supply_config psy_cfg = {};
|
||
|
|
||
|
if (!extra_features)
|
||
|
return 0;
|
||
|
|
||
|
/* Fan control */
|
||
|
data = devm_kzalloc(&pdev->dev, sizeof(struct compal_data), GFP_KERNEL);
|
||
|
if (!data)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
initialize_fan_control_data(data);
|
||
|
|
||
|
err = sysfs_create_group(&pdev->dev.kobj, &compal_platform_attr_group);
|
||
|
if (err)
|
||
|
return err;
|
||
|
|
||
|
hwmon_dev = devm_hwmon_device_register_with_groups(&pdev->dev,
|
||
|
"compal", data,
|
||
|
compal_hwmon_groups);
|
||
|
if (IS_ERR(hwmon_dev)) {
|
||
|
err = PTR_ERR(hwmon_dev);
|
||
|
goto remove;
|
||
|
}
|
||
|
|
||
|
/* Power supply */
|
||
|
initialize_power_supply_data(data);
|
||
|
psy_cfg.drv_data = data;
|
||
|
data->psy = power_supply_register(&compal_device->dev, &psy_bat_desc,
|
||
|
&psy_cfg);
|
||
|
if (IS_ERR(data->psy)) {
|
||
|
err = PTR_ERR(data->psy);
|
||
|
goto remove;
|
||
|
}
|
||
|
|
||
|
platform_set_drvdata(pdev, data);
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
remove:
|
||
|
sysfs_remove_group(&pdev->dev.kobj, &compal_platform_attr_group);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
static void __exit compal_cleanup(void)
|
||
|
{
|
||
|
platform_device_unregister(compal_device);
|
||
|
platform_driver_unregister(&compal_driver);
|
||
|
backlight_device_unregister(compalbl_device);
|
||
|
rfkill_unregister(wifi_rfkill);
|
||
|
rfkill_unregister(bt_rfkill);
|
||
|
rfkill_destroy(wifi_rfkill);
|
||
|
rfkill_destroy(bt_rfkill);
|
||
|
|
||
|
pr_info("Driver unloaded\n");
|
||
|
}
|
||
|
|
||
|
static int compal_remove(struct platform_device *pdev)
|
||
|
{
|
||
|
struct compal_data *data;
|
||
|
|
||
|
if (!extra_features)
|
||
|
return 0;
|
||
|
|
||
|
pr_info("Unloading: resetting fan control to motherboard\n");
|
||
|
pwm_disable_control();
|
||
|
|
||
|
data = platform_get_drvdata(pdev);
|
||
|
power_supply_unregister(data->psy);
|
||
|
|
||
|
sysfs_remove_group(&pdev->dev.kobj, &compal_platform_attr_group);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
|
||
|
module_init(compal_init);
|
||
|
module_exit(compal_cleanup);
|
||
|
|
||
|
MODULE_AUTHOR("Cezary Jackiewicz");
|
||
|
MODULE_AUTHOR("Roald Frederickx (roald.frederickx@gmail.com)");
|
||
|
MODULE_DESCRIPTION("Compal Laptop Support");
|
||
|
MODULE_VERSION(DRIVER_VERSION);
|
||
|
MODULE_LICENSE("GPL");
|