最新在设计marvell公司的mv88e6390 交换机,在实现其驱动时感觉mdio读写reg时用到了三种读读写时序,看了不少文档,请助了不少同仁,最终实现并验证读写ok,现在总结一下,让后来的方便理解和使用;
1.直接寻址:基于mdio clause 22: 5bit dev addr+5bit reg addr,每个reg16bit;
2.间接寻址:分两种:
2.1:基于mdio clause 22:
static int mv88e6xxx_mdio_read_indirect_cls22(struct mv88e6xxx_priv_state *ps,
int addr, int regnum)
{
int ret;
ret = _mv88e6xxx_reg_write(ps, REG_GLOBAL2, GLOBAL2_SMI_OP,
GLOBAL2_SMI_OP_22_READ | (addr << 5) |
regnum);
if (ret < 0)
return ret;
ret = mv88e6xxx_mdio_wait(ps);
if (ret < 0)
return ret;
ret = _mv88e6xxx_reg_read(ps, REG_GLOBAL2, GLOBAL2_SMI_DATA);
return ret;
}
static int mv88e6xxx_mdio_write_indirect_cls22(struct mv88e6xxx_priv_state *ps,
int addr, int regnum, u16 val)
{
int ret;
ret = _mv88e6xxx_reg_write(ps, REG_GLOBAL2, GLOBAL2_SMI_DATA, val);
if (ret < 0)
return ret;
ret = _mv88e6xxx_reg_write(ps, REG_GLOBAL2, GLOBAL2_SMI_OP,
GLOBAL2_SMI_OP_22_WRITE | (addr << 5) |
regnum);
return mv88e6xxx_mdio_wait(ps);
}
2.2 :基于mdio clause 45:
static int mv88e6xxx_mdio_read_indirect_cls45(struct mv88e6xxx_priv_state *ps,
int addr, int regnum)
{
int ret,cmd_data;
ret = _mv88e6xxx_reg_write(ps, REG_GLOBAL2, GLOBAL2_SMI_DATA, regnum);
if (ret < 0)
return ret;
cmd_data = (1 << MV_SMIBUSY_OFFSET) | (0 << MV_SMIFUNC_OFFSET) |
(0 << MV_SMIMODE_OFFSET) | (0 << MV_SMIOP_OFFSET) |
(((addr>>5) & MV_DEVAD_MASK) << MV_DEVAD_OFFSET) | ((addr & MV_REGAD_MASK) << MV_REGAD_OFFSET);
ret = _mv88e6xxx_reg_write(ps, REG_GLOBAL2, GLOBAL2_SMI_OP,cmd_data);
if (ret < 0)
return ret;
ret = mv88e6xxx_mdio_wait(ps);
if (ret < 0)
return ret;
cmd_data = (1 << MV_SMIBUSY_OFFSET) | (0 << MV_SMIFUNC_OFFSET) |
(0 << MV_SMIMODE_OFFSET) | (3 << MV_SMIOP_OFFSET) |
(((addr>>5) & MV_DEVAD_MASK) << MV_DEVAD_OFFSET) | ((addr & MV_REGAD_MASK) << MV_REGAD_OFFSET);
ret = _mv88e6xxx_reg_write(ps, REG_GLOBAL2, GLOBAL2_SMI_OP,cmd_data);
ret = _mv88e6xxx_reg_read(ps, REG_GLOBAL2, GLOBAL2_SMI_DATA);
return ret;
}
static int mv88e6xxx_mdio_write_indirect_cls45(struct mv88e6xxx_priv_state *ps,
int addr, int regnum, u16 val)
{
int ret,cmd_data;
ret = _mv88e6xxx_reg_write(ps, REG_GLOBAL2, GLOBAL2_SMI_DATA, regnum);
if (ret < 0)
return ret;
cmd_data = (1 << MV_SMIBUSY_OFFSET) | (0 << MV_SMIFUNC_OFFSET) |
(0 << MV_SMIMODE_OFFSET) | (0 << MV_SMIOP_OFFSET) |
(((addr>>5) & MV_DEVAD_MASK) << MV_DEVAD_OFFSET) | ((addr & MV_REGAD_MASK) << MV_REGAD_OFFSET);
ret = _mv88e6xxx_reg_write(ps, REG_GLOBAL2, GLOBAL2_SMI_OP,cmd_data);
if (ret < 0)
return ret;
ret = mv88e6xxx_mdio_wait(ps);
if (ret < 0)
return ret;
ret = _mv88e6xxx_reg_write(ps, REG_GLOBAL2, GLOBAL2_SMI_DATA, val);
cmd_data = (1 << MV_SMIBUSY_OFFSET) | (0 << MV_SMIFUNC_OFFSET) |
(0 << MV_SMIMODE_OFFSET) | (1 << MV_SMIOP_OFFSET) |
(((addr>>5) & MV_DEVAD_MASK) << MV_DEVAD_OFFSET) | ((addr & MV_REGAD_MASK) << MV_REGAD_OFFSET);
ret = _mv88e6xxx_reg_write(ps, REG_GLOBAL2, GLOBAL2_SMI_OP,cmd_data);
if (ret < 0)
return ret;
return mv88e6xxx_mdio_wait(ps);
}