bb73687514
* Add new CIG device CS6436-54P and CS5435-54P, also update code for CS6436-56P * security kernel update to 4.9.189 for CIG devices * security kernel update to 4.9.189 for CIG devices * Update rules Update rule file
595 lines
18 KiB
C
595 lines
18 KiB
C
/*
|
|
* A hwmon driver for the CIG cs6436-56P LED
|
|
*
|
|
* Copyright (C) 2018 Cambridge, Inc.
|
|
|
|
*
|
|
* 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., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
*/
|
|
|
|
/*#define DEBUG*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/init.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/err.h>
|
|
#include <linux/leds.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/dmi.h>
|
|
|
|
extern int cig_cpld_write_register(u8 reg_off, u8 val);
|
|
|
|
extern int cig_cpld_read_register(u8 reg_off, u8 *val);
|
|
|
|
extern void led_classdev_unregister(struct led_classdev *led_cdev);
|
|
extern int led_classdev_register(struct device *parent, struct led_classdev *led_cdev);
|
|
extern void led_classdev_resume(struct led_classdev *led_cdev);
|
|
extern void led_classdev_suspend(struct led_classdev *led_cdev);
|
|
|
|
#define DRVNAME "cs6436_56p_led"
|
|
|
|
struct cs6436_56p_led_data {
|
|
struct platform_device *pdev;
|
|
struct mutex update_lock;
|
|
char valid; /* != 0 if registers are valid */
|
|
unsigned long last_updated; /* In jiffies */
|
|
u8 reg_val[6]; /* 0: system & location
|
|
1: PSU1 &PSU12
|
|
2: fan & management
|
|
3: console & ToD
|
|
4-5 : fan1-fan5*/
|
|
};
|
|
|
|
static struct cs6436_56p_led_data *ledctl = NULL;
|
|
|
|
/* LED related data
|
|
*/
|
|
#define LED_TYPE_PSU1_REG_MASK 0x0C
|
|
#define LED_MODE_PSU1_GREEN_MASK 0x08
|
|
#define LED_MODE_PSU1_RED_MASK 0x04
|
|
#define LED_MODE_PSU1_AMBER_MASK 0x0C
|
|
#define LED_MODE_PSU1_OFF_MASK 0x00
|
|
|
|
#define LED_TYPE_PSU2_REG_MASK 0x30
|
|
#define LED_MODE_PSU2_GREEN_MASK 0x20
|
|
#define LED_MODE_PSU2_RED_MASK 0x10
|
|
#define LED_MODE_PSU2_AMBER_MASK 0x30
|
|
#define LED_MODE_PSU2_OFF_MASK 0x00
|
|
|
|
#define LED_TYPE_SYS_REG_MASK 0xF0
|
|
#define LED_MODE_SYS_GREEN_MASK 0x40
|
|
#define LED_MODE_SYS_RED_MASK 0x20
|
|
#define LED_MODE_SYS_AMBER_MASK 0x60
|
|
#define LED_MODE_SYS_AMBER_FLASHING_MASK 0x70
|
|
#define LED_MODE_SYS_OFF_MASK 0x00
|
|
|
|
#define LED_TYPE_RES_REG_MASK 0x0F
|
|
#define LED_MODE_RES_GREEN_MASK 0x04
|
|
#define LED_MODE_RES_RED_MASK 0x02
|
|
#define LED_MODE_RES_AMBER_MASK 0x06
|
|
#define LED_MODE_RES_AMBER_FLASHING_MASK 0x07
|
|
#define LED_MODE_RES_OFF_MASK 0x00
|
|
|
|
#define LED_TYPE_FAN_REG_MASK 0x03
|
|
#define LED_MODE_FAN_GREEN_MASK 0x02
|
|
#define LED_MODE_FAN_RED_MASK 0x01
|
|
#define LED_MODE_FAN_AMBER_MASK 0x03
|
|
#define LED_MODE_FAN_OFF_MASK 0x00
|
|
|
|
#define LED_TYPE_FAN1_REG_MASK 0x03
|
|
#define LED_TYPE_FAN2_REG_MASK 0x0C
|
|
#define LED_TYPE_FAN3_REG_MASK 0x30
|
|
#define LED_TYPE_FAN4_REG_MASK 0xC0
|
|
#define LED_TYPE_FAN5_REG_MASK 0x03
|
|
|
|
#define LED_MODE_FANX_GREEN_MASK 0x02
|
|
#define LED_MODE_FANX_RED_MASK 0x01
|
|
#define LED_MODE_FANX_AMBER_MASK 0x03
|
|
#define LED_MODE_FANX_OFF_MASK 0x00
|
|
|
|
enum led_type {
|
|
LED_TYPE_SYS,
|
|
LED_TYPE_PSU2,
|
|
LED_TYPE_PSU1,
|
|
LED_TYPE_FAN,
|
|
LED_TYPE_FAN1,
|
|
LED_TYPE_FAN2,
|
|
LED_TYPE_FAN3,
|
|
LED_TYPE_FAN4,
|
|
LED_TYPE_FAN5,
|
|
};
|
|
|
|
static const u8 led_reg[] = {
|
|
0x30, /* system & reserved*/
|
|
0x31, /* fan & PSU1 & PSU2 */
|
|
0x32, /* FAN5 LED */
|
|
0x33, /* FAN1-4 LED */
|
|
};
|
|
|
|
|
|
enum led_light_mode {
|
|
LED_MODE_OFF = 0,
|
|
LED_MODE_GREEN,
|
|
LED_MODE_AMBER,
|
|
LED_MODE_RED,
|
|
LED_MODE_GREEN_BLINK,
|
|
LED_MODE_AMBER_BLINK,
|
|
LED_MODE_RED_BLINK,
|
|
LED_MODE_GREEN_FLASHING,
|
|
LED_MODE_AMBER_FLASHING,
|
|
LED_MODE_RED_FLASHING,
|
|
LED_MODE_AUTO,
|
|
LED_MODE_UNKNOWN
|
|
};
|
|
|
|
struct led_type_mode {
|
|
enum led_type type;
|
|
int type_mask;
|
|
enum led_light_mode mode;
|
|
int mode_mask;
|
|
};
|
|
|
|
static struct led_type_mode led_type_mode_data[] = {
|
|
{LED_TYPE_PSU1, LED_TYPE_PSU1_REG_MASK, LED_MODE_GREEN, LED_MODE_PSU1_GREEN_MASK},
|
|
{LED_TYPE_PSU1, LED_TYPE_PSU1_REG_MASK, LED_MODE_AMBER, LED_MODE_PSU1_AMBER_MASK},
|
|
{LED_TYPE_PSU1, LED_TYPE_PSU1_REG_MASK, LED_MODE_RED, LED_MODE_PSU1_RED_MASK},
|
|
{LED_TYPE_PSU1, LED_TYPE_PSU1_REG_MASK, LED_MODE_OFF, LED_MODE_PSU1_OFF_MASK},
|
|
|
|
{LED_TYPE_PSU2, LED_TYPE_PSU2_REG_MASK, LED_MODE_GREEN, LED_MODE_PSU2_GREEN_MASK},
|
|
{LED_TYPE_PSU2, LED_TYPE_PSU2_REG_MASK, LED_MODE_AMBER, LED_MODE_PSU2_AMBER_MASK},
|
|
{LED_TYPE_PSU2, LED_TYPE_PSU2_REG_MASK, LED_MODE_RED, LED_MODE_PSU2_RED_MASK},
|
|
{LED_TYPE_PSU2, LED_TYPE_PSU2_REG_MASK, LED_MODE_OFF, LED_MODE_PSU2_OFF_MASK},
|
|
|
|
{LED_TYPE_SYS, LED_TYPE_SYS_REG_MASK, LED_MODE_GREEN, LED_MODE_SYS_GREEN_MASK},
|
|
{LED_TYPE_SYS, LED_TYPE_SYS_REG_MASK, LED_MODE_AMBER, LED_MODE_SYS_AMBER_MASK},
|
|
{LED_TYPE_SYS, LED_TYPE_SYS_REG_MASK, LED_MODE_RED, LED_MODE_SYS_RED_MASK},
|
|
{LED_TYPE_SYS, LED_TYPE_SYS_REG_MASK, LED_MODE_AMBER_FLASHING, LED_MODE_SYS_AMBER_FLASHING_MASK},
|
|
{LED_TYPE_SYS, LED_TYPE_SYS_REG_MASK, LED_MODE_OFF, LED_MODE_SYS_OFF_MASK},
|
|
|
|
{LED_TYPE_FAN, LED_TYPE_FAN_REG_MASK, LED_MODE_GREEN, LED_MODE_FAN_GREEN_MASK},
|
|
{LED_TYPE_FAN, LED_TYPE_FAN_REG_MASK, LED_MODE_AMBER, LED_MODE_FAN_AMBER_MASK},
|
|
{LED_TYPE_FAN, LED_TYPE_FAN_REG_MASK, LED_MODE_RED, LED_MODE_FAN_RED_MASK},
|
|
{LED_TYPE_FAN, LED_TYPE_FAN_REG_MASK, LED_MODE_OFF, LED_MODE_FAN_OFF_MASK},
|
|
|
|
{LED_TYPE_FAN1, LED_TYPE_FAN1_REG_MASK, LED_MODE_GREEN, LED_MODE_FANX_GREEN_MASK << 0},
|
|
{LED_TYPE_FAN1, LED_TYPE_FAN1_REG_MASK, LED_MODE_RED, LED_MODE_FANX_RED_MASK << 0},
|
|
{LED_TYPE_FAN1, LED_TYPE_FAN1_REG_MASK, LED_MODE_AMBER, LED_MODE_FANX_AMBER_MASK << 0},
|
|
{LED_TYPE_FAN1, LED_TYPE_FAN1_REG_MASK, LED_MODE_OFF, LED_MODE_FANX_OFF_MASK << 0},
|
|
{LED_TYPE_FAN2, LED_TYPE_FAN2_REG_MASK, LED_MODE_GREEN, LED_MODE_FANX_GREEN_MASK << 2},
|
|
{LED_TYPE_FAN2, LED_TYPE_FAN2_REG_MASK, LED_MODE_RED, LED_MODE_FANX_RED_MASK << 2},
|
|
{LED_TYPE_FAN2, LED_TYPE_FAN2_REG_MASK, LED_MODE_AMBER, LED_MODE_FANX_AMBER_MASK << 2},
|
|
{LED_TYPE_FAN2, LED_TYPE_FAN2_REG_MASK, LED_MODE_OFF, LED_MODE_FANX_OFF_MASK << 2},
|
|
{LED_TYPE_FAN3, LED_TYPE_FAN3_REG_MASK, LED_MODE_GREEN, LED_MODE_FANX_GREEN_MASK << 4},
|
|
{LED_TYPE_FAN3, LED_TYPE_FAN3_REG_MASK, LED_MODE_RED, LED_MODE_FANX_RED_MASK << 4},
|
|
{LED_TYPE_FAN3, LED_TYPE_FAN3_REG_MASK, LED_MODE_AMBER, LED_MODE_FANX_AMBER_MASK << 4},
|
|
{LED_TYPE_FAN3, LED_TYPE_FAN3_REG_MASK, LED_MODE_OFF, LED_MODE_FANX_OFF_MASK << 4},
|
|
{LED_TYPE_FAN4, LED_TYPE_FAN4_REG_MASK, LED_MODE_GREEN, LED_MODE_FANX_GREEN_MASK << 6},
|
|
{LED_TYPE_FAN4, LED_TYPE_FAN4_REG_MASK, LED_MODE_RED, LED_MODE_FANX_RED_MASK << 6},
|
|
{LED_TYPE_FAN4, LED_TYPE_FAN4_REG_MASK, LED_MODE_AMBER, LED_MODE_FANX_AMBER_MASK << 6},
|
|
{LED_TYPE_FAN4, LED_TYPE_FAN4_REG_MASK, LED_MODE_OFF, LED_MODE_FANX_OFF_MASK << 6},
|
|
{LED_TYPE_FAN5, LED_TYPE_FAN5_REG_MASK, LED_MODE_GREEN, LED_MODE_FANX_GREEN_MASK << 0},
|
|
{LED_TYPE_FAN5, LED_TYPE_FAN5_REG_MASK, LED_MODE_RED, LED_MODE_FANX_RED_MASK << 0},
|
|
{LED_TYPE_FAN5, LED_TYPE_FAN5_REG_MASK, LED_MODE_AMBER, LED_MODE_FANX_AMBER_MASK << 0},
|
|
{LED_TYPE_FAN5, LED_TYPE_FAN5_REG_MASK, LED_MODE_OFF, LED_MODE_FANX_OFF_MASK << 0},
|
|
};
|
|
|
|
struct fanx_info_s {
|
|
u8 cname; /* device name */
|
|
enum led_type type;
|
|
u8 reg_id; /* map to led_reg & reg_val */
|
|
};
|
|
|
|
static struct fanx_info_s fanx_info[] = {
|
|
{'1', LED_TYPE_FAN1, 3},
|
|
{'2', LED_TYPE_FAN2, 3},
|
|
{'3', LED_TYPE_FAN3, 3},
|
|
{'4', LED_TYPE_FAN4, 3},
|
|
{'5', LED_TYPE_FAN5, 2},
|
|
};
|
|
|
|
|
|
static int led_reg_val_to_light_mode(enum led_type type, u8 reg_val) {
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(led_type_mode_data); i++) {
|
|
|
|
if (type != led_type_mode_data[i].type)
|
|
continue;
|
|
|
|
if ((led_type_mode_data[i].type_mask & reg_val) ==
|
|
led_type_mode_data[i].mode_mask)
|
|
{
|
|
return led_type_mode_data[i].mode;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static u8 led_light_mode_to_reg_val(enum led_type type,
|
|
enum led_light_mode mode, u8 reg_val) {
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(led_type_mode_data); i++) {
|
|
if (type != led_type_mode_data[i].type)
|
|
continue;
|
|
|
|
if (mode != led_type_mode_data[i].mode)
|
|
continue;
|
|
|
|
reg_val = led_type_mode_data[i].mode_mask |
|
|
(reg_val & (~led_type_mode_data[i].type_mask));
|
|
break;
|
|
}
|
|
|
|
return reg_val;
|
|
}
|
|
|
|
static void cs6436_56p_led_update(void)
|
|
{
|
|
mutex_lock(&ledctl->update_lock);
|
|
|
|
if (time_after(jiffies, ledctl->last_updated + HZ + HZ / 2)
|
|
|| !ledctl->valid) {
|
|
int i;
|
|
|
|
dev_dbg(&ledctl->pdev->dev, "Starting cs6436_56p_led update\n");
|
|
|
|
/* Update LED data
|
|
*/
|
|
for (i = 0; i < ARRAY_SIZE(ledctl->reg_val); i++) {
|
|
u8 status;
|
|
cig_cpld_read_register(led_reg[i], &status);
|
|
|
|
if (status < 0) {
|
|
ledctl->valid = 0;
|
|
dev_dbg(&ledctl->pdev->dev, "reg %d, err %d\n", led_reg[i], status);
|
|
goto exit;
|
|
}
|
|
else
|
|
{
|
|
ledctl->reg_val[i] = status;
|
|
}
|
|
}
|
|
|
|
ledctl->last_updated = jiffies;
|
|
ledctl->valid = 1;
|
|
}
|
|
|
|
exit:
|
|
mutex_unlock(&ledctl->update_lock);
|
|
}
|
|
|
|
static void cs6436_56p_led_set(struct led_classdev *led_cdev,
|
|
enum led_brightness led_light_mode,
|
|
u8 reg, enum led_type type)
|
|
{
|
|
u8 reg_val;
|
|
mutex_lock(&ledctl->update_lock);
|
|
|
|
cig_cpld_read_register(reg, ®_val);
|
|
if (reg_val < 0) {
|
|
dev_dbg(&ledctl->pdev->dev, "reg %d, err %d\n", reg, reg_val);
|
|
goto exit;
|
|
}
|
|
|
|
reg_val = led_light_mode_to_reg_val(type, led_light_mode, reg_val);
|
|
|
|
cig_cpld_write_register(reg, reg_val);
|
|
|
|
/* to prevent the slow-update issue */
|
|
ledctl->valid = 0;
|
|
|
|
exit:
|
|
mutex_unlock(&ledctl->update_lock);
|
|
}
|
|
|
|
static void cs6436_56p_led_fanx_set(struct led_classdev *led_cdev,
|
|
enum led_brightness led_light_mode)
|
|
{
|
|
enum led_type led_type1;
|
|
int reg_id;
|
|
int i, nsize;
|
|
int ncount = sizeof(fanx_info)/sizeof(struct fanx_info_s);
|
|
|
|
for(i=0;i<ncount;i++)
|
|
{
|
|
nsize=strlen(led_cdev->name);
|
|
|
|
if (led_cdev->name[nsize-1] == fanx_info[i].cname)
|
|
{
|
|
led_type1 = fanx_info[i].type;
|
|
reg_id = fanx_info[i].reg_id;
|
|
|
|
cs6436_56p_led_set(led_cdev, led_light_mode, led_reg[reg_id], led_type1);
|
|
return;
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
static enum led_brightness cs6436_56p_led_fanx_get(struct led_classdev *cdev)
|
|
{
|
|
enum led_type led_type1;
|
|
int reg_id;
|
|
int i, nsize;
|
|
int ncount = sizeof(fanx_info)/sizeof(struct fanx_info_s);
|
|
|
|
for(i=0;i<ncount;i++)
|
|
{
|
|
nsize=strlen(cdev->name);
|
|
|
|
if (cdev->name[nsize-1] == fanx_info[i].cname)
|
|
{
|
|
led_type1 = fanx_info[i].type;
|
|
reg_id = fanx_info[i].reg_id;
|
|
cs6436_56p_led_update();
|
|
return led_reg_val_to_light_mode(led_type1, ledctl->reg_val[reg_id]);
|
|
}
|
|
}
|
|
|
|
return led_reg_val_to_light_mode(LED_TYPE_FAN1, ledctl->reg_val[5]);
|
|
}
|
|
|
|
|
|
static void cs6436_56p_led_psu1_set(struct led_classdev *led_cdev,
|
|
enum led_brightness led_light_mode)
|
|
{
|
|
cs6436_56p_led_set(led_cdev, led_light_mode, led_reg[1], LED_TYPE_PSU1);
|
|
}
|
|
|
|
static enum led_brightness cs6436_56p_led_psu1_get(struct led_classdev *cdev)
|
|
{
|
|
cs6436_56p_led_update();
|
|
return led_reg_val_to_light_mode(LED_TYPE_PSU1, ledctl->reg_val[1]);
|
|
}
|
|
|
|
static void cs6436_56p_led_psu2_set(struct led_classdev *led_cdev,
|
|
enum led_brightness led_light_mode)
|
|
{
|
|
cs6436_56p_led_set(led_cdev, led_light_mode, led_reg[1], LED_TYPE_PSU2);
|
|
}
|
|
|
|
static enum led_brightness cs6436_56p_led_psu2_get(struct led_classdev *cdev)
|
|
{
|
|
cs6436_56p_led_update();
|
|
return led_reg_val_to_light_mode(LED_TYPE_PSU2, ledctl->reg_val[1]);
|
|
}
|
|
|
|
static void cs6436_56p_led_sys_set(struct led_classdev *led_cdev,
|
|
enum led_brightness led_light_mode)
|
|
{
|
|
cs6436_56p_led_set(led_cdev, led_light_mode,led_reg[0], LED_TYPE_SYS);
|
|
}
|
|
|
|
static enum led_brightness cs6436_56p_led_sys_get(struct led_classdev *cdev)
|
|
{
|
|
cs6436_56p_led_update();
|
|
return led_reg_val_to_light_mode(LED_TYPE_SYS, ledctl->reg_val[0]);
|
|
}
|
|
|
|
|
|
static enum led_brightness cs6436_56p_led_fan_get(struct led_classdev *cdev)
|
|
{
|
|
cs6436_56p_led_update();
|
|
return led_reg_val_to_light_mode(LED_TYPE_FAN, ledctl->reg_val[1]);
|
|
}
|
|
|
|
static void cs6436_56p_led_fan_set(struct led_classdev *led_cdev,
|
|
enum led_brightness led_light_mode)
|
|
{
|
|
cs6436_56p_led_set(led_cdev, led_light_mode, led_reg[1], LED_TYPE_FAN);
|
|
}
|
|
|
|
|
|
static struct led_classdev cs6436_56p_leds[] = {
|
|
[LED_TYPE_SYS] = {
|
|
.name = "cs6436_56p_led::sys",
|
|
.default_trigger = "unused",
|
|
.brightness_set = cs6436_56p_led_sys_set,
|
|
.brightness_get = cs6436_56p_led_sys_get,
|
|
.flags = LED_CORE_SUSPENDRESUME,
|
|
.max_brightness = LED_MODE_AUTO,
|
|
},
|
|
[LED_TYPE_FAN] = {
|
|
.name = "cs6436_56p_led::fan",
|
|
.default_trigger = "unused",
|
|
.brightness_set = cs6436_56p_led_fan_set,
|
|
.brightness_get = cs6436_56p_led_fan_get,
|
|
.flags = LED_CORE_SUSPENDRESUME,
|
|
.max_brightness = LED_MODE_AUTO,
|
|
},
|
|
|
|
[LED_TYPE_PSU1] = {
|
|
.name = "cs6436_56p_led::psu1",
|
|
.default_trigger = "unused",
|
|
.brightness_set = cs6436_56p_led_psu1_set,
|
|
.brightness_get = cs6436_56p_led_psu1_get,
|
|
.flags = LED_CORE_SUSPENDRESUME,
|
|
.max_brightness = LED_MODE_AUTO,
|
|
},
|
|
[LED_TYPE_PSU2] = {
|
|
.name = "cs6436_56p_led::psu2",
|
|
.default_trigger = "unused",
|
|
.brightness_set = cs6436_56p_led_psu2_set,
|
|
.brightness_get = cs6436_56p_led_psu2_get,
|
|
.flags = LED_CORE_SUSPENDRESUME,
|
|
.max_brightness = LED_MODE_AUTO,
|
|
},
|
|
|
|
[LED_TYPE_FAN1] = {
|
|
.name = "cs6436_56p_led::fan1",
|
|
.default_trigger = "unused",
|
|
.brightness_set = cs6436_56p_led_fanx_set,
|
|
.brightness_get = cs6436_56p_led_fanx_get,
|
|
.flags = LED_CORE_SUSPENDRESUME,
|
|
.max_brightness = LED_MODE_AUTO,
|
|
},
|
|
[LED_TYPE_FAN2] = {
|
|
.name = "cs6436_56p_led::fan2",
|
|
.default_trigger = "unused",
|
|
.brightness_set = cs6436_56p_led_fanx_set,
|
|
.brightness_get = cs6436_56p_led_fanx_get,
|
|
.flags = LED_CORE_SUSPENDRESUME,
|
|
.max_brightness = LED_MODE_AUTO,
|
|
},
|
|
[LED_TYPE_FAN3] = {
|
|
.name = "cs6436_56p_led::fan3",
|
|
.default_trigger = "unused",
|
|
.brightness_set = cs6436_56p_led_fanx_set,
|
|
.brightness_get = cs6436_56p_led_fanx_get,
|
|
.flags = LED_CORE_SUSPENDRESUME,
|
|
.max_brightness = LED_MODE_AUTO,
|
|
},
|
|
[LED_TYPE_FAN4] = {
|
|
.name = "cs6436_56p_led::fan4",
|
|
.default_trigger = "unused",
|
|
.brightness_set = cs6436_56p_led_fanx_set,
|
|
.brightness_get = cs6436_56p_led_fanx_get,
|
|
.flags = LED_CORE_SUSPENDRESUME,
|
|
.max_brightness = LED_MODE_AUTO,
|
|
},
|
|
[LED_TYPE_FAN5] = {
|
|
.name = "cs6436_56p_led::fan5",
|
|
.default_trigger = "unused",
|
|
.brightness_set = cs6436_56p_led_fanx_set,
|
|
.brightness_get = cs6436_56p_led_fanx_get,
|
|
.flags = LED_CORE_SUSPENDRESUME,
|
|
.max_brightness = LED_MODE_AUTO,
|
|
}
|
|
};
|
|
|
|
static int cs6436_56p_led_suspend(struct platform_device *dev,
|
|
pm_message_t state)
|
|
{
|
|
int i = 0;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(cs6436_56p_leds); i++) {
|
|
led_classdev_suspend(&cs6436_56p_leds[i]);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int cs6436_56p_led_resume(struct platform_device *dev)
|
|
{
|
|
int i = 0;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(cs6436_56p_leds); i++) {
|
|
led_classdev_resume(&cs6436_56p_leds[i]);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int cs6436_56p_led_probe(struct platform_device *pdev)
|
|
{
|
|
int ret, i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(cs6436_56p_leds); i++) {
|
|
ret = led_classdev_register(&pdev->dev, &cs6436_56p_leds[i]);
|
|
|
|
if (ret < 0)
|
|
break;
|
|
}
|
|
|
|
/* Check if all LEDs were successfully registered */
|
|
if (i != ARRAY_SIZE(cs6436_56p_leds)) {
|
|
int j;
|
|
|
|
/* only unregister the LEDs that were successfully registered */
|
|
for (j = 0; j < i; j++) {
|
|
led_classdev_unregister(&cs6436_56p_leds[i]);
|
|
}
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int cs6436_56p_led_remove(struct platform_device *pdev)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(cs6436_56p_leds); i++) {
|
|
led_classdev_unregister(&cs6436_56p_leds[i]);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct platform_driver cs6436_56p_led_driver = {
|
|
.probe = cs6436_56p_led_probe,
|
|
.remove = cs6436_56p_led_remove,
|
|
.suspend = cs6436_56p_led_suspend,
|
|
.resume = cs6436_56p_led_resume,
|
|
.driver = {
|
|
.name = DRVNAME,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
};
|
|
|
|
static int cs6436_56p_led_default(void)
|
|
{
|
|
cig_cpld_write_register(0x30, 0x40);// system green led solid on
|
|
}
|
|
|
|
static int __init cs6436_56p_led_init(void)
|
|
{
|
|
int ret;
|
|
|
|
ret = platform_driver_register(&cs6436_56p_led_driver);
|
|
if (ret < 0) {
|
|
goto exit;
|
|
}
|
|
|
|
ledctl = kzalloc(sizeof(struct cs6436_56p_led_data), GFP_KERNEL);
|
|
if (!ledctl) {
|
|
ret = -ENOMEM;
|
|
platform_driver_unregister(&cs6436_56p_led_driver);
|
|
goto exit;
|
|
}
|
|
|
|
mutex_init(&ledctl->update_lock);
|
|
|
|
ledctl->pdev = platform_device_register_simple(DRVNAME, -1, NULL, 0);
|
|
if (IS_ERR(ledctl->pdev)) {
|
|
ret = PTR_ERR(ledctl->pdev);
|
|
platform_driver_unregister(&cs6436_56p_led_driver);
|
|
kfree(ledctl);
|
|
goto exit;
|
|
}
|
|
|
|
cs6436_56p_led_default();
|
|
|
|
exit:
|
|
return ret;
|
|
}
|
|
|
|
static void __exit cs6436_56p_led_exit(void)
|
|
{
|
|
platform_device_unregister(ledctl->pdev);
|
|
platform_driver_unregister(&cs6436_56p_led_driver);
|
|
kfree(ledctl);
|
|
}
|
|
|
|
module_init(cs6436_56p_led_init);
|
|
module_exit(cs6436_56p_led_exit);
|
|
|
|
MODULE_AUTHOR("Zhang Peng <zhangpeng@cigtech.com>");
|
|
MODULE_DESCRIPTION("cs6436_56p_led driver");
|
|
MODULE_LICENSE("GPL");
|
|
|