220 lines
6.5 KiB
C
220 lines
6.5 KiB
C
/* An hwmon driver for Cameo esqc610-56sq Innovium i2c Module */
|
|
#pragma GCC diagnostic ignored "-Wformat-zero-length"
|
|
#include "x86-64-cameo-esqc610-56sq.h"
|
|
#include "x86-64-cameo-esqc610-56sq-common.h"
|
|
#include "x86-64-cameo-esqc610-56sq-led.h"
|
|
|
|
/* i2c_client Declaration */
|
|
extern struct i2c_client *Cameo_CPLD_30_client; //0x30 for SYS CPLD
|
|
/* end of i2c_client Declaration */
|
|
|
|
/* implement i2c_function */
|
|
ssize_t led_ctrl_get(struct device *dev, struct device_attribute *da, char *buf)
|
|
{
|
|
int status = -EPERM;
|
|
int res = 0x1;
|
|
int i;
|
|
int led_a_status = 0;
|
|
int led_g_status = 0;
|
|
int led_b_status = 0;
|
|
struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
|
|
|
|
status = i2c_smbus_read_byte_data(Cameo_CPLD_30_client, LED_CTRL_REG);
|
|
sprintf(buf, "");
|
|
|
|
for (i = 1; i <= 4; i++)
|
|
{
|
|
if ( i == attr->index)
|
|
{
|
|
if (status & res)
|
|
{
|
|
led_a_status = ENABLE;
|
|
}
|
|
else
|
|
{
|
|
led_a_status = DISABLE;
|
|
}
|
|
}
|
|
res = res << 1;
|
|
if( i == (attr->index + 1) )
|
|
{
|
|
if (status & res)
|
|
{
|
|
led_g_status = ENABLE;
|
|
}
|
|
else
|
|
{
|
|
led_g_status = DISABLE;
|
|
}
|
|
}
|
|
res = res << 1;
|
|
}
|
|
res = 0x1;
|
|
|
|
status = i2c_smbus_read_byte_data(Cameo_CPLD_30_client, LED_BLINK_REG);
|
|
for (i = 1; i <= 4; i++)
|
|
{
|
|
if ( i == attr->index)
|
|
{
|
|
if (status & res)
|
|
{
|
|
led_b_status = ENABLE;
|
|
}
|
|
else
|
|
{
|
|
led_b_status = DISABLE;
|
|
}
|
|
}
|
|
res = res << 1;
|
|
}
|
|
if(led_a_status == ENABLE && led_b_status == ENABLE)
|
|
{
|
|
sprintf(buf, "%s2\n", buf);
|
|
}
|
|
else if(led_a_status == ENABLE && led_b_status == DISABLE)
|
|
{
|
|
sprintf(buf, "%s1\n", buf);
|
|
}
|
|
else if(led_g_status == ENABLE && led_b_status == ENABLE)
|
|
{
|
|
sprintf(buf, "%s4\n", buf);
|
|
}
|
|
else if(led_g_status == ENABLE && led_b_status == DISABLE)
|
|
{
|
|
sprintf(buf, "%s3\n", buf);
|
|
}
|
|
else
|
|
{
|
|
sprintf(buf, "%s0\n", buf);
|
|
}
|
|
|
|
return sprintf(buf, "%s", buf);
|
|
}
|
|
|
|
ssize_t led_ctrl_set(struct device *dev, struct device_attribute *da, const char *buf, size_t count)
|
|
{
|
|
int led_value = -EPERM;
|
|
int blk_value = -EPERM;
|
|
int result = -EPERM;
|
|
int offset = 0;
|
|
u16 i;
|
|
struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
|
|
struct Cameo_i2c_data *data = i2c_get_clientdata(Cameo_CPLD_30_client);
|
|
|
|
mutex_lock(&data->update_lock);
|
|
led_value = i2c_smbus_read_byte_data(Cameo_CPLD_30_client, LED_CTRL_REG);
|
|
blk_value = i2c_smbus_read_byte_data(Cameo_CPLD_30_client, LED_BLINK_REG);
|
|
if (attr->index != 0)
|
|
{
|
|
i = simple_strtol(buf, NULL, 10);
|
|
if(attr->index == 1)
|
|
{
|
|
offset = 0;
|
|
}
|
|
else
|
|
{
|
|
offset = 2*((attr->index)-1);
|
|
}
|
|
switch(i)
|
|
{
|
|
case SWITCH_LED_OFF: //i=0
|
|
led_value &= ~(0x03 << offset);
|
|
blk_value &= ~(1 << ((attr->index)-1));
|
|
break;
|
|
case SWITCH_LED_A_N: //i=1
|
|
led_value &= ~(0x03 << offset);
|
|
led_value |= (0x01 << offset);
|
|
blk_value &= ~(1 << ((attr->index)-1));
|
|
break;
|
|
case SWITCH_LED_A_B: //i=2
|
|
led_value &= ~(0x03 << offset);
|
|
led_value |= (0x01 << offset);
|
|
blk_value |= (1 << ((attr->index)-1));
|
|
break;
|
|
case SWITCH_LED_G_N: //i=3
|
|
led_value &= ~(0x03 << offset);
|
|
led_value |= (0x02 << offset);
|
|
blk_value &= ~(1 << ((attr->index)-1));
|
|
break;
|
|
case SWITCH_LED_G_B: //i=4
|
|
led_value &= ~(0x03 << offset);
|
|
led_value |= (0x02 << offset);
|
|
blk_value |= (1 << ((attr->index)-1));
|
|
break;
|
|
default:
|
|
printk(KERN_ALERT "led_ctrl_set wrong Value\n");
|
|
return count;
|
|
}
|
|
result = i2c_smbus_write_byte_data(Cameo_CPLD_30_client, LED_CTRL_REG, led_value);
|
|
result |= i2c_smbus_write_byte_data(Cameo_CPLD_30_client, LED_BLINK_REG, blk_value);
|
|
if (result < 0)
|
|
{
|
|
printk(KERN_ALERT "ERROR: led_ctrl_set FAILED!\n");
|
|
}
|
|
}
|
|
mutex_unlock(&data->update_lock);
|
|
return count;
|
|
}
|
|
|
|
ssize_t led_fiber_get(struct device *dev, struct device_attribute *da, char *buf)
|
|
{
|
|
struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
|
|
struct Cameo_i2c_data *data = i2c_get_clientdata(Cameo_CPLD_30_client);
|
|
|
|
mutex_lock(&data->update_lock);
|
|
sprintf(buf, "");
|
|
if (attr->index == LED_FIBER)
|
|
{
|
|
if (i2c_smbus_read_byte_data(Cameo_CPLD_30_client, LED_FIBER_REG) & BIT_0_MASK)
|
|
{
|
|
sprintf(buf, "%s%d\n", buf, ENABLE);
|
|
}
|
|
else
|
|
{
|
|
sprintf(buf, "%s%d\n", buf, DISABLE);
|
|
}
|
|
}
|
|
mutex_unlock(&data->update_lock);
|
|
return sprintf(buf, "%s\n", buf);
|
|
}
|
|
ssize_t led_fiber_set(struct device *dev, struct device_attribute *da, const char *buf, size_t count)
|
|
{
|
|
int status = -EPERM;
|
|
int value = -EPERM;
|
|
int result = -EPERM;
|
|
int input;
|
|
struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
|
|
struct Cameo_i2c_data *data = i2c_get_clientdata(Cameo_CPLD_30_client);
|
|
|
|
mutex_lock(&data->update_lock);
|
|
status = i2c_smbus_read_byte_data(Cameo_CPLD_30_client, LED_CTRL_REG);
|
|
if (attr->index == LED_FIBER)
|
|
{
|
|
input = simple_strtol(buf, NULL, 10);
|
|
if (input == ENABLE)
|
|
{
|
|
value = status | LED_FIBER_ENABLE;
|
|
result = i2c_smbus_write_byte_data(Cameo_CPLD_30_client, LED_FIBER_REG, value);
|
|
if (result < 0)
|
|
{
|
|
printk(KERN_ALERT "ERROR: led_ctrl_set FAILED!\n");
|
|
}
|
|
}
|
|
else if (input == DISABLE)
|
|
{
|
|
value = status & LED_FIBER_DISABLE;
|
|
result = i2c_smbus_write_byte_data(Cameo_CPLD_30_client, LED_FIBER_REG, value);
|
|
if (result < 0)
|
|
{
|
|
printk(KERN_ALERT "ERROR: led_ctrl_set FAILED!\n");
|
|
}
|
|
}
|
|
else
|
|
{
|
|
printk(KERN_ALERT "led_ctrl_set wrong Value\n");
|
|
}
|
|
}
|
|
mutex_unlock(&data->update_lock);
|
|
return count;
|
|
}
|
|
/* end of implement i2c_function */ |