mirror of
git://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
synced 2025-08-05 16:54:27 +00:00
ee00b24f32
Add a driver with initial support for the Arrow SpeedChips XRS7000 series of gigabit Ethernet switch chips which are typically used in critical networking applications. The switches have up to three RGMII ports and one RMII port. Management to the switches can be performed over i2c or mdio. Support for advanced features such as PTP and HSR/PRP (IEC 62439-3 Clause 5 & 4) is not included in this patch and may be added at a later date. Signed-off-by: George McCollister <george.mccollister@gmail.com> Reviewed-by: Florian Fainelli <f.fainelli@gmail.com> Reviewed-by: Andrew Lunn <andrew@lunn.ch> Reviewed-by: Vladimir Oltean <olteanv@gmail.com> Signed-off-by: Jakub Kicinski <kuba@kernel.org>
150 lines
3.4 KiB
C
150 lines
3.4 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* Copyright (C) 2020 NovaTech LLC
|
|
* George McCollister <george.mccollister@gmail.com>
|
|
*/
|
|
|
|
#include <linux/bits.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/module.h>
|
|
#include "xrs700x.h"
|
|
#include "xrs700x_reg.h"
|
|
|
|
static int xrs700x_i2c_reg_read(void *context, unsigned int reg,
|
|
unsigned int *val)
|
|
{
|
|
struct device *dev = context;
|
|
struct i2c_client *i2c = to_i2c_client(dev);
|
|
unsigned char buf[4];
|
|
int ret;
|
|
|
|
buf[0] = reg >> 23 & 0xff;
|
|
buf[1] = reg >> 15 & 0xff;
|
|
buf[2] = reg >> 7 & 0xff;
|
|
buf[3] = (reg & 0x7f) << 1;
|
|
|
|
ret = i2c_master_send(i2c, buf, sizeof(buf));
|
|
if (ret < 0) {
|
|
dev_err(dev, "xrs i2c_master_send returned %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
ret = i2c_master_recv(i2c, buf, 2);
|
|
if (ret < 0) {
|
|
dev_err(dev, "xrs i2c_master_recv returned %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
*val = buf[0] << 8 | buf[1];
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int xrs700x_i2c_reg_write(void *context, unsigned int reg,
|
|
unsigned int val)
|
|
{
|
|
struct device *dev = context;
|
|
struct i2c_client *i2c = to_i2c_client(dev);
|
|
unsigned char buf[6];
|
|
int ret;
|
|
|
|
buf[0] = reg >> 23 & 0xff;
|
|
buf[1] = reg >> 15 & 0xff;
|
|
buf[2] = reg >> 7 & 0xff;
|
|
buf[3] = (reg & 0x7f) << 1 | 1;
|
|
buf[4] = val >> 8 & 0xff;
|
|
buf[5] = val & 0xff;
|
|
|
|
ret = i2c_master_send(i2c, buf, sizeof(buf));
|
|
if (ret < 0) {
|
|
dev_err(dev, "xrs i2c_master_send returned %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct regmap_config xrs700x_i2c_regmap_config = {
|
|
.val_bits = 16,
|
|
.reg_stride = 2,
|
|
.reg_bits = 32,
|
|
.pad_bits = 0,
|
|
.write_flag_mask = 0,
|
|
.read_flag_mask = 0,
|
|
.reg_read = xrs700x_i2c_reg_read,
|
|
.reg_write = xrs700x_i2c_reg_write,
|
|
.max_register = 0,
|
|
.cache_type = REGCACHE_NONE,
|
|
.reg_format_endian = REGMAP_ENDIAN_BIG,
|
|
.val_format_endian = REGMAP_ENDIAN_BIG
|
|
};
|
|
|
|
static int xrs700x_i2c_probe(struct i2c_client *i2c,
|
|
const struct i2c_device_id *i2c_id)
|
|
{
|
|
struct xrs700x *priv;
|
|
int ret;
|
|
|
|
priv = xrs700x_switch_alloc(&i2c->dev, i2c);
|
|
if (!priv)
|
|
return -ENOMEM;
|
|
|
|
priv->regmap = devm_regmap_init(&i2c->dev, NULL, &i2c->dev,
|
|
&xrs700x_i2c_regmap_config);
|
|
if (IS_ERR(priv->regmap)) {
|
|
ret = PTR_ERR(priv->regmap);
|
|
dev_err(&i2c->dev, "Failed to initialize regmap: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
i2c_set_clientdata(i2c, priv);
|
|
|
|
ret = xrs700x_switch_register(priv);
|
|
|
|
/* Main DSA driver may not be started yet. */
|
|
if (ret)
|
|
return ret;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int xrs700x_i2c_remove(struct i2c_client *i2c)
|
|
{
|
|
struct xrs700x *priv = i2c_get_clientdata(i2c);
|
|
|
|
xrs700x_switch_remove(priv);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct i2c_device_id xrs700x_i2c_id[] = {
|
|
{ "xrs700x-switch", 0 },
|
|
{},
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(i2c, xrs700x_i2c_id);
|
|
|
|
static const struct of_device_id xrs700x_i2c_dt_ids[] = {
|
|
{ .compatible = "arrow,xrs7003e", .data = &xrs7003e_info },
|
|
{ .compatible = "arrow,xrs7003f", .data = &xrs7003f_info },
|
|
{ .compatible = "arrow,xrs7004e", .data = &xrs7004e_info },
|
|
{ .compatible = "arrow,xrs7004f", .data = &xrs7004f_info },
|
|
{},
|
|
};
|
|
MODULE_DEVICE_TABLE(of, xrs700x_i2c_dt_ids);
|
|
|
|
static struct i2c_driver xrs700x_i2c_driver = {
|
|
.driver = {
|
|
.name = "xrs700x-i2c",
|
|
.of_match_table = of_match_ptr(xrs700x_i2c_dt_ids),
|
|
},
|
|
.probe = xrs700x_i2c_probe,
|
|
.remove = xrs700x_i2c_remove,
|
|
.id_table = xrs700x_i2c_id,
|
|
};
|
|
|
|
module_i2c_driver(xrs700x_i2c_driver);
|
|
|
|
MODULE_AUTHOR("George McCollister <george.mccollister@gmail.com>");
|
|
MODULE_DESCRIPTION("Arrow SpeedChips XRS700x DSA I2C driver");
|
|
MODULE_LICENSE("GPL v2");
|