499 lines
12 KiB
C
499 lines
12 KiB
C
|
#include <linux/module.h>
|
||
|
|
#include <linux/kernel.h>
|
||
|
|
#include <linux/sysfs.h>
|
||
|
|
#include <linux/slab.h>
|
||
|
|
#include <linux/stat.h>
|
||
|
|
#include <linux/i2c.h>
|
||
|
|
#include <linux/i2c-mux.h>
|
||
|
|
#include <linux/i2c-mux-gpio.h>
|
||
|
|
#include <linux/platform_device.h>
|
||
|
|
#include <linux/delay.h>
|
||
|
|
|
||
|
|
#define S9200_MUX_BASE_NR 0
|
||
|
|
#define CPLD_DEVICE_NUM 5
|
||
|
|
|
||
|
|
/* CPLD registers */
|
||
|
|
#define CPLD_REG_REV 0x01
|
||
|
|
#define CPLD_REG_ID 0x02
|
||
|
|
#define CPLD_REG_10G_MUX 0x41
|
||
|
|
|
||
|
|
/* QSFP signal bit in register */
|
||
|
|
#define BIT_RST 0
|
||
|
|
#define BIT_LPM 2
|
||
|
|
#define BIT_INT 0
|
||
|
|
#define BIT_ABS 1
|
||
|
|
|
||
|
|
static void device_release(struct device *dev)
|
||
|
|
{
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* S9200 CPLD register addresses
|
||
|
|
*/
|
||
|
|
static const int int_abs_reg[CPLD_DEVICE_NUM][2]= {
|
||
|
|
{0x20, 0x2B},
|
||
|
|
{0x20, 0x2C},
|
||
|
|
{0x20, 0x2C},
|
||
|
|
{0x20, 0x2C},
|
||
|
|
{0x20, 0x2C}
|
||
|
|
};
|
||
|
|
|
||
|
|
static const int rst_lp_reg[CPLD_DEVICE_NUM][2]= {
|
||
|
|
{0x30, 0x3B},
|
||
|
|
{0x30, 0x3C},
|
||
|
|
{0x30, 0x3C},
|
||
|
|
{0x30, 0x3C},
|
||
|
|
{0x30, 0x3C}
|
||
|
|
};
|
||
|
|
|
||
|
|
/*
|
||
|
|
* S9200 CPLD
|
||
|
|
*/
|
||
|
|
|
||
|
|
enum cpld_type {
|
||
|
|
cpld_1,
|
||
|
|
cpld_2,
|
||
|
|
cpld_3,
|
||
|
|
cpld_4,
|
||
|
|
cpld_5,
|
||
|
|
};
|
||
|
|
|
||
|
|
enum qsfp_signal {
|
||
|
|
sig_int,
|
||
|
|
sig_abs,
|
||
|
|
sig_rst,
|
||
|
|
sig_lpm
|
||
|
|
};
|
||
|
|
|
||
|
|
struct cpld_platform_data {
|
||
|
|
int reg_addr;
|
||
|
|
struct i2c_client *client;
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct cpld_platform_data s9200_cpld_platform_data[] = {
|
||
|
|
[cpld_1] = {
|
||
|
|
.reg_addr = 0x33,
|
||
|
|
},
|
||
|
|
|
||
|
|
[cpld_2] = {
|
||
|
|
.reg_addr = 0x33,
|
||
|
|
},
|
||
|
|
|
||
|
|
[cpld_3] = {
|
||
|
|
.reg_addr = 0x33,
|
||
|
|
},
|
||
|
|
|
||
|
|
[cpld_4] = {
|
||
|
|
.reg_addr = 0x33,
|
||
|
|
},
|
||
|
|
|
||
|
|
[cpld_5] = {
|
||
|
|
.reg_addr = 0x33,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct platform_device s9200_cpld = {
|
||
|
|
.name = "ingrasys-s9200-cpld",
|
||
|
|
.id = 0,
|
||
|
|
.dev = {
|
||
|
|
.platform_data = s9200_cpld_platform_data,
|
||
|
|
.release = device_release
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
/*
|
||
|
|
* S9200 I2C DEVICES
|
||
|
|
*/
|
||
|
|
|
||
|
|
struct i2c_device_platform_data {
|
||
|
|
int parent;
|
||
|
|
struct i2c_board_info info;
|
||
|
|
struct i2c_client *client;
|
||
|
|
};
|
||
|
|
|
||
|
|
/* module_platform_driver */
|
||
|
|
static ssize_t get_cpld_reg(struct device *dev, struct device_attribute *devattr, char *buf, int signal)
|
||
|
|
{
|
||
|
|
int ret;
|
||
|
|
u64 data = 0;
|
||
|
|
u64 shift = 0;
|
||
|
|
int i = 0;
|
||
|
|
int j = 0;
|
||
|
|
int port = 0;
|
||
|
|
int bit = 0;
|
||
|
|
int bit_mask = 0;
|
||
|
|
int (*reg)[CPLD_DEVICE_NUM][2];
|
||
|
|
struct cpld_platform_data *pdata = NULL;
|
||
|
|
|
||
|
|
pdata = dev->platform_data;
|
||
|
|
|
||
|
|
switch(signal) {
|
||
|
|
case sig_int:
|
||
|
|
bit = BIT_INT;
|
||
|
|
reg = (typeof(reg)) &int_abs_reg;
|
||
|
|
break;
|
||
|
|
case sig_abs:
|
||
|
|
bit = BIT_ABS;
|
||
|
|
reg = (typeof(reg)) &int_abs_reg;
|
||
|
|
break;
|
||
|
|
case sig_rst:
|
||
|
|
bit = BIT_RST;
|
||
|
|
reg = (typeof(reg)) &rst_lp_reg;
|
||
|
|
break;
|
||
|
|
case sig_lpm:
|
||
|
|
bit = BIT_LPM;
|
||
|
|
reg = (typeof(reg)) &rst_lp_reg;
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
return sprintf(buf, "na");
|
||
|
|
}
|
||
|
|
bit_mask = 0x1 << bit;
|
||
|
|
|
||
|
|
for (i=0; i<CPLD_DEVICE_NUM; ++i) {
|
||
|
|
for (j = (*reg)[i][0]; j <= (*reg)[i][1]; ++j) {
|
||
|
|
ret = i2c_smbus_read_byte_data(pdata[i].client, j);
|
||
|
|
if (ret < 0) {
|
||
|
|
return sprintf(buf, "na");
|
||
|
|
}
|
||
|
|
shift = ((u64) ((ret & bit_mask) >> bit)) << port;
|
||
|
|
data |= shift;
|
||
|
|
port++;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
return sprintf(buf, "0x%016llx\n", data);
|
||
|
|
}
|
||
|
|
|
||
|
|
static ssize_t set_cpld_reg(struct device *dev, struct device_attribute *devattr, const char *buf, size_t count, int signal)
|
||
|
|
{
|
||
|
|
unsigned long data;
|
||
|
|
int err;
|
||
|
|
struct cpld_platform_data *pdata = dev->platform_data;
|
||
|
|
u8 current_reg_val = 0;
|
||
|
|
u8 new_reg_val = 0;
|
||
|
|
int value;
|
||
|
|
int i = 0;
|
||
|
|
int j = 0;
|
||
|
|
int port = 0;
|
||
|
|
int ret = 0;
|
||
|
|
int bit = 0;
|
||
|
|
int (*reg)[CPLD_DEVICE_NUM][2];
|
||
|
|
|
||
|
|
err = kstrtoul(buf, 16, &data);
|
||
|
|
if (err)
|
||
|
|
return err;
|
||
|
|
|
||
|
|
switch(signal) {
|
||
|
|
case sig_int:
|
||
|
|
bit = BIT_INT;
|
||
|
|
reg = (typeof(reg)) &int_abs_reg;
|
||
|
|
break;
|
||
|
|
case sig_abs:
|
||
|
|
bit = BIT_ABS;
|
||
|
|
reg = (typeof(reg)) &int_abs_reg;
|
||
|
|
break;
|
||
|
|
case sig_rst:
|
||
|
|
bit = BIT_RST;
|
||
|
|
reg = (typeof(reg)) &rst_lp_reg;
|
||
|
|
break;
|
||
|
|
case sig_lpm:
|
||
|
|
bit = BIT_LPM;
|
||
|
|
reg = (typeof(reg)) &rst_lp_reg;
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
return sprintf(buf, "na");
|
||
|
|
}
|
||
|
|
|
||
|
|
for (i=0; i<CPLD_DEVICE_NUM; ++i) {
|
||
|
|
for (j = (*reg)[i][0]; j <= (*reg)[i][1]; ++j) {
|
||
|
|
//read reg value
|
||
|
|
current_reg_val = i2c_smbus_read_byte_data(pdata[i].client, j);
|
||
|
|
if (current_reg_val < 0) {
|
||
|
|
return current_reg_val;
|
||
|
|
}
|
||
|
|
|
||
|
|
//get new value of port N from data
|
||
|
|
value = (data >> port) & 0x1;
|
||
|
|
|
||
|
|
//set value on bit N of new_reg_val
|
||
|
|
if (value > 0) {
|
||
|
|
new_reg_val = current_reg_val | (u8) (0x1 << bit);
|
||
|
|
} else {
|
||
|
|
new_reg_val = current_reg_val & (u8) ~(0x1 << bit);
|
||
|
|
}
|
||
|
|
//write reg value if changed
|
||
|
|
if (current_reg_val != new_reg_val) {
|
||
|
|
ret = i2c_smbus_write_byte_data(pdata[i].client, j,
|
||
|
|
(u8)(new_reg_val));
|
||
|
|
if (ret < 0){
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
port++;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
return count;
|
||
|
|
}
|
||
|
|
|
||
|
|
static ssize_t get_lpmode(struct device *dev, struct device_attribute *devattr, char *buf)
|
||
|
|
{
|
||
|
|
return get_cpld_reg(dev, devattr, buf, sig_lpm);
|
||
|
|
}
|
||
|
|
|
||
|
|
static ssize_t set_lpmode(struct device *dev, struct device_attribute *devattr, const char *buf, size_t count)
|
||
|
|
{
|
||
|
|
return set_cpld_reg(dev, devattr, buf, count, sig_lpm);
|
||
|
|
}
|
||
|
|
|
||
|
|
static ssize_t get_reset(struct device *dev, struct device_attribute *devattr, char *buf)
|
||
|
|
{
|
||
|
|
return get_cpld_reg(dev, devattr, buf, sig_rst);
|
||
|
|
}
|
||
|
|
|
||
|
|
static ssize_t set_reset(struct device *dev, struct device_attribute *devattr, const char *buf, size_t count)
|
||
|
|
{
|
||
|
|
return set_cpld_reg(dev, devattr, buf, count, sig_rst);
|
||
|
|
}
|
||
|
|
|
||
|
|
static ssize_t get_modprs(struct device *dev, struct device_attribute *devattr, char *buf)
|
||
|
|
{
|
||
|
|
return get_cpld_reg(dev, devattr, buf, sig_abs);
|
||
|
|
}
|
||
|
|
|
||
|
|
static ssize_t get_int(struct device *dev, struct device_attribute *devattr, char *buf)
|
||
|
|
{
|
||
|
|
return get_cpld_reg(dev, devattr, buf, sig_int);
|
||
|
|
}
|
||
|
|
|
||
|
|
static ssize_t get_cpld_version(struct device *dev, struct device_attribute *devattr, char *buf)
|
||
|
|
{
|
||
|
|
int i = 0;
|
||
|
|
int cnt = 0;
|
||
|
|
u8 reg_val_rev[CPLD_DEVICE_NUM];
|
||
|
|
u8 reg_val_id[CPLD_DEVICE_NUM];
|
||
|
|
|
||
|
|
struct cpld_platform_data *pdata = dev->platform_data;
|
||
|
|
|
||
|
|
//get reg value
|
||
|
|
for (i=0; i<CPLD_DEVICE_NUM; ++i) {
|
||
|
|
reg_val_rev[i] = i2c_smbus_read_byte_data(pdata[i].client, CPLD_REG_REV);
|
||
|
|
if (reg_val_rev[i] < 0) {
|
||
|
|
return sprintf(buf, "na");
|
||
|
|
}
|
||
|
|
reg_val_id[i] = i2c_smbus_read_byte_data(pdata[i].client, CPLD_REG_ID);
|
||
|
|
if (reg_val_id[i] < 0) {
|
||
|
|
return sprintf(buf, "na");
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
//output reg value
|
||
|
|
for (i=0; i<CPLD_DEVICE_NUM; ++i) {
|
||
|
|
|
||
|
|
cnt += sprintf(buf + cnt,
|
||
|
|
"CPLD[%d]:\n"
|
||
|
|
" [1] Code Revision Bit = %d\n"
|
||
|
|
" [2] Release Bit = %d\n"
|
||
|
|
" [3] ID = %d\n",
|
||
|
|
i,
|
||
|
|
reg_val_rev[i] & 0x1F,
|
||
|
|
reg_val_rev[i] >> 6 & 0x1,
|
||
|
|
reg_val_id[i] & 0x7);
|
||
|
|
}
|
||
|
|
|
||
|
|
return cnt;
|
||
|
|
}
|
||
|
|
|
||
|
|
static ssize_t set_10g_mux(struct device *dev, struct device_attribute *devattr, const char *buf, size_t count)
|
||
|
|
{
|
||
|
|
u8 data;
|
||
|
|
u8 current_reg_val = 0;
|
||
|
|
u8 new_reg_val = 0;
|
||
|
|
int cpld_dev_num=cpld_1;
|
||
|
|
int reg_offset=CPLD_REG_10G_MUX;
|
||
|
|
int err;
|
||
|
|
struct cpld_platform_data *pdata = dev->platform_data;
|
||
|
|
int value;
|
||
|
|
int i = 0;
|
||
|
|
int port = 0;
|
||
|
|
int ret = 0;
|
||
|
|
int bit = 0;
|
||
|
|
|
||
|
|
err = kstrtou8(buf, 16, &new_reg_val);
|
||
|
|
if (err)
|
||
|
|
return err;
|
||
|
|
|
||
|
|
//read reg value
|
||
|
|
current_reg_val = i2c_smbus_read_byte_data(pdata[cpld_dev_num].client, reg_offset);
|
||
|
|
if (current_reg_val < 0) {
|
||
|
|
return current_reg_val;
|
||
|
|
}
|
||
|
|
|
||
|
|
//write reg value if changed
|
||
|
|
if (current_reg_val != new_reg_val) {
|
||
|
|
ret = i2c_smbus_write_byte_data(pdata[cpld_dev_num].client, reg_offset,
|
||
|
|
(u8)(new_reg_val));
|
||
|
|
if (ret < 0){
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
return count;
|
||
|
|
}
|
||
|
|
|
||
|
|
static ssize_t get_10g_mux(struct device *dev, struct device_attribute *devattr, char *buf)
|
||
|
|
{
|
||
|
|
int cpld_dev_num=cpld_1;
|
||
|
|
int reg_offset=CPLD_REG_10G_MUX;
|
||
|
|
u8 reg_val=0;
|
||
|
|
struct cpld_platform_data *pdata = dev->platform_data;
|
||
|
|
|
||
|
|
//read 10G mux register
|
||
|
|
reg_val = i2c_smbus_read_byte_data(pdata[cpld_dev_num].client, reg_offset);
|
||
|
|
if (reg_val < 0) {
|
||
|
|
return sprintf(buf, "na");
|
||
|
|
}
|
||
|
|
|
||
|
|
return sprintf(buf, "0x%x\n", reg_val);
|
||
|
|
}
|
||
|
|
|
||
|
|
static DEVICE_ATTR(qsfp_int, S_IRUGO, get_int, NULL);
|
||
|
|
static DEVICE_ATTR(qsfp_modprs, S_IRUGO, get_modprs, NULL);
|
||
|
|
static DEVICE_ATTR(qsfp_lpmode, S_IRUGO | S_IWUSR, get_lpmode, set_lpmode);
|
||
|
|
static DEVICE_ATTR(qsfp_reset, S_IRUGO | S_IWUSR, get_reset, set_reset);
|
||
|
|
static DEVICE_ATTR(cpld_version, S_IRUGO, get_cpld_version, NULL);
|
||
|
|
static DEVICE_ATTR(cpld_10g_mux, S_IRUGO | S_IWUSR, get_10g_mux, set_10g_mux);
|
||
|
|
|
||
|
|
static struct attribute *s9200_cpld_attrs[] = {
|
||
|
|
&dev_attr_qsfp_int.attr,
|
||
|
|
&dev_attr_qsfp_lpmode.attr,
|
||
|
|
&dev_attr_qsfp_reset.attr,
|
||
|
|
&dev_attr_qsfp_modprs.attr,
|
||
|
|
&dev_attr_cpld_version.attr,
|
||
|
|
&dev_attr_cpld_10g_mux.attr,
|
||
|
|
NULL,
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct attribute_group s9200_cpld_attr_grp = {
|
||
|
|
.attrs = s9200_cpld_attrs,
|
||
|
|
};
|
||
|
|
|
||
|
|
static int __init cpld_probe(struct platform_device *pdev)
|
||
|
|
{
|
||
|
|
struct cpld_platform_data *pdata;
|
||
|
|
struct i2c_adapter *parent[CPLD_DEVICE_NUM];
|
||
|
|
int i;
|
||
|
|
int ret;
|
||
|
|
|
||
|
|
pdata = pdev->dev.platform_data;
|
||
|
|
if (!pdata) {
|
||
|
|
dev_err(&pdev->dev, "Missing platform data\n");
|
||
|
|
return -ENODEV;
|
||
|
|
}
|
||
|
|
|
||
|
|
for (i = 0; i < CPLD_DEVICE_NUM; i++) {
|
||
|
|
parent[i] = i2c_get_adapter(S9200_MUX_BASE_NR + i + 1);
|
||
|
|
if (!parent[i]) {
|
||
|
|
printk(KERN_WARNING "Parent adapter (%d) not found\n",
|
||
|
|
S9200_MUX_BASE_NR + i + 1);
|
||
|
|
return -ENODEV;
|
||
|
|
}
|
||
|
|
pdata[i].client = i2c_new_dummy(parent[i], pdata[i].reg_addr);
|
||
|
|
if (!pdata[i].client) {
|
||
|
|
printk(KERN_WARNING "Fail to create dummy i2c client for addr %d\n", pdata[i].reg_addr);
|
||
|
|
goto error;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
ret = sysfs_create_group(&pdev->dev.kobj, &s9200_cpld_attr_grp);
|
||
|
|
if (ret)
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
|
||
|
|
error:
|
||
|
|
i2c_put_adapter(parent[i]);
|
||
|
|
i--;
|
||
|
|
for (; i >= 0; i--) {
|
||
|
|
if (pdata[i].client) {
|
||
|
|
i2c_unregister_device(pdata[i].client);
|
||
|
|
i2c_put_adapter(parent[i]);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
return -ENODEV;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int __exit cpld_remove(struct platform_device *pdev)
|
||
|
|
{
|
||
|
|
int i;
|
||
|
|
struct i2c_adapter *parent = NULL;
|
||
|
|
struct cpld_platform_data *pdata = pdev->dev.platform_data;
|
||
|
|
|
||
|
|
sysfs_remove_group(&pdev->dev.kobj, &s9200_cpld_attr_grp);
|
||
|
|
|
||
|
|
if (!pdata) {
|
||
|
|
dev_err(&pdev->dev, "Missing platform data\n");
|
||
|
|
} else {
|
||
|
|
for (i = 0; i < CPLD_DEVICE_NUM; i++) {
|
||
|
|
if (pdata[i].client) {
|
||
|
|
parent = (pdata[i].client)->adapter;
|
||
|
|
i2c_unregister_device(pdata[i].client);
|
||
|
|
i2c_put_adapter(parent);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static struct platform_driver cpld_driver = {
|
||
|
|
.probe = cpld_probe,
|
||
|
|
.remove = __exit_p(cpld_remove),
|
||
|
|
.driver = {
|
||
|
|
.owner = THIS_MODULE,
|
||
|
|
.name = "ingrasys-s9200-cpld",
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static int __init ingrasys_s9200_platform_init(void)
|
||
|
|
{
|
||
|
|
int ret = 0;
|
||
|
|
|
||
|
|
printk("ingrasysl_s9200_platform module initialization\n");
|
||
|
|
|
||
|
|
mdelay(10000);
|
||
|
|
|
||
|
|
ret = platform_driver_register(&cpld_driver);
|
||
|
|
if (ret) {
|
||
|
|
printk(KERN_WARNING "Fail to register cpld driver\n");
|
||
|
|
goto error_cpld_driver;
|
||
|
|
}
|
||
|
|
ret = platform_device_register(&s9200_cpld);
|
||
|
|
if (ret) {
|
||
|
|
printk(KERN_WARNING "Fail to create cpld device\n");
|
||
|
|
goto error_cpld;
|
||
|
|
}
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
|
||
|
|
error_cpld:
|
||
|
|
platform_driver_unregister(&cpld_driver);
|
||
|
|
error_cpld_driver:
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void __exit ingrasys_s9200_platform_exit(void)
|
||
|
|
{
|
||
|
|
platform_device_unregister(&s9200_cpld);
|
||
|
|
platform_driver_unregister(&cpld_driver);
|
||
|
|
}
|
||
|
|
|
||
|
|
module_init(ingrasys_s9200_platform_init);
|
||
|
|
module_exit(ingrasys_s9200_platform_exit);
|
||
|
|
|
||
|
|
MODULE_DESCRIPTION("Ingrasys S9200 Platform Support");
|
||
|
|
MODULE_AUTHOR("Jason Tsai <feng.cf.lee@ingrasys.com>");
|
||
|
|
MODULE_LICENSE("GPL");
|