FPGA/corundum
1
0
Fork 0
mirror of https://github.com/corundum/corundum.git synced 2025-01-16 08:12:53 +08:00
Code Issues Projects Releases Wiki Activity

Add mqnic_create_i2c_adapter method

Browse Source
This commit is contained in:
Alex Forencich 2020-09-19 17:00:39 -07:00
parent 70b7082fb6
commit a46cb33b69
3 changed files with 64 additions and 32 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
modules/mqnic/mqnic.h
View File

@ -105,13 +105,11 @@ struct mqnic_dev {
struct ptp_clock *ptp_clock;
struct ptp_clock_info ptp_clock_info;
struct i2c_algo_bit_data if_i2c_algo[MQNIC_MAX_IF];
struct i2c_adapter if_i2c_adap[MQNIC_MAX_IF];
struct mqnic_i2c_priv if_i2c_priv[MQNIC_MAX_IF];
int i2c_adapter_count;
struct i2c_algo_bit_data i2c_algo[MQNIC_MAX_I2C_ADAPTERS];
struct i2c_adapter i2c_adapter[MQNIC_MAX_I2C_ADAPTERS];
struct mqnic_i2c_priv i2c_priv[MQNIC_MAX_I2C_ADAPTERS];
struct i2c_algo_bit_data eeprom_i2c_algo;
struct i2c_adapter eeprom_i2c_adap;
struct mqnic_i2c_priv eeprom_i2c_priv;
struct i2c_client *eeprom_i2c_client;
};

2
modules/mqnic/mqnic_hw.h
View File

@ -48,6 +48,8 @@ either expressed or implied, of The Regents of the University of California.
#define MQNIC_MAX_RX_RINGS 8192
#define MQNIC_MAX_RX_CPL_RINGS 8192
#define MQNIC_MAX_I2C_ADAPTERS 4
#define MQNIC_BOARD_ID_NETFPGA_SUME 0x10ee7028
#define MQNIC_BOARD_ID_AU50 0x10ee9032
#define MQNIC_BOARD_ID_AU200 0x10ee90c8

82
modules/mqnic/mqnic_i2c.c
View File

@ -110,8 +110,52 @@ static struct i2c_client *create_i2c_client(struct i2c_adapter *adapter, const c
return client;
}
static struct i2c_adapter *mqnic_create_i2c_adapter(struct mqnic_dev *mqnic, u8 __iomem *reg)
{
struct i2c_algo_bit_data *algo;
struct i2c_adapter *adapter;
struct mqnic_i2c_priv *priv;
if (mqnic->i2c_adapter_count >= MQNIC_MAX_I2C_ADAPTERS || !reg)
return NULL;
algo = &mqnic->i2c_algo[mqnic->i2c_adapter_count];
adapter = &mqnic->i2c_adapter[mqnic->i2c_adapter_count];
priv = &mqnic->i2c_priv[mqnic->i2c_adapter_count];
priv->mqnic = mqnic;
priv->scl_in_reg = reg;
priv->scl_out_reg = reg;
priv->sda_in_reg = reg;
priv->sda_out_reg = reg;
priv->scl_in_mask = MQNIC_REG_GPIO_I2C_SCL_IN;
priv->scl_out_mask = MQNIC_REG_GPIO_I2C_SCL_OUT;
priv->sda_in_mask = MQNIC_REG_GPIO_I2C_SDA_IN;
priv->sda_out_mask = MQNIC_REG_GPIO_I2C_SDA_OUT;
*algo = mqnic_i2c_algo;
algo->data = priv;
adapter->owner = THIS_MODULE;
adapter->algo_data = algo;
adapter->dev.parent = mqnic->dev;
snprintf(adapter->name, sizeof(adapter->name), "%s I2C%d", mqnic->name, mqnic->i2c_adapter_count);
if (i2c_bit_add_bus(adapter))
{
dev_err(mqnic->dev, "Failed to register I2C adapter");
memset(adapter, 0, sizeof(*adapter));
return NULL;
}
mqnic->i2c_adapter_count++;
return adapter;
}
int mqnic_init_i2c(struct mqnic_dev *mqnic)
{
struct i2c_adapter *adapter;
int ret = 0;
// interface i2c interfaces
// TODO
@ -121,30 +165,12 @@ int mqnic_init_i2c(struct mqnic_dev *mqnic)
case MQNIC_BOARD_ID_EXANIC_X10:
case MQNIC_BOARD_ID_EXANIC_X25:
case MQNIC_BOARD_ID_ADM_PCIE_9V3:
mqnic->eeprom_i2c_adap.owner = THIS_MODULE;
mqnic->eeprom_i2c_priv.mqnic = mqnic;
mqnic->eeprom_i2c_priv.scl_in_reg = mqnic->hw_addr+MQNIC_REG_GPIO_IN;
mqnic->eeprom_i2c_priv.scl_out_reg = mqnic->hw_addr+MQNIC_REG_GPIO_OUT;
mqnic->eeprom_i2c_priv.sda_in_reg = mqnic->hw_addr+MQNIC_REG_GPIO_IN;
mqnic->eeprom_i2c_priv.sda_out_reg = mqnic->hw_addr+MQNIC_REG_GPIO_OUT;
mqnic->eeprom_i2c_priv.scl_in_mask = 1 << 24;
mqnic->eeprom_i2c_priv.scl_out_mask = 1 << 24;
mqnic->eeprom_i2c_priv.sda_in_mask = 1 << 25;
mqnic->eeprom_i2c_priv.sda_out_mask = 1 << 25;
mqnic->eeprom_i2c_algo = mqnic_i2c_algo;
mqnic->eeprom_i2c_algo.data = &mqnic->eeprom_i2c_priv;
mqnic->eeprom_i2c_adap.algo_data = &mqnic->eeprom_i2c_algo;
mqnic->eeprom_i2c_adap.dev.parent = mqnic->dev;
iowrite32(ioread32(mqnic->hw_addr+MQNIC_REG_GPIO_OUT) & ~(1 << 26), mqnic->hw_addr+MQNIC_REG_GPIO_OUT); // WP disable
strlcpy(mqnic->eeprom_i2c_adap.name, "mqnic EEPROM", sizeof(mqnic->eeprom_i2c_adap.name));
ret = i2c_bit_add_bus(&mqnic->eeprom_i2c_adap);
if (ret)
{
return ret;
}
// create I2C adapter
adapter = mqnic_create_i2c_adapter(mqnic, mqnic->hw_addr+MQNIC_REG_GPIO_I2C_1);
// I2C EEPROM
mqnic->eeprom_i2c_client = create_i2c_client(&mqnic->eeprom_i2c_adap, "24c02", 0x50, NULL);
mqnic->eeprom_i2c_client = create_i2c_client(adapter, "24c02", 0x50, NULL);
break;
}
@ -154,6 +180,8 @@ int mqnic_init_i2c(struct mqnic_dev *mqnic)
void mqnic_remove_i2c(struct mqnic_dev *mqnic)
{
int k;
// eeprom i2c interface
if (mqnic->eeprom_i2c_client)
{
@ -161,12 +189,16 @@ void mqnic_remove_i2c(struct mqnic_dev *mqnic)
mqnic->eeprom_i2c_client = NULL;
}
if (mqnic->eeprom_i2c_adap.owner)
// delete adapters
for (k = 0; k < ARRAY_SIZE(mqnic->i2c_adapter); k++)
{
i2c_del_adapter(&mqnic->eeprom_i2c_adap);
if (mqnic->i2c_adapter[k].owner)
{
i2c_del_adapter(&mqnic->i2c_adapter[k]);
}
memset(&mqnic->eeprom_i2c_adap, 0, sizeof(mqnic->eeprom_i2c_adap));
memset(&mqnic->i2c_adapter[k], 0, sizeof(mqnic->i2c_adapter[k]));
}
}