358 lines
9.8 KiB
C
358 lines
9.8 KiB
C
/* An hwmon driver for Cameo esc600-128Q Innovium i2c Module */
|
|
#pragma GCC diagnostic ignored "-Wformat-zero-length"
|
|
#include "x86-64-cameo-esc600-128q.h"
|
|
#include "x86-64-cameo-esc600-128q-common.h"
|
|
#include "x86-64-cameo-esc600-128q-fan.h"
|
|
|
|
/* extern i2c_client */
|
|
extern struct i2c_client *Cameo_CPLD_35_client; //0x35 CPLD ,XO2-2000HC-4FTG256C
|
|
extern struct i2c_client *Cameo_BMC_14_client; //0x14 for BMC slave
|
|
/* end of extern i2c_client */
|
|
|
|
/* implement i2c_function */
|
|
ssize_t fan_ctrl_mode_get(struct device *dev, struct device_attribute *da, char *buf)
|
|
{
|
|
int status = -EPERM;
|
|
struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
|
|
struct Cameo_i2c_data *data = i2c_get_clientdata(Cameo_BMC_14_client);
|
|
|
|
mutex_lock(&data->update_lock);
|
|
sprintf(buf, "");
|
|
if (attr->index == FANCTRL_MODE)
|
|
{
|
|
if( bmc_enable() == ENABLE)
|
|
{
|
|
status = i2c_smbus_read_byte_data(Cameo_BMC_14_client, FANCTRL_MODE_REG);
|
|
if(status == 0xff || status < 0)
|
|
{
|
|
sprintf(buf, "%sAccess BMC module FAILED\n", buf);
|
|
}
|
|
else
|
|
{
|
|
sprintf(buf, "%s0x%x\n", buf, status);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
sprintf(buf, "%sAccess BMC module FAILED\n", buf);
|
|
}
|
|
}
|
|
mutex_unlock(&data->update_lock);
|
|
return sprintf(buf, "%s\n", buf);
|
|
}
|
|
|
|
ssize_t fan_ctrl_rpm_get(struct device *dev, struct device_attribute *da, char *buf)
|
|
{
|
|
int status = -EPERM;
|
|
struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
|
|
struct Cameo_i2c_data *data = i2c_get_clientdata(Cameo_BMC_14_client);
|
|
|
|
mutex_lock(&data->update_lock);
|
|
sprintf(buf, "");
|
|
if (attr->index == FANCTRL_RPM)
|
|
{
|
|
if( bmc_enable() == ENABLE)
|
|
{
|
|
status = i2c_smbus_read_byte_data(Cameo_BMC_14_client, FANCTRL_RPM_REG);
|
|
if(status == 0xff || status < 0)
|
|
{
|
|
sprintf(buf, "%sAccess BMC module FAILED\n", buf);
|
|
}
|
|
else
|
|
{
|
|
sprintf(buf, "%s0x%x\n", buf, status);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
sprintf(buf, "%sAccess BMC module FAILED\n", buf);
|
|
}
|
|
}
|
|
mutex_unlock(&data->update_lock);
|
|
return sprintf(buf, "%s\n", buf);
|
|
}
|
|
|
|
ssize_t fan_status_get(struct device *dev, struct device_attribute *da, char *buf)
|
|
{
|
|
int status = -EPERM;
|
|
int result = -EPERM;
|
|
struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
|
|
struct Cameo_i2c_data *Cameo_CPLD_35_data = i2c_get_clientdata(Cameo_CPLD_35_client);
|
|
struct Cameo_i2c_data *Cameo_BMC_14_data = i2c_get_clientdata(Cameo_BMC_14_client);
|
|
|
|
sprintf(buf, "");
|
|
if( bmc_enable() == ENABLE)
|
|
{
|
|
mutex_lock(&Cameo_BMC_14_data->update_lock);
|
|
status = i2c_smbus_read_byte_data(Cameo_BMC_14_client, BMC_FAN_STAT_REG);
|
|
mutex_unlock(&Cameo_BMC_14_data->update_lock);
|
|
}
|
|
else
|
|
{
|
|
mutex_lock(&Cameo_CPLD_35_data->update_lock);
|
|
status = i2c_smbus_read_byte_data(Cameo_CPLD_35_client, FAN_STAT_REG);
|
|
mutex_unlock(&Cameo_CPLD_35_data->update_lock);
|
|
}
|
|
|
|
result = FAILED;
|
|
switch (attr->index)
|
|
{
|
|
case 1:
|
|
if(status & BIT_4_MASK)
|
|
{
|
|
result = PASSED;
|
|
}
|
|
break;
|
|
case 2:
|
|
if(status & BIT_5_MASK)
|
|
{
|
|
result = PASSED;
|
|
}
|
|
break;
|
|
case 3:
|
|
if(status & BIT_6_MASK)
|
|
{
|
|
result = PASSED;
|
|
}
|
|
break;
|
|
case 4:
|
|
if(status & BIT_7_MASK)
|
|
{
|
|
result = PASSED;
|
|
}
|
|
break;
|
|
}
|
|
if(result != PASSED)
|
|
{
|
|
return sprintf(buf, "%s%d\n", buf, FAILED);
|
|
}
|
|
return sprintf(buf, "%s%d\n", buf, PASSED);
|
|
}
|
|
|
|
ssize_t fan_present_get(struct device *dev, struct device_attribute *da, char *buf)
|
|
{
|
|
int status = -EPERM;
|
|
int result = -EPERM;
|
|
struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
|
|
struct Cameo_i2c_data *Cameo_CPLD_35_data = i2c_get_clientdata(Cameo_CPLD_35_client);
|
|
struct Cameo_i2c_data *Cameo_BMC_14_data = i2c_get_clientdata(Cameo_BMC_14_client);
|
|
|
|
sprintf(buf, "");
|
|
if( bmc_enable() == ENABLE)
|
|
{
|
|
mutex_lock(&Cameo_BMC_14_data->update_lock);
|
|
status = i2c_smbus_read_byte_data(Cameo_BMC_14_client, BMC_FAN_PRESENT_REG);
|
|
mutex_unlock(&Cameo_BMC_14_data->update_lock);
|
|
}
|
|
else
|
|
{
|
|
mutex_lock(&Cameo_CPLD_35_data->update_lock);
|
|
status = i2c_smbus_read_byte_data(Cameo_CPLD_35_client, FAN_PRESENT_REG);
|
|
mutex_unlock(&Cameo_CPLD_35_data->update_lock);
|
|
}
|
|
|
|
result = FAILED;
|
|
switch (attr->index)
|
|
{
|
|
case 1:
|
|
if(status & BIT_0_MASK)
|
|
{
|
|
result = PASSED;
|
|
}
|
|
break;
|
|
case 2:
|
|
if(status & BIT_1_MASK)
|
|
{
|
|
result = PASSED;
|
|
}
|
|
break;
|
|
case 3:
|
|
if(status & BIT_2_MASK)
|
|
{
|
|
result = PASSED;
|
|
}
|
|
break;
|
|
case 4:
|
|
if(status & BIT_3_MASK)
|
|
{
|
|
result = PASSED;
|
|
}
|
|
break;
|
|
}
|
|
if(result != PASSED)
|
|
{
|
|
return sprintf(buf, "%s%d\n", buf, FAILED);
|
|
}
|
|
return sprintf(buf, "%s%d\n", buf, PASSED);
|
|
}
|
|
|
|
ssize_t fan_power_get(struct device *dev, struct device_attribute *da, char *buf)
|
|
{
|
|
int status = -EPERM;
|
|
int result = -EPERM;
|
|
struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
|
|
struct Cameo_i2c_data *Cameo_CPLD_35_data = i2c_get_clientdata(Cameo_CPLD_35_client);
|
|
struct Cameo_i2c_data *Cameo_BMC_14_data = i2c_get_clientdata(Cameo_BMC_14_client);
|
|
|
|
sprintf(buf, "");
|
|
if( bmc_enable() == ENABLE)
|
|
{
|
|
mutex_lock(&Cameo_BMC_14_data->update_lock);
|
|
status = i2c_smbus_read_byte_data(Cameo_BMC_14_client, BMC_FAN_POWER_REG);
|
|
mutex_unlock(&Cameo_BMC_14_data->update_lock);
|
|
}
|
|
else
|
|
{
|
|
mutex_lock(&Cameo_CPLD_35_data->update_lock);
|
|
status = i2c_smbus_read_byte_data(Cameo_CPLD_35_client, FAN_POWER_REG);
|
|
mutex_unlock(&Cameo_CPLD_35_data->update_lock);
|
|
}
|
|
|
|
result = FAILED;
|
|
switch (attr->index)
|
|
{
|
|
case 1:
|
|
if(status & BIT_4_MASK)
|
|
{
|
|
result = PASSED;
|
|
}
|
|
break;
|
|
case 2:
|
|
if(status & BIT_5_MASK)
|
|
{
|
|
result = PASSED;
|
|
}
|
|
break;
|
|
case 3:
|
|
if(status & BIT_6_MASK)
|
|
{
|
|
result = PASSED;
|
|
}
|
|
break;
|
|
case 4:
|
|
if(status & BIT_7_MASK)
|
|
{
|
|
result = PASSED;
|
|
}
|
|
break;
|
|
}
|
|
if(result != PASSED)
|
|
{
|
|
return sprintf(buf, "%s%d\n", buf, FAILED);
|
|
}
|
|
return sprintf(buf, "%s%d\n", buf, PASSED);
|
|
}
|
|
|
|
ssize_t fan_direct_get(struct device *dev, struct device_attribute *da, char *buf)
|
|
{
|
|
int status = -EPERM;
|
|
int result = -EPERM;
|
|
struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
|
|
struct Cameo_i2c_data *Cameo_CPLD_35_data = i2c_get_clientdata(Cameo_CPLD_35_client);
|
|
struct Cameo_i2c_data *Cameo_BMC_14_data = i2c_get_clientdata(Cameo_BMC_14_client);
|
|
|
|
sprintf(buf, "");
|
|
if( bmc_enable() == ENABLE)
|
|
{
|
|
mutex_lock(&Cameo_BMC_14_data->update_lock);
|
|
status = i2c_smbus_read_byte_data(Cameo_BMC_14_client, BMC_FAN_DIRECT_REG);
|
|
mutex_unlock(&Cameo_BMC_14_data->update_lock);
|
|
}
|
|
else
|
|
{
|
|
mutex_lock(&Cameo_CPLD_35_data->update_lock);
|
|
status = i2c_smbus_read_byte_data(Cameo_CPLD_35_client, FAN_DIRECT_REG);
|
|
mutex_unlock(&Cameo_CPLD_35_data->update_lock);
|
|
}
|
|
|
|
result = IN;
|
|
switch (attr->index)
|
|
{
|
|
case 1:
|
|
if(status & BIT_0_MASK)
|
|
{
|
|
result = OUT;
|
|
}
|
|
break;
|
|
case 2:
|
|
if(status & BIT_1_MASK)
|
|
{
|
|
result = OUT;
|
|
}
|
|
break;
|
|
case 3:
|
|
if(status & BIT_2_MASK)
|
|
{
|
|
result = OUT;
|
|
}
|
|
break;
|
|
case 4:
|
|
if(status & BIT_3_MASK)
|
|
{
|
|
result = OUT;
|
|
}
|
|
break;
|
|
}
|
|
if(result != OUT)
|
|
{
|
|
return sprintf(buf, "%s%d\n", buf, IN);
|
|
}
|
|
return sprintf(buf, "%s%d\n", buf, IN);
|
|
}
|
|
|
|
ssize_t fan_rpm_get(struct device *dev, struct device_attribute *da, char *buf)
|
|
{
|
|
int status = -EPERM;
|
|
int fan_offset = 0;
|
|
u8 target_register = 0x00;
|
|
u16 fan_speed = 0;
|
|
struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
|
|
struct i2c_client *target_client = NULL;
|
|
|
|
sprintf(buf, "");
|
|
if( bmc_enable() == ENABLE)
|
|
{
|
|
target_client = Cameo_BMC_14_client;
|
|
target_register = 0xe0;
|
|
}
|
|
else
|
|
{
|
|
target_client = Cameo_CPLD_35_client;
|
|
target_register = 0xa3;
|
|
}
|
|
|
|
switch (attr->index)
|
|
{
|
|
case FAN_1_RPM:
|
|
fan_offset = 0;
|
|
break;
|
|
case FAN_2_RPM:
|
|
fan_offset = 1;
|
|
break;
|
|
case FAN_3_RPM:
|
|
fan_offset = 2;
|
|
break;
|
|
case FAN_4_RPM:
|
|
fan_offset = 3;
|
|
break;
|
|
}
|
|
|
|
// read high byte
|
|
status = i2c_smbus_read_byte_data(target_client, target_register+(fan_offset*2)+1);
|
|
fan_speed = status;
|
|
if(status < 0)
|
|
{
|
|
fan_speed = 0;
|
|
}
|
|
// read low byte
|
|
status = i2c_smbus_read_byte_data(target_client, target_register+(fan_offset*2));
|
|
fan_speed = ((fan_speed<<8) + status)*30;
|
|
if(status < 0)
|
|
{
|
|
fan_speed = 0;
|
|
}
|
|
|
|
sprintf(buf, "%s%d\n", buf, fan_speed);
|
|
return sprintf(buf, "%s\n",buf);
|
|
}
|
|
/* end of implement i2c_function */ |