diff options
Diffstat (limited to 'drivers/platform/x86/compal-laptop.c')
| -rw-r--r-- | drivers/platform/x86/compal-laptop.c | 929 |
1 files changed, 823 insertions, 106 deletions
diff --git a/drivers/platform/x86/compal-laptop.c b/drivers/platform/x86/compal-laptop.c index 71ff1545a93..d071ce05632 100644 --- a/drivers/platform/x86/compal-laptop.c +++ b/drivers/platform/x86/compal-laptop.c | |||
| @@ -24,17 +24,50 @@ | |||
| 24 | */ | 24 | */ |
| 25 | 25 | ||
| 26 | /* | 26 | /* |
| 27 | * comapl-laptop.c - Compal laptop support. | 27 | * compal-laptop.c - Compal laptop support. |
| 28 | * | ||
| 29 | * 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) | ||
| 28 | * | 45 | * |
| 29 | * The driver registers itself with the rfkill subsystem and | ||
| 30 | * the Linux backlight control subsystem. | ||
| 31 | * | 46 | * |
| 32 | * This driver might work on other laptops produced by Compal. If you | 47 | * This driver might work on other laptops produced by Compal. If you |
| 33 | * want to try it you can pass force=1 as argument to the module which | 48 | * want to try it you can pass force=1 as argument to the module which |
| 34 | * will force it to load even when the DMI data doesn't identify the | 49 | * will force it to load even when the DMI data doesn't identify the |
| 35 | * laptop as FL9x. | 50 | * 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! | ||
| 36 | */ | 65 | */ |
| 37 | 66 | ||
| 67 | /* 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 | |||
| 38 | #include <linux/module.h> | 71 | #include <linux/module.h> |
| 39 | #include <linux/kernel.h> | 72 | #include <linux/kernel.h> |
| 40 | #include <linux/init.h> | 73 | #include <linux/init.h> |
| @@ -43,71 +76,296 @@ | |||
| 43 | #include <linux/backlight.h> | 76 | #include <linux/backlight.h> |
| 44 | #include <linux/platform_device.h> | 77 | #include <linux/platform_device.h> |
| 45 | #include <linux/rfkill.h> | 78 | #include <linux/rfkill.h> |
| 79 | #include <linux/hwmon.h> | ||
| 80 | #include <linux/hwmon-sysfs.h> | ||
| 81 | #include <linux/power_supply.h> | ||
| 82 | #include <linux/fb.h> | ||
| 83 | |||
| 84 | |||
| 85 | /* ======= */ | ||
| 86 | /* Defines */ | ||
| 87 | /* ======= */ | ||
| 88 | #define DRIVER_NAME "compal-laptop" | ||
| 89 | #define DRIVER_VERSION "0.2.7" | ||
| 90 | |||
| 91 | #define BACKLIGHT_LEVEL_ADDR 0xB9 | ||
| 92 | #define BACKLIGHT_LEVEL_MAX 7 | ||
| 93 | #define BACKLIGHT_STATE_ADDR 0x59 | ||
| 94 | #define BACKLIGHT_STATE_ON_DATA 0xE1 | ||
| 95 | #define BACKLIGHT_STATE_OFF_DATA 0xE2 | ||
| 96 | |||
| 97 | #define WAKE_UP_ADDR 0xA4 | ||
| 98 | #define WAKE_UP_PME (1 << 0) | ||
| 99 | #define WAKE_UP_MODEM (1 << 1) | ||
| 100 | #define WAKE_UP_LAN (1 << 2) | ||
| 101 | #define WAKE_UP_WLAN (1 << 4) | ||
| 102 | #define WAKE_UP_KEY (1 << 6) | ||
| 103 | #define WAKE_UP_MOUSE (1 << 7) | ||
| 104 | |||
| 105 | #define WIRELESS_ADDR 0xBB | ||
| 106 | #define WIRELESS_WLAN (1 << 0) | ||
| 107 | #define WIRELESS_BT (1 << 1) | ||
| 108 | #define WIRELESS_WLAN_EXISTS (1 << 2) | ||
| 109 | #define WIRELESS_BT_EXISTS (1 << 3) | ||
| 110 | #define WIRELESS_KILLSWITCH (1 << 4) | ||
| 111 | |||
| 112 | #define PWM_ADDRESS 0x46 | ||
| 113 | #define PWM_DISABLE_ADDR 0x59 | ||
| 114 | #define PWM_DISABLE_DATA 0xA5 | ||
| 115 | #define PWM_ENABLE_ADDR 0x59 | ||
| 116 | #define PWM_ENABLE_DATA 0xA8 | ||
| 117 | |||
| 118 | #define FAN_ADDRESS 0x46 | ||
| 119 | #define FAN_DATA 0x81 | ||
| 120 | #define FAN_FULL_ON_CMD 0x59 /* Doesn't seem to work. Just */ | ||
| 121 | #define FAN_FULL_ON_ENABLE 0x76 /* force the pwm signal to its */ | ||
| 122 | #define FAN_FULL_ON_DISABLE 0x77 /* maximum value instead */ | ||
| 123 | |||
| 124 | #define TEMP_CPU 0xB0 | ||
| 125 | #define TEMP_CPU_LOCAL 0xB1 | ||
| 126 | #define TEMP_CPU_DTS 0xB5 | ||
| 127 | #define TEMP_NORTHBRIDGE 0xB6 | ||
| 128 | #define TEMP_VGA 0xB4 | ||
| 129 | #define TEMP_SKIN 0xB2 | ||
| 130 | |||
| 131 | #define BAT_MANUFACTURER_NAME_ADDR 0x10 | ||
| 132 | #define BAT_MANUFACTURER_NAME_LEN 9 | ||
| 133 | #define BAT_MODEL_NAME_ADDR 0x19 | ||
| 134 | #define BAT_MODEL_NAME_LEN 6 | ||
| 135 | #define BAT_SERIAL_NUMBER_ADDR 0xC4 | ||
| 136 | #define BAT_SERIAL_NUMBER_LEN 5 | ||
| 137 | #define BAT_CHARGE_NOW 0xC2 | ||
| 138 | #define BAT_CHARGE_DESIGN 0xCA | ||
| 139 | #define BAT_VOLTAGE_NOW 0xC6 | ||
| 140 | #define BAT_VOLTAGE_DESIGN 0xC8 | ||
| 141 | #define BAT_CURRENT_NOW 0xD0 | ||
| 142 | #define BAT_CURRENT_AVG 0xD2 | ||
| 143 | #define BAT_POWER 0xD4 | ||
| 144 | #define BAT_CAPACITY 0xCE | ||
| 145 | #define BAT_TEMP 0xD6 | ||
| 146 | #define BAT_TEMP_AVG 0xD7 | ||
| 147 | #define BAT_STATUS0 0xC1 | ||
| 148 | #define BAT_STATUS1 0xF0 | ||
| 149 | #define BAT_STATUS2 0xF1 | ||
| 150 | #define BAT_STOP_CHARGE1 0xF2 | ||
| 151 | #define BAT_STOP_CHARGE2 0xF3 | ||
| 152 | |||
| 153 | #define BAT_S0_DISCHARGE (1 << 0) | ||
| 154 | #define BAT_S0_DISCHRG_CRITICAL (1 << 2) | ||
| 155 | #define BAT_S0_LOW (1 << 3) | ||
| 156 | #define BAT_S0_CHARGING (1 << 1) | ||
| 157 | #define BAT_S0_AC (1 << 7) | ||
| 158 | #define BAT_S1_EXISTS (1 << 0) | ||
| 159 | #define BAT_S1_FULL (1 << 1) | ||
| 160 | #define BAT_S1_EMPTY (1 << 2) | ||
| 161 | #define BAT_S1_LiION_OR_NiMH (1 << 7) | ||
| 162 | #define BAT_S2_LOW_LOW (1 << 0) | ||
| 163 | #define BAT_STOP_CHRG1_BAD_CELL (1 << 1) | ||
| 164 | #define BAT_STOP_CHRG1_COMM_FAIL (1 << 2) | ||
| 165 | #define BAT_STOP_CHRG1_OVERVOLTAGE (1 << 6) | ||
| 166 | #define BAT_STOP_CHRG1_OVERTEMPERATURE (1 << 7) | ||
| 167 | |||
| 168 | |||
| 169 | /* ======= */ | ||
| 170 | /* Structs */ | ||
| 171 | /* ======= */ | ||
| 172 | struct compal_data{ | ||
| 173 | /* Fan control */ | ||
| 174 | struct device *hwmon_dev; | ||
| 175 | int pwm_enable; /* 0:full on, 1:set by pwm1, 2:control by moterboard */ | ||
| 176 | unsigned char curr_pwm; | ||
| 177 | |||
| 178 | /* Power supply */ | ||
| 179 | struct power_supply psy; | ||
| 180 | struct power_supply_info psy_info; | ||
| 181 | char bat_model_name[BAT_MODEL_NAME_LEN + 1]; | ||
| 182 | char bat_manufacturer_name[BAT_MANUFACTURER_NAME_LEN + 1]; | ||
| 183 | char bat_serial_number[BAT_SERIAL_NUMBER_LEN + 1]; | ||
| 184 | }; | ||
| 46 | 185 | ||
| 47 | #define COMPAL_DRIVER_VERSION "0.2.6" | ||
| 48 | 186 | ||
| 49 | #define COMPAL_LCD_LEVEL_MAX 8 | 187 | /* =============== */ |
| 188 | /* General globals */ | ||
| 189 | /* =============== */ | ||
| 190 | static int force; | ||
| 191 | module_param(force, bool, 0); | ||
| 192 | MODULE_PARM_DESC(force, "Force driver load, ignore DMI data"); | ||
| 50 | 193 | ||
| 51 | #define COMPAL_EC_COMMAND_WIRELESS 0xBB | 194 | /* Support for the wake_on_XXX, hwmon and power_supply interface. Currently |
| 52 | #define COMPAL_EC_COMMAND_LCD_LEVEL 0xB9 | 195 | * only gets enabled on a JHL90 board. Might work with the others too */ |
| 196 | static bool extra_features; | ||
| 197 | |||
| 198 | /* Nasty stuff. For some reason the fan control is very un-linear. I've | ||
| 199 | * come up with these values by looping through the possible inputs and | ||
| 200 | * watching the output of address 0x4F (do an ec_transaction writing 0x33 | ||
| 201 | * into 0x4F and read a few bytes from the output, like so: | ||
| 202 | * u8 writeData = 0x33; | ||
| 203 | * ec_transaction(0x4F, &writeData, 1, buffer, 32, 0); | ||
| 204 | * That address is labled "fan1 table information" in the service manual. | ||
| 205 | * It should be clear which value in 'buffer' changes). This seems to be | ||
| 206 | * related to fan speed. It isn't a proper 'realtime' fan speed value | ||
| 207 | * though, because physically stopping or speeding up the fan doesn't | ||
| 208 | * change it. It might be the average voltage or current of the pwm output. | ||
| 209 | * Nevertheless, it is more fine-grained than the actual RPM reading */ | ||
| 210 | static const unsigned char pwm_lookup_table[256] = { | ||
| 211 | 0, 0, 0, 1, 1, 1, 2, 253, 254, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, | ||
| 212 | 7, 7, 7, 8, 86, 86, 9, 9, 9, 10, 10, 10, 11, 92, 92, 12, 12, 95, | ||
| 213 | 13, 66, 66, 14, 14, 98, 15, 15, 15, 16, 16, 67, 17, 17, 72, 18, 70, | ||
| 214 | 75, 19, 90, 90, 73, 73, 73, 21, 21, 91, 91, 91, 96, 23, 94, 94, 94, | ||
| 215 | 94, 94, 94, 94, 94, 94, 94, 141, 141, 238, 223, 192, 139, 139, 139, | ||
| 216 | 139, 139, 142, 142, 142, 142, 142, 78, 78, 78, 78, 78, 76, 76, 76, | ||
| 217 | 76, 76, 79, 79, 79, 79, 79, 79, 79, 20, 20, 20, 20, 20, 22, 22, 22, | ||
| 218 | 22, 22, 24, 24, 24, 24, 24, 24, 219, 219, 219, 219, 219, 219, 219, | ||
| 219 | 219, 27, 27, 188, 188, 28, 28, 28, 29, 186, 186, 186, 186, 186, | ||
| 220 | 186, 186, 186, 186, 186, 31, 31, 31, 31, 31, 32, 32, 32, 41, 33, | ||
| 221 | 33, 33, 33, 33, 252, 252, 34, 34, 34, 43, 35, 35, 35, 36, 36, 38, | ||
| 222 | 206, 206, 206, 206, 206, 206, 206, 206, 206, 37, 37, 37, 46, 46, | ||
| 223 | 47, 47, 232, 232, 232, 232, 232, 232, 232, 232, 232, 232, 48, 48, | ||
| 224 | 48, 48, 48, 40, 40, 40, 49, 42, 42, 42, 42, 42, 42, 42, 42, 44, | ||
| 225 | 189, 189, 189, 189, 54, 54, 45, 45, 45, 45, 45, 45, 45, 45, 251, | ||
| 226 | 191, 199, 199, 199, 199, 199, 215, 215, 215, 215, 187, 187, 187, | ||
| 227 | 187, 187, 193, 50 | ||
| 228 | }; | ||
| 53 | 229 | ||
| 54 | #define KILLSWITCH_MASK 0x10 | ||
| 55 | #define WLAN_MASK 0x01 | ||
| 56 | #define BT_MASK 0x02 | ||
| 57 | 230 | ||
| 58 | static struct rfkill *wifi_rfkill; | ||
| 59 | static struct rfkill *bt_rfkill; | ||
| 60 | static struct platform_device *compal_device; | ||
| 61 | 231 | ||
| 62 | static int force; | ||
| 63 | module_param(force, bool, 0); | ||
| 64 | MODULE_PARM_DESC(force, "Force driver load, ignore DMI data"); | ||
| 65 | 232 | ||
| 66 | /* Hardware access */ | 233 | /* ========================= */ |
| 234 | /* Hardware access functions */ | ||
| 235 | /* ========================= */ | ||
| 236 | /* General access */ | ||
| 237 | static u8 ec_read_u8(u8 addr) | ||
| 238 | { | ||
| 239 | u8 value; | ||
| 240 | ec_read(addr, &value); | ||
| 241 | return value; | ||
| 242 | } | ||
| 243 | |||
| 244 | static s8 ec_read_s8(u8 addr) | ||
| 245 | { | ||
| 246 | return (s8)ec_read_u8(addr); | ||
| 247 | } | ||
| 248 | |||
| 249 | static u16 ec_read_u16(u8 addr) | ||
| 250 | { | ||
| 251 | int hi, lo; | ||
| 252 | lo = ec_read_u8(addr); | ||
| 253 | hi = ec_read_u8(addr + 1); | ||
| 254 | return (hi << 8) + lo; | ||
| 255 | } | ||
| 256 | |||
| 257 | static s16 ec_read_s16(u8 addr) | ||
| 258 | { | ||
| 259 | return (s16) ec_read_u16(addr); | ||
| 260 | } | ||
| 67 | 261 | ||
| 68 | static int set_lcd_level(int level) | 262 | static void ec_read_sequence(u8 addr, u8 *buf, int len) |
| 69 | { | 263 | { |
| 70 | if (level < 0 || level >= COMPAL_LCD_LEVEL_MAX) | 264 | int i; |
| 265 | for (i = 0; i < len; i++) | ||
| 266 | ec_read(addr + i, buf + i); | ||
| 267 | } | ||
| 268 | |||
| 269 | |||
| 270 | /* Backlight access */ | ||
| 271 | static int set_backlight_level(int level) | ||
| 272 | { | ||
| 273 | if (level < 0 || level > BACKLIGHT_LEVEL_MAX) | ||
| 71 | return -EINVAL; | 274 | return -EINVAL; |
| 72 | 275 | ||
| 73 | ec_write(COMPAL_EC_COMMAND_LCD_LEVEL, level); | 276 | ec_write(BACKLIGHT_LEVEL_ADDR, level); |
| 74 | 277 | ||
| 75 | return 0; | 278 | return 1; |
| 279 | } | ||
| 280 | |||
| 281 | static int get_backlight_level(void) | ||
| 282 | { | ||
| 283 | return (int) ec_read_u8(BACKLIGHT_LEVEL_ADDR); | ||
| 76 | } | 284 | } |
| 77 | 285 | ||
| 78 | static int get_lcd_level(void) | 286 | static void set_backlight_state(bool on) |
| 79 | { | 287 | { |
| 80 | u8 result; | 288 | u8 data = on ? BACKLIGHT_STATE_ON_DATA : BACKLIGHT_STATE_OFF_DATA; |
| 289 | ec_transaction(BACKLIGHT_STATE_ADDR, &data, 1, NULL, 0, 0); | ||
| 290 | } | ||
| 291 | |||
| 292 | |||
| 293 | /* Fan control access */ | ||
| 294 | static void pwm_enable_control(void) | ||
| 295 | { | ||
| 296 | unsigned char writeData = PWM_ENABLE_DATA; | ||
| 297 | ec_transaction(PWM_ENABLE_ADDR, &writeData, 1, NULL, 0, 0); | ||
| 298 | } | ||
| 299 | |||
| 300 | static void pwm_disable_control(void) | ||
| 301 | { | ||
| 302 | unsigned char writeData = PWM_DISABLE_DATA; | ||
| 303 | ec_transaction(PWM_DISABLE_ADDR, &writeData, 1, NULL, 0, 0); | ||
| 304 | } | ||
| 81 | 305 | ||
| 82 | ec_read(COMPAL_EC_COMMAND_LCD_LEVEL, &result); | 306 | static void set_pwm(int pwm) |
| 307 | { | ||
| 308 | ec_transaction(PWM_ADDRESS, &pwm_lookup_table[pwm], 1, NULL, 0, 0); | ||
| 309 | } | ||
| 310 | |||
| 311 | static int get_fan_rpm(void) | ||
| 312 | { | ||
| 313 | u8 value, data = FAN_DATA; | ||
| 314 | ec_transaction(FAN_ADDRESS, &data, 1, &value, 1, 0); | ||
| 315 | return 100 * (int)value; | ||
| 316 | } | ||
| 317 | |||
| 318 | |||
| 319 | |||
| 320 | |||
| 321 | /* =================== */ | ||
| 322 | /* Interface functions */ | ||
| 323 | /* =================== */ | ||
| 324 | |||
| 325 | /* Backlight interface */ | ||
| 326 | static int bl_get_brightness(struct backlight_device *b) | ||
| 327 | { | ||
| 328 | return get_backlight_level(); | ||
| 329 | } | ||
| 330 | |||
| 331 | static int bl_update_status(struct backlight_device *b) | ||
| 332 | { | ||
| 333 | int ret = set_backlight_level(b->props.brightness); | ||
| 334 | if (ret) | ||
| 335 | return ret; | ||
| 83 | 336 | ||
| 84 | return (int) result; | 337 | set_backlight_state((b->props.power == FB_BLANK_UNBLANK) |
| 338 | && !(b->props.state & BL_CORE_SUSPENDED) | ||
| 339 | && !(b->props.state & BL_CORE_FBBLANK)); | ||
| 340 | return 0; | ||
| 85 | } | 341 | } |
| 86 | 342 | ||
| 343 | static const struct backlight_ops compalbl_ops = { | ||
| 344 | .get_brightness = bl_get_brightness, | ||
| 345 | .update_status = bl_update_status, | ||
| 346 | }; | ||
| 347 | |||
| 348 | |||
| 349 | /* Wireless interface */ | ||
| 87 | static int compal_rfkill_set(void *data, bool blocked) | 350 | static int compal_rfkill_set(void *data, bool blocked) |
| 88 | { | 351 | { |
| 89 | unsigned long radio = (unsigned long) data; | 352 | unsigned long radio = (unsigned long) data; |
| 90 | u8 result, value; | 353 | u8 result = ec_read_u8(WIRELESS_ADDR); |
| 91 | 354 | u8 value; | |
| 92 | ec_read(COMPAL_EC_COMMAND_WIRELESS, &result); | ||
| 93 | 355 | ||
| 94 | if (!blocked) | 356 | if (!blocked) |
| 95 | value = (u8) (result | radio); | 357 | value = (u8) (result | radio); |
| 96 | else | 358 | else |
| 97 | value = (u8) (result & ~radio); | 359 | value = (u8) (result & ~radio); |
| 98 | ec_write(COMPAL_EC_COMMAND_WIRELESS, value); | 360 | ec_write(WIRELESS_ADDR, value); |
| 99 | 361 | ||
| 100 | return 0; | 362 | return 0; |
| 101 | } | 363 | } |
| 102 | 364 | ||
| 103 | static void compal_rfkill_poll(struct rfkill *rfkill, void *data) | 365 | static void compal_rfkill_poll(struct rfkill *rfkill, void *data) |
| 104 | { | 366 | { |
| 105 | u8 result; | 367 | u8 result = ec_read_u8(WIRELESS_ADDR); |
| 106 | bool hw_blocked; | 368 | bool hw_blocked = !(result & WIRELESS_KILLSWITCH); |
| 107 | |||
| 108 | ec_read(COMPAL_EC_COMMAND_WIRELESS, &result); | ||
| 109 | |||
| 110 | hw_blocked = !(result & KILLSWITCH_MASK); | ||
| 111 | rfkill_set_hw_state(rfkill, hw_blocked); | 369 | rfkill_set_hw_state(rfkill, hw_blocked); |
| 112 | } | 370 | } |
| 113 | 371 | ||
| @@ -116,80 +374,404 @@ static const struct rfkill_ops compal_rfkill_ops = { | |||
| 116 | .set_block = compal_rfkill_set, | 374 | .set_block = compal_rfkill_set, |
| 117 | }; | 375 | }; |
| 118 | 376 | ||
| 119 | static int setup_rfkill(void) | 377 | |
| 378 | /* Wake_up interface */ | ||
| 379 | #define SIMPLE_MASKED_STORE_SHOW(NAME, ADDR, MASK) \ | ||
| 380 | static ssize_t NAME##_show(struct device *dev, \ | ||
| 381 | struct device_attribute *attr, char *buf) \ | ||
| 382 | { \ | ||
| 383 | return sprintf(buf, "%d\n", ((ec_read_u8(ADDR) & MASK) != 0)); \ | ||
| 384 | } \ | ||
| 385 | static ssize_t NAME##_store(struct device *dev, \ | ||
| 386 | struct device_attribute *attr, const char *buf, size_t count) \ | ||
| 387 | { \ | ||
| 388 | int state; \ | ||
| 389 | u8 old_val = ec_read_u8(ADDR); \ | ||
| 390 | if (sscanf(buf, "%d", &state) != 1 || (state < 0 || state > 1)) \ | ||
| 391 | return -EINVAL; \ | ||
| 392 | ec_write(ADDR, state ? (old_val | MASK) : (old_val & ~MASK)); \ | ||
| 393 | return count; \ | ||
| 394 | } | ||
| 395 | |||
| 396 | SIMPLE_MASKED_STORE_SHOW(wake_up_pme, WAKE_UP_ADDR, WAKE_UP_PME) | ||
| 397 | SIMPLE_MASKED_STORE_SHOW(wake_up_modem, WAKE_UP_ADDR, WAKE_UP_MODEM) | ||
| 398 | SIMPLE_MASKED_STORE_SHOW(wake_up_lan, WAKE_UP_ADDR, WAKE_UP_LAN) | ||
| 399 | SIMPLE_MASKED_STORE_SHOW(wake_up_wlan, WAKE_UP_ADDR, WAKE_UP_WLAN) | ||
| 400 | SIMPLE_MASKED_STORE_SHOW(wake_up_key, WAKE_UP_ADDR, WAKE_UP_KEY) | ||
| 401 | SIMPLE_MASKED_STORE_SHOW(wake_up_mouse, WAKE_UP_ADDR, WAKE_UP_MOUSE) | ||
| 402 | |||
| 403 | |||
| 404 | /* General hwmon interface */ | ||
| 405 | static ssize_t hwmon_name_show(struct device *dev, | ||
| 406 | struct device_attribute *attr, char *buf) | ||
| 120 | { | 407 | { |
| 121 | int ret; | 408 | return sprintf(buf, "%s\n", DRIVER_NAME); |
| 409 | } | ||
| 122 | 410 | ||
| 123 | wifi_rfkill = rfkill_alloc("compal-wifi", &compal_device->dev, | ||
| 124 | RFKILL_TYPE_WLAN, &compal_rfkill_ops, | ||
| 125 | (void *) WLAN_MASK); | ||
| 126 | if (!wifi_rfkill) | ||
| 127 | return -ENOMEM; | ||
| 128 | 411 | ||
| 129 | ret = rfkill_register(wifi_rfkill); | 412 | /* Fan control interface */ |
| 130 | if (ret) | 413 | static ssize_t pwm_enable_show(struct device *dev, |
| 131 | goto err_wifi; | 414 | struct device_attribute *attr, char *buf) |
| 415 | { | ||
| 416 | struct compal_data *data = dev_get_drvdata(dev); | ||
| 417 | return sprintf(buf, "%d\n", data->pwm_enable); | ||
| 418 | } | ||
| 132 | 419 | ||
| 133 | bt_rfkill = rfkill_alloc("compal-bluetooth", &compal_device->dev, | 420 | static ssize_t pwm_enable_store(struct device *dev, |
| 134 | RFKILL_TYPE_BLUETOOTH, &compal_rfkill_ops, | 421 | struct device_attribute *attr, const char *buf, size_t count) |
| 135 | (void *) BT_MASK); | 422 | { |
| 136 | if (!bt_rfkill) { | 423 | struct compal_data *data = dev_get_drvdata(dev); |
| 137 | ret = -ENOMEM; | 424 | long val; |
| 138 | goto err_allocate_bt; | 425 | int err; |
| 426 | err = strict_strtol(buf, 10, &val); | ||
| 427 | if (err) | ||
| 428 | return err; | ||
| 429 | if (val < 0) | ||
| 430 | return -EINVAL; | ||
| 431 | |||
| 432 | data->pwm_enable = val; | ||
| 433 | |||
| 434 | switch (val) { | ||
| 435 | case 0: /* Full speed */ | ||
| 436 | pwm_enable_control(); | ||
| 437 | set_pwm(255); | ||
| 438 | break; | ||
| 439 | case 1: /* As set by pwm1 */ | ||
| 440 | pwm_enable_control(); | ||
| 441 | set_pwm(data->curr_pwm); | ||
| 442 | break; | ||
| 443 | default: /* Control by motherboard */ | ||
| 444 | pwm_disable_control(); | ||
| 445 | break; | ||
| 139 | } | 446 | } |
| 140 | ret = rfkill_register(bt_rfkill); | ||
| 141 | if (ret) | ||
| 142 | goto err_register_bt; | ||
| 143 | 447 | ||
| 144 | return 0; | 448 | return count; |
| 449 | } | ||
| 145 | 450 | ||
| 146 | err_register_bt: | 451 | static ssize_t pwm_show(struct device *dev, struct device_attribute *attr, |
| 147 | rfkill_destroy(bt_rfkill); | 452 | char *buf) |
| 453 | { | ||
| 454 | struct compal_data *data = dev_get_drvdata(dev); | ||
| 455 | return sprintf(buf, "%hhu\n", data->curr_pwm); | ||
| 456 | } | ||
| 148 | 457 | ||
| 149 | err_allocate_bt: | 458 | static ssize_t pwm_store(struct device *dev, struct device_attribute *attr, |
| 150 | rfkill_unregister(wifi_rfkill); | 459 | const char *buf, size_t count) |
| 460 | { | ||
| 461 | struct compal_data *data = dev_get_drvdata(dev); | ||
| 462 | long val; | ||
| 463 | int err; | ||
| 464 | err = strict_strtol(buf, 10, &val); | ||
| 465 | if (err) | ||
| 466 | return err; | ||
| 467 | if (val < 0 || val > 255) | ||
| 468 | return -EINVAL; | ||
| 151 | 469 | ||
| 152 | err_wifi: | 470 | data->curr_pwm = val; |
| 153 | rfkill_destroy(wifi_rfkill); | ||
| 154 | 471 | ||
| 155 | return ret; | 472 | if (data->pwm_enable != 1) |
| 473 | return count; | ||
| 474 | set_pwm(val); | ||
| 475 | |||
| 476 | return count; | ||
| 156 | } | 477 | } |
| 157 | 478 | ||
| 158 | /* Backlight device stuff */ | 479 | static ssize_t fan_show(struct device *dev, struct device_attribute *attr, |
| 480 | char *buf) | ||
| 481 | { | ||
| 482 | return sprintf(buf, "%d\n", get_fan_rpm()); | ||
| 483 | } | ||
| 159 | 484 | ||
| 160 | static int bl_get_brightness(struct backlight_device *b) | 485 | |
| 486 | /* Temperature interface */ | ||
| 487 | #define TEMPERATURE_SHOW_TEMP_AND_LABEL(POSTFIX, ADDRESS, LABEL) \ | ||
| 488 | static ssize_t temp_##POSTFIX(struct device *dev, \ | ||
| 489 | struct device_attribute *attr, char *buf) \ | ||
| 490 | { \ | ||
| 491 | return sprintf(buf, "%d\n", 1000 * (int)ec_read_s8(ADDRESS)); \ | ||
| 492 | } \ | ||
| 493 | static ssize_t label_##POSTFIX(struct device *dev, \ | ||
| 494 | struct device_attribute *attr, char *buf) \ | ||
| 495 | { \ | ||
| 496 | return sprintf(buf, "%s\n", LABEL); \ | ||
| 497 | } | ||
| 498 | |||
| 499 | /* Labels as in service guide */ | ||
| 500 | TEMPERATURE_SHOW_TEMP_AND_LABEL(cpu, TEMP_CPU, "CPU_TEMP"); | ||
| 501 | TEMPERATURE_SHOW_TEMP_AND_LABEL(cpu_local, TEMP_CPU_LOCAL, "CPU_TEMP_LOCAL"); | ||
| 502 | TEMPERATURE_SHOW_TEMP_AND_LABEL(cpu_DTS, TEMP_CPU_DTS, "CPU_DTS"); | ||
| 503 | TEMPERATURE_SHOW_TEMP_AND_LABEL(northbridge,TEMP_NORTHBRIDGE,"NorthBridge"); | ||
| 504 | TEMPERATURE_SHOW_TEMP_AND_LABEL(vga, TEMP_VGA, "VGA_TEMP"); | ||
| 505 | TEMPERATURE_SHOW_TEMP_AND_LABEL(SKIN, TEMP_SKIN, "SKIN_TEMP90"); | ||
| 506 | |||
| 507 | |||
| 508 | /* Power supply interface */ | ||
| 509 | static int bat_status(void) | ||
| 510 | { | ||
| 511 | u8 status0 = ec_read_u8(BAT_STATUS0); | ||
| 512 | u8 status1 = ec_read_u8(BAT_STATUS1); | ||
| 513 | |||
| 514 | if (status0 & BAT_S0_CHARGING) | ||
| 515 | return POWER_SUPPLY_STATUS_CHARGING; | ||
| 516 | if (status0 & BAT_S0_DISCHARGE) | ||
| 517 | return POWER_SUPPLY_STATUS_DISCHARGING; | ||
| 518 | if (status1 & BAT_S1_FULL) | ||
| 519 | return POWER_SUPPLY_STATUS_FULL; | ||
| 520 | return POWER_SUPPLY_STATUS_NOT_CHARGING; | ||
| 521 | } | ||
| 522 | |||
| 523 | static int bat_health(void) | ||
| 161 | { | 524 | { |
| 162 | return get_lcd_level(); | 525 | u8 status = ec_read_u8(BAT_STOP_CHARGE1); |
| 526 | |||
| 527 | if (status & BAT_STOP_CHRG1_OVERTEMPERATURE) | ||
| 528 | return POWER_SUPPLY_HEALTH_OVERHEAT; | ||
| 529 | if (status & BAT_STOP_CHRG1_OVERVOLTAGE) | ||
| 530 | return POWER_SUPPLY_HEALTH_OVERVOLTAGE; | ||
| 531 | if (status & BAT_STOP_CHRG1_BAD_CELL) | ||
| 532 | return POWER_SUPPLY_HEALTH_DEAD; | ||
| 533 | if (status & BAT_STOP_CHRG1_COMM_FAIL) | ||
| 534 | return POWER_SUPPLY_HEALTH_UNKNOWN; | ||
| 535 | return POWER_SUPPLY_HEALTH_GOOD; | ||
| 163 | } | 536 | } |
| 164 | 537 | ||
| 538 | static int bat_is_present(void) | ||
| 539 | { | ||
| 540 | u8 status = ec_read_u8(BAT_STATUS2); | ||
| 541 | return ((status & BAT_S1_EXISTS) != 0); | ||
| 542 | } | ||
| 165 | 543 | ||
| 166 | static int bl_update_status(struct backlight_device *b) | 544 | static int bat_technology(void) |
| 167 | { | 545 | { |
| 168 | return set_lcd_level(b->props.brightness); | 546 | u8 status = ec_read_u8(BAT_STATUS1); |
| 547 | |||
| 548 | if (status & BAT_S1_LiION_OR_NiMH) | ||
| 549 | return POWER_SUPPLY_TECHNOLOGY_LION; | ||
| 550 | return POWER_SUPPLY_TECHNOLOGY_NiMH; | ||
| 169 | } | 551 | } |
| 170 | 552 | ||
| 171 | static struct backlight_ops compalbl_ops = { | 553 | static int bat_capacity_level(void) |
| 172 | .get_brightness = bl_get_brightness, | 554 | { |
| 173 | .update_status = bl_update_status, | 555 | u8 status0 = ec_read_u8(BAT_STATUS0); |
| 174 | }; | 556 | u8 status1 = ec_read_u8(BAT_STATUS1); |
| 557 | u8 status2 = ec_read_u8(BAT_STATUS2); | ||
| 558 | |||
| 559 | if (status0 & BAT_S0_DISCHRG_CRITICAL | ||
| 560 | || status1 & BAT_S1_EMPTY | ||
| 561 | || status2 & BAT_S2_LOW_LOW) | ||
| 562 | return POWER_SUPPLY_CAPACITY_LEVEL_CRITICAL; | ||
| 563 | if (status0 & BAT_S0_LOW) | ||
| 564 | return POWER_SUPPLY_CAPACITY_LEVEL_LOW; | ||
| 565 | if (status1 & BAT_S1_FULL) | ||
| 566 | return POWER_SUPPLY_CAPACITY_LEVEL_FULL; | ||
| 567 | return POWER_SUPPLY_CAPACITY_LEVEL_NORMAL; | ||
| 568 | } | ||
| 569 | |||
| 570 | static int bat_get_property(struct power_supply *psy, | ||
| 571 | enum power_supply_property psp, | ||
| 572 | union power_supply_propval *val) | ||
| 573 | { | ||
| 574 | struct compal_data *data; | ||
| 575 | data = container_of(psy, struct compal_data, psy); | ||
| 576 | |||
| 577 | switch (psp) { | ||
| 578 | case POWER_SUPPLY_PROP_STATUS: | ||
| 579 | val->intval = bat_status(); | ||
| 580 | break; | ||
| 581 | case POWER_SUPPLY_PROP_HEALTH: | ||
| 582 | val->intval = bat_health(); | ||
| 583 | break; | ||
| 584 | case POWER_SUPPLY_PROP_PRESENT: | ||
| 585 | val->intval = bat_is_present(); | ||
| 586 | break; | ||
| 587 | case POWER_SUPPLY_PROP_TECHNOLOGY: | ||
| 588 | val->intval = bat_technology(); | ||
| 589 | break; | ||
| 590 | case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN: /* THE design voltage... */ | ||
| 591 | val->intval = ec_read_u16(BAT_VOLTAGE_DESIGN) * 1000; | ||
| 592 | break; | ||
| 593 | case POWER_SUPPLY_PROP_VOLTAGE_NOW: | ||
| 594 | val->intval = ec_read_u16(BAT_VOLTAGE_NOW) * 1000; | ||
| 595 | break; | ||
| 596 | case POWER_SUPPLY_PROP_CURRENT_NOW: | ||
| 597 | val->intval = ec_read_s16(BAT_CURRENT_NOW) * 1000; | ||
| 598 | break; | ||
| 599 | case POWER_SUPPLY_PROP_CURRENT_AVG: | ||
| 600 | val->intval = ec_read_s16(BAT_CURRENT_AVG) * 1000; | ||
| 601 | break; | ||
| 602 | case POWER_SUPPLY_PROP_POWER_NOW: | ||
| 603 | val->intval = ec_read_u8(BAT_POWER) * 1000000; | ||
| 604 | break; | ||
| 605 | case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN: | ||
| 606 | val->intval = ec_read_u16(BAT_CHARGE_DESIGN) * 1000; | ||
| 607 | break; | ||
| 608 | case POWER_SUPPLY_PROP_CHARGE_NOW: | ||
| 609 | val->intval = ec_read_u16(BAT_CHARGE_NOW) * 1000; | ||
| 610 | break; | ||
| 611 | case POWER_SUPPLY_PROP_CAPACITY: | ||
| 612 | val->intval = ec_read_u8(BAT_CAPACITY); | ||
| 613 | break; | ||
| 614 | case POWER_SUPPLY_PROP_CAPACITY_LEVEL: | ||
| 615 | val->intval = bat_capacity_level(); | ||
| 616 | break; | ||
| 617 | /* It smees that BAT_TEMP_AVG is a (2's complement?) value showing | ||
| 618 | * the number of degrees, whereas BAT_TEMP is somewhat more | ||
| 619 | * complicated. It looks like this is a negative nember with a | ||
| 620 | * 100/256 divider and an offset of 222. Both were determined | ||
| 621 | * experimentally by comparing BAT_TEMP and BAT_TEMP_AVG. */ | ||
| 622 | case POWER_SUPPLY_PROP_TEMP: | ||
| 623 | val->intval = ((222 - (int)ec_read_u8(BAT_TEMP)) * 1000) >> 8; | ||
| 624 | break; | ||
| 625 | case POWER_SUPPLY_PROP_TEMP_AMBIENT: /* Ambient, Avg, ... same thing */ | ||
| 626 | val->intval = ec_read_s8(BAT_TEMP_AVG) * 10; | ||
| 627 | break; | ||
| 628 | /* Neither the model name nor manufacturer name work for me. */ | ||
| 629 | case POWER_SUPPLY_PROP_MODEL_NAME: | ||
| 630 | val->strval = data->bat_model_name; | ||
| 631 | break; | ||
| 632 | case POWER_SUPPLY_PROP_MANUFACTURER: | ||
| 633 | val->strval = data->bat_manufacturer_name; | ||
| 634 | break; | ||
| 635 | case POWER_SUPPLY_PROP_SERIAL_NUMBER: | ||
| 636 | val->strval = data->bat_serial_number; | ||
| 637 | break; | ||
| 638 | default: | ||
| 639 | break; | ||
| 640 | } | ||
| 641 | return 0; | ||
| 642 | } | ||
| 175 | 643 | ||
| 176 | static struct backlight_device *compalbl_device; | ||
| 177 | 644 | ||
| 178 | 645 | ||
| 646 | |||
| 647 | |||
| 648 | /* ============== */ | ||
| 649 | /* Driver Globals */ | ||
| 650 | /* ============== */ | ||
| 651 | static DEVICE_ATTR(wake_up_pme, | ||
| 652 | 0644, wake_up_pme_show, wake_up_pme_store); | ||
| 653 | static DEVICE_ATTR(wake_up_modem, | ||
| 654 | 0644, wake_up_modem_show, wake_up_modem_store); | ||
| 655 | static DEVICE_ATTR(wake_up_lan, | ||
| 656 | 0644, wake_up_lan_show, wake_up_lan_store); | ||
| 657 | static DEVICE_ATTR(wake_up_wlan, | ||
| 658 | 0644, wake_up_wlan_show, wake_up_wlan_store); | ||
| 659 | static DEVICE_ATTR(wake_up_key, | ||
| 660 | 0644, wake_up_key_show, wake_up_key_store); | ||
| 661 | static DEVICE_ATTR(wake_up_mouse, | ||
| 662 | 0644, wake_up_mouse_show, wake_up_mouse_store); | ||
| 663 | |||
| 664 | static SENSOR_DEVICE_ATTR(name, S_IRUGO, hwmon_name_show, NULL, 1); | ||
| 665 | static SENSOR_DEVICE_ATTR(fan1_input, S_IRUGO, fan_show, NULL, 1); | ||
| 666 | static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, temp_cpu, NULL, 1); | ||
| 667 | static SENSOR_DEVICE_ATTR(temp2_input, S_IRUGO, temp_cpu_local, NULL, 1); | ||
| 668 | static SENSOR_DEVICE_ATTR(temp3_input, S_IRUGO, temp_cpu_DTS, NULL, 1); | ||
| 669 | static SENSOR_DEVICE_ATTR(temp4_input, S_IRUGO, temp_northbridge, NULL, 1); | ||
| 670 | static SENSOR_DEVICE_ATTR(temp5_input, S_IRUGO, temp_vga, NULL, 1); | ||
| 671 | static SENSOR_DEVICE_ATTR(temp6_input, S_IRUGO, temp_SKIN, NULL, 1); | ||
| 672 | static SENSOR_DEVICE_ATTR(temp1_label, S_IRUGO, label_cpu, NULL, 1); | ||
| 673 | static SENSOR_DEVICE_ATTR(temp2_label, S_IRUGO, label_cpu_local, NULL, 1); | ||
| 674 | static SENSOR_DEVICE_ATTR(temp3_label, S_IRUGO, label_cpu_DTS, NULL, 1); | ||
| 675 | static SENSOR_DEVICE_ATTR(temp4_label, S_IRUGO, label_northbridge, NULL, 1); | ||
| 676 | static SENSOR_DEVICE_ATTR(temp5_label, S_IRUGO, label_vga, NULL, 1); | ||
| 677 | static SENSOR_DEVICE_ATTR(temp6_label, S_IRUGO, label_SKIN, NULL, 1); | ||
| 678 | static SENSOR_DEVICE_ATTR(pwm1, S_IRUGO | S_IWUSR, pwm_show, pwm_store, 1); | ||
| 679 | static SENSOR_DEVICE_ATTR(pwm1_enable, | ||
| 680 | S_IRUGO | S_IWUSR, pwm_enable_show, pwm_enable_store, 0); | ||
| 681 | |||
| 682 | static struct attribute *compal_attributes[] = { | ||
| 683 | &dev_attr_wake_up_pme.attr, | ||
| 684 | &dev_attr_wake_up_modem.attr, | ||
| 685 | &dev_attr_wake_up_lan.attr, | ||
| 686 | &dev_attr_wake_up_wlan.attr, | ||
| 687 | &dev_attr_wake_up_key.attr, | ||
| 688 | &dev_attr_wake_up_mouse.attr, | ||
| 689 | /* Maybe put the sensor-stuff in a separate hwmon-driver? That way, | ||
| 690 | * the hwmon sysfs won't be cluttered with the above files. */ | ||
| 691 | &sensor_dev_attr_name.dev_attr.attr, | ||
| 692 | &sensor_dev_attr_pwm1_enable.dev_attr.attr, | ||
| 693 | &sensor_dev_attr_pwm1.dev_attr.attr, | ||
| 694 | &sensor_dev_attr_fan1_input.dev_attr.attr, | ||
| 695 | &sensor_dev_attr_temp1_input.dev_attr.attr, | ||
| 696 | &sensor_dev_attr_temp2_input.dev_attr.attr, | ||
| 697 | &sensor_dev_attr_temp3_input.dev_attr.attr, | ||
| 698 | &sensor_dev_attr_temp4_input.dev_attr.attr, | ||
| 699 | &sensor_dev_attr_temp5_input.dev_attr.attr, | ||
| 700 | &sensor_dev_attr_temp6_input.dev_attr.attr, | ||
| 701 | &sensor_dev_attr_temp1_label.dev_attr.attr, | ||
| 702 | &sensor_dev_attr_temp2_label.dev_attr.attr, | ||
| 703 | &sensor_dev_attr_temp3_label.dev_attr.attr, | ||
| 704 | &sensor_dev_attr_temp4_label.dev_attr.attr, | ||
| 705 | &sensor_dev_attr_temp5_label.dev_attr.attr, | ||
| 706 | &sensor_dev_attr_temp6_label.dev_attr.attr, | ||
| 707 | NULL | ||
| 708 | }; | ||
| 709 | |||
| 710 | static struct attribute_group compal_attribute_group = { | ||
| 711 | .attrs = compal_attributes | ||
| 712 | }; | ||
| 713 | |||
| 714 | static int __devinit compal_probe(struct platform_device *); | ||
| 715 | static int __devexit compal_remove(struct platform_device *); | ||
| 179 | static struct platform_driver compal_driver = { | 716 | static struct platform_driver compal_driver = { |
| 180 | .driver = { | 717 | .driver = { |
| 181 | .name = "compal-laptop", | 718 | .name = DRIVER_NAME, |
| 182 | .owner = THIS_MODULE, | 719 | .owner = THIS_MODULE, |
| 183 | } | 720 | }, |
| 721 | .probe = compal_probe, | ||
| 722 | .remove = __devexit_p(compal_remove) | ||
| 184 | }; | 723 | }; |
| 185 | 724 | ||
| 186 | /* Initialization */ | 725 | static enum power_supply_property compal_bat_properties[] = { |
| 726 | POWER_SUPPLY_PROP_STATUS, | ||
| 727 | POWER_SUPPLY_PROP_HEALTH, | ||
| 728 | POWER_SUPPLY_PROP_PRESENT, | ||
| 729 | POWER_SUPPLY_PROP_TECHNOLOGY, | ||
| 730 | POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN, | ||
| 731 | POWER_SUPPLY_PROP_VOLTAGE_NOW, | ||
| 732 | POWER_SUPPLY_PROP_CURRENT_NOW, | ||
| 733 | POWER_SUPPLY_PROP_CURRENT_AVG, | ||
| 734 | POWER_SUPPLY_PROP_POWER_NOW, | ||
| 735 | POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN, | ||
| 736 | POWER_SUPPLY_PROP_CHARGE_NOW, | ||
| 737 | POWER_SUPPLY_PROP_CAPACITY, | ||
| 738 | POWER_SUPPLY_PROP_CAPACITY_LEVEL, | ||
| 739 | POWER_SUPPLY_PROP_TEMP, | ||
| 740 | POWER_SUPPLY_PROP_TEMP_AMBIENT, | ||
| 741 | POWER_SUPPLY_PROP_MODEL_NAME, | ||
| 742 | POWER_SUPPLY_PROP_MANUFACTURER, | ||
| 743 | POWER_SUPPLY_PROP_SERIAL_NUMBER, | ||
| 744 | }; | ||
| 745 | |||
| 746 | static struct backlight_device *compalbl_device; | ||
| 747 | |||
| 748 | static struct platform_device *compal_device; | ||
| 749 | |||
| 750 | static struct rfkill *wifi_rfkill; | ||
| 751 | static struct rfkill *bt_rfkill; | ||
| 752 | |||
| 753 | |||
| 754 | |||
| 755 | |||
| 756 | |||
| 757 | /* =================================== */ | ||
| 758 | /* Initialization & clean-up functions */ | ||
| 759 | /* =================================== */ | ||
| 187 | 760 | ||
| 188 | static int dmi_check_cb(const struct dmi_system_id *id) | 761 | static int dmi_check_cb(const struct dmi_system_id *id) |
| 189 | { | 762 | { |
| 190 | printk(KERN_INFO "compal-laptop: Identified laptop model '%s'.\n", | 763 | printk(KERN_INFO DRIVER_NAME": Identified laptop model '%s'\n", |
| 191 | id->ident); | 764 | id->ident); |
| 765 | extra_features = false; | ||
| 766 | return 0; | ||
| 767 | } | ||
| 192 | 768 | ||
| 769 | static int dmi_check_cb_extra(const struct dmi_system_id *id) | ||
| 770 | { | ||
| 771 | printk(KERN_INFO DRIVER_NAME": Identified laptop model '%s', " | ||
| 772 | "enabling extra features\n", | ||
| 773 | id->ident); | ||
| 774 | extra_features = true; | ||
| 193 | return 0; | 775 | return 0; |
| 194 | } | 776 | } |
| 195 | 777 | ||
| @@ -274,27 +856,106 @@ static struct dmi_system_id __initdata compal_dmi_table[] = { | |||
| 274 | }, | 856 | }, |
| 275 | .callback = dmi_check_cb | 857 | .callback = dmi_check_cb |
| 276 | }, | 858 | }, |
| 277 | 859 | { | |
| 860 | .ident = "JHL90", | ||
| 861 | .matches = { | ||
| 862 | DMI_MATCH(DMI_BOARD_NAME, "JHL90"), | ||
| 863 | DMI_MATCH(DMI_BOARD_VERSION, "REFERENCE"), | ||
| 864 | }, | ||
| 865 | .callback = dmi_check_cb_extra | ||
| 866 | }, | ||
| 278 | { } | 867 | { } |
| 279 | }; | 868 | }; |
| 280 | 869 | ||
| 870 | static void initialize_power_supply_data(struct compal_data *data) | ||
| 871 | { | ||
| 872 | data->psy.name = DRIVER_NAME; | ||
| 873 | data->psy.type = POWER_SUPPLY_TYPE_BATTERY; | ||
| 874 | data->psy.properties = compal_bat_properties; | ||
| 875 | data->psy.num_properties = ARRAY_SIZE(compal_bat_properties); | ||
| 876 | data->psy.get_property = bat_get_property; | ||
| 877 | |||
| 878 | ec_read_sequence(BAT_MANUFACTURER_NAME_ADDR, | ||
| 879 | data->bat_manufacturer_name, | ||
| 880 | BAT_MANUFACTURER_NAME_LEN); | ||
| 881 | data->bat_manufacturer_name[BAT_MANUFACTURER_NAME_LEN] = 0; | ||
| 882 | |||
| 883 | ec_read_sequence(BAT_MODEL_NAME_ADDR, | ||
| 884 | data->bat_model_name, | ||
| 885 | BAT_MODEL_NAME_LEN); | ||
| 886 | data->bat_model_name[BAT_MODEL_NAME_LEN] = 0; | ||
| 887 | |||
| 888 | scnprintf(data->bat_serial_number, BAT_SERIAL_NUMBER_LEN + 1, "%d", | ||
| 889 | ec_read_u16(BAT_SERIAL_NUMBER_ADDR)); | ||
| 890 | } | ||
| 891 | |||
| 892 | static void initialize_fan_control_data(struct compal_data *data) | ||
| 893 | { | ||
| 894 | data->pwm_enable = 2; /* Keep motherboard in control for now */ | ||
| 895 | data->curr_pwm = 255; /* Try not to cause a CPU_on_fire exception | ||
| 896 | if we take over... */ | ||
| 897 | } | ||
| 898 | |||
| 899 | static int setup_rfkill(void) | ||
| 900 | { | ||
| 901 | int ret; | ||
| 902 | |||
| 903 | wifi_rfkill = rfkill_alloc("compal-wifi", &compal_device->dev, | ||
| 904 | RFKILL_TYPE_WLAN, &compal_rfkill_ops, | ||
| 905 | (void *) WIRELESS_WLAN); | ||
| 906 | if (!wifi_rfkill) | ||
| 907 | return -ENOMEM; | ||
| 908 | |||
| 909 | ret = rfkill_register(wifi_rfkill); | ||
| 910 | if (ret) | ||
| 911 | goto err_wifi; | ||
| 912 | |||
| 913 | bt_rfkill = rfkill_alloc("compal-bluetooth", &compal_device->dev, | ||
| 914 | RFKILL_TYPE_BLUETOOTH, &compal_rfkill_ops, | ||
| 915 | (void *) WIRELESS_BT); | ||
| 916 | if (!bt_rfkill) { | ||
| 917 | ret = -ENOMEM; | ||
| 918 | goto err_allocate_bt; | ||
| 919 | } | ||
| 920 | ret = rfkill_register(bt_rfkill); | ||
| 921 | if (ret) | ||
| 922 | goto err_register_bt; | ||
| 923 | |||
| 924 | return 0; | ||
| 925 | |||
| 926 | err_register_bt: | ||
| 927 | rfkill_destroy(bt_rfkill); | ||
| 928 | |||
| 929 | err_allocate_bt: | ||
| 930 | rfkill_unregister(wifi_rfkill); | ||
| 931 | |||
| 932 | err_wifi: | ||
| 933 | rfkill_destroy(wifi_rfkill); | ||
| 934 | |||
| 935 | return ret; | ||
| 936 | } | ||
| 937 | |||
| 281 | static int __init compal_init(void) | 938 | static int __init compal_init(void) |
| 282 | { | 939 | { |
| 283 | int ret; | 940 | int ret; |
| 284 | 941 | ||
| 285 | if (acpi_disabled) | 942 | if (acpi_disabled) { |
| 943 | printk(KERN_ERR DRIVER_NAME": ACPI needs to be enabled for " | ||
| 944 | "this driver to work!\n"); | ||
| 286 | return -ENODEV; | 945 | return -ENODEV; |
| 946 | } | ||
| 287 | 947 | ||
| 288 | if (!force && !dmi_check_system(compal_dmi_table)) | 948 | if (!force && !dmi_check_system(compal_dmi_table)) { |
| 949 | printk(KERN_ERR DRIVER_NAME": Motherboard not recognized (You " | ||
| 950 | "could try the module's force-parameter)"); | ||
| 289 | return -ENODEV; | 951 | return -ENODEV; |
| 290 | 952 | } | |
| 291 | /* Register backlight stuff */ | ||
| 292 | 953 | ||
| 293 | if (!acpi_video_backlight_support()) { | 954 | if (!acpi_video_backlight_support()) { |
| 294 | struct backlight_properties props; | 955 | struct backlight_properties props; |
| 295 | memset(&props, 0, sizeof(struct backlight_properties)); | 956 | memset(&props, 0, sizeof(struct backlight_properties)); |
| 296 | props.max_brightness = COMPAL_LCD_LEVEL_MAX - 1; | 957 | props.max_brightness = BACKLIGHT_LEVEL_MAX; |
| 297 | compalbl_device = backlight_device_register("compal-laptop", | 958 | compalbl_device = backlight_device_register(DRIVER_NAME, |
| 298 | NULL, NULL, | 959 | NULL, NULL, |
| 299 | &compalbl_ops, | 960 | &compalbl_ops, |
| 300 | &props); | 961 | &props); |
| @@ -304,67 +965,122 @@ static int __init compal_init(void) | |||
| 304 | 965 | ||
| 305 | ret = platform_driver_register(&compal_driver); | 966 | ret = platform_driver_register(&compal_driver); |
| 306 | if (ret) | 967 | if (ret) |
| 307 | goto fail_backlight; | 968 | goto err_backlight; |
| 308 | 969 | ||
| 309 | /* Register platform stuff */ | 970 | compal_device = platform_device_alloc(DRIVER_NAME, -1); |
| 310 | |||
| 311 | compal_device = platform_device_alloc("compal-laptop", -1); | ||
| 312 | if (!compal_device) { | 971 | if (!compal_device) { |
| 313 | ret = -ENOMEM; | 972 | ret = -ENOMEM; |
| 314 | goto fail_platform_driver; | 973 | goto err_platform_driver; |
| 315 | } | 974 | } |
| 316 | 975 | ||
| 317 | ret = platform_device_add(compal_device); | 976 | ret = platform_device_add(compal_device); /* This calls compal_probe */ |
| 318 | if (ret) | 977 | if (ret) |
| 319 | goto fail_platform_device; | 978 | goto err_platform_device; |
| 320 | 979 | ||
| 321 | ret = setup_rfkill(); | 980 | ret = setup_rfkill(); |
| 322 | if (ret) | 981 | if (ret) |
| 323 | goto fail_rfkill; | 982 | goto err_rfkill; |
| 324 | |||
| 325 | printk(KERN_INFO "compal-laptop: driver "COMPAL_DRIVER_VERSION | ||
| 326 | " successfully loaded.\n"); | ||
| 327 | 983 | ||
| 984 | printk(KERN_INFO DRIVER_NAME": Driver "DRIVER_VERSION | ||
| 985 | " successfully loaded\n"); | ||
| 328 | return 0; | 986 | return 0; |
| 329 | 987 | ||
| 330 | fail_rfkill: | 988 | err_rfkill: |
| 331 | platform_device_del(compal_device); | 989 | platform_device_del(compal_device); |
| 332 | 990 | ||
| 333 | fail_platform_device: | 991 | err_platform_device: |
| 334 | |||
| 335 | platform_device_put(compal_device); | 992 | platform_device_put(compal_device); |
| 336 | 993 | ||
| 337 | fail_platform_driver: | 994 | err_platform_driver: |
| 338 | |||
| 339 | platform_driver_unregister(&compal_driver); | 995 | platform_driver_unregister(&compal_driver); |
| 340 | 996 | ||
| 341 | fail_backlight: | 997 | err_backlight: |
| 342 | |||
| 343 | backlight_device_unregister(compalbl_device); | 998 | backlight_device_unregister(compalbl_device); |
| 344 | 999 | ||
| 345 | return ret; | 1000 | return ret; |
| 346 | } | 1001 | } |
| 347 | 1002 | ||
| 348 | static void __exit compal_cleanup(void) | 1003 | static int __devinit compal_probe(struct platform_device *pdev) |
| 349 | { | 1004 | { |
| 1005 | int err; | ||
| 1006 | struct compal_data *data; | ||
| 1007 | |||
| 1008 | if (!extra_features) | ||
| 1009 | return 0; | ||
| 1010 | |||
| 1011 | /* Fan control */ | ||
| 1012 | data = kzalloc(sizeof(struct compal_data), GFP_KERNEL); | ||
| 1013 | if (!data) | ||
| 1014 | return -ENOMEM; | ||
| 1015 | |||
| 1016 | initialize_fan_control_data(data); | ||
| 1017 | |||
| 1018 | err = sysfs_create_group(&pdev->dev.kobj, &compal_attribute_group); | ||
| 1019 | if (err) | ||
| 1020 | return err; | ||
| 1021 | |||
| 1022 | data->hwmon_dev = hwmon_device_register(&pdev->dev); | ||
| 1023 | if (IS_ERR(data->hwmon_dev)) { | ||
| 1024 | err = PTR_ERR(data->hwmon_dev); | ||
| 1025 | sysfs_remove_group(&pdev->dev.kobj, | ||
| 1026 | &compal_attribute_group); | ||
| 1027 | kfree(data); | ||
| 1028 | return err; | ||
| 1029 | } | ||
| 1030 | |||
| 1031 | /* Power supply */ | ||
| 1032 | initialize_power_supply_data(data); | ||
| 1033 | power_supply_register(&compal_device->dev, &data->psy); | ||
| 1034 | |||
| 1035 | platform_set_drvdata(pdev, data); | ||
| 1036 | |||
| 1037 | return 0; | ||
| 1038 | } | ||
| 350 | 1039 | ||
| 1040 | static void __exit compal_cleanup(void) | ||
| 1041 | { | ||
| 351 | platform_device_unregister(compal_device); | 1042 | platform_device_unregister(compal_device); |
| 352 | platform_driver_unregister(&compal_driver); | 1043 | platform_driver_unregister(&compal_driver); |
| 353 | backlight_device_unregister(compalbl_device); | 1044 | backlight_device_unregister(compalbl_device); |
| 354 | rfkill_unregister(wifi_rfkill); | 1045 | rfkill_unregister(wifi_rfkill); |
| 355 | rfkill_destroy(wifi_rfkill); | ||
| 356 | rfkill_unregister(bt_rfkill); | 1046 | rfkill_unregister(bt_rfkill); |
| 1047 | rfkill_destroy(wifi_rfkill); | ||
| 357 | rfkill_destroy(bt_rfkill); | 1048 | rfkill_destroy(bt_rfkill); |
| 358 | 1049 | ||
| 359 | printk(KERN_INFO "compal-laptop: driver unloaded.\n"); | 1050 | printk(KERN_INFO DRIVER_NAME": Driver unloaded\n"); |
| 360 | } | 1051 | } |
| 361 | 1052 | ||
| 1053 | static int __devexit compal_remove(struct platform_device *pdev) | ||
| 1054 | { | ||
| 1055 | struct compal_data *data; | ||
| 1056 | |||
| 1057 | if (!extra_features) | ||
| 1058 | return 0; | ||
| 1059 | |||
| 1060 | printk(KERN_INFO DRIVER_NAME": Unloading: resetting fan control " | ||
| 1061 | "to motherboard\n"); | ||
| 1062 | pwm_disable_control(); | ||
| 1063 | |||
| 1064 | data = platform_get_drvdata(pdev); | ||
| 1065 | hwmon_device_unregister(data->hwmon_dev); | ||
| 1066 | power_supply_unregister(&data->psy); | ||
| 1067 | |||
| 1068 | platform_set_drvdata(pdev, NULL); | ||
| 1069 | kfree(data); | ||
| 1070 | |||
| 1071 | sysfs_remove_group(&pdev->dev.kobj, &compal_attribute_group); | ||
| 1072 | |||
| 1073 | return 0; | ||
| 1074 | } | ||
| 1075 | |||
| 1076 | |||
| 362 | module_init(compal_init); | 1077 | module_init(compal_init); |
| 363 | module_exit(compal_cleanup); | 1078 | module_exit(compal_cleanup); |
| 364 | 1079 | ||
| 365 | MODULE_AUTHOR("Cezary Jackiewicz"); | 1080 | MODULE_AUTHOR("Cezary Jackiewicz"); |
| 1081 | MODULE_AUTHOR("Roald Frederickx (roald.frederickx@gmail.com)"); | ||
| 366 | MODULE_DESCRIPTION("Compal Laptop Support"); | 1082 | MODULE_DESCRIPTION("Compal Laptop Support"); |
| 367 | MODULE_VERSION(COMPAL_DRIVER_VERSION); | 1083 | MODULE_VERSION(DRIVER_VERSION); |
| 368 | MODULE_LICENSE("GPL"); | 1084 | MODULE_LICENSE("GPL"); |
| 369 | 1085 | ||
| 370 | MODULE_ALIAS("dmi:*:rnIFL90:rvrIFT00:*"); | 1086 | MODULE_ALIAS("dmi:*:rnIFL90:rvrIFT00:*"); |
| @@ -372,6 +1088,7 @@ MODULE_ALIAS("dmi:*:rnIFL90:rvrREFERENCE:*"); | |||
| 372 | MODULE_ALIAS("dmi:*:rnIFL91:rvrIFT00:*"); | 1088 | MODULE_ALIAS("dmi:*:rnIFL91:rvrIFT00:*"); |
| 373 | MODULE_ALIAS("dmi:*:rnJFL92:rvrIFT00:*"); | 1089 | MODULE_ALIAS("dmi:*:rnJFL92:rvrIFT00:*"); |
| 374 | MODULE_ALIAS("dmi:*:rnIFT00:rvrIFT00:*"); | 1090 | MODULE_ALIAS("dmi:*:rnIFT00:rvrIFT00:*"); |
| 1091 | MODULE_ALIAS("dmi:*:rnJHL90:rvrREFERENCE:*"); | ||
| 375 | MODULE_ALIAS("dmi:*:svnDellInc.:pnInspiron910:*"); | 1092 | MODULE_ALIAS("dmi:*:svnDellInc.:pnInspiron910:*"); |
| 376 | MODULE_ALIAS("dmi:*:svnDellInc.:pnInspiron1010:*"); | 1093 | MODULE_ALIAS("dmi:*:svnDellInc.:pnInspiron1010:*"); |
| 377 | MODULE_ALIAS("dmi:*:svnDellInc.:pnInspiron1011:*"); | 1094 | MODULE_ALIAS("dmi:*:svnDellInc.:pnInspiron1011:*"); |
