generic: rtl8366: introduce rtl8366_smi_ops
git-svn-id: svn://svn.openwrt.org/openwrt/trunk@21910 3c298f89-4303-0410-b956-a3cf2f4a3e73master
parent
b481092d7e
commit
f7f98477b9
|
@ -272,6 +272,9 @@ int rtl8366_smi_init(struct rtl8366_smi *smi)
|
|||
if (!smi->parent)
|
||||
return -EINVAL;
|
||||
|
||||
if (!smi->ops)
|
||||
return -EINVAL;
|
||||
|
||||
err = gpio_request(smi->gpio_sda, dev_name(smi->parent));
|
||||
if (err) {
|
||||
dev_err(smi->parent, "gpio_request failed for %u, err=%d\n",
|
||||
|
@ -291,8 +294,16 @@ int rtl8366_smi_init(struct rtl8366_smi *smi)
|
|||
dev_info(smi->parent, "using GPIO pins %u (SDA) and %u (SCK)\n",
|
||||
smi->gpio_sda, smi->gpio_sck);
|
||||
|
||||
err = smi->ops->detect(smi);
|
||||
if (err) {
|
||||
dev_err(smi->parent, "chip detection failed, err=%d\n", err);
|
||||
goto err_free_sck;
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
err_free_sck:
|
||||
gpio_free(smi->gpio_sck);
|
||||
err_free_sda:
|
||||
gpio_free(smi->gpio_sda);
|
||||
err_out:
|
||||
|
|
|
@ -11,11 +11,19 @@
|
|||
#ifndef _RTL8366_SMI_H
|
||||
#define _RTL8366_SMI_H
|
||||
|
||||
struct rtl8366_smi_ops;
|
||||
|
||||
struct rtl8366_smi {
|
||||
struct device *parent;
|
||||
unsigned int gpio_sda;
|
||||
unsigned int gpio_sck;
|
||||
spinlock_t lock;
|
||||
|
||||
struct rtl8366_smi_ops *ops;
|
||||
};
|
||||
|
||||
struct rtl8366_smi_ops {
|
||||
int (*detect)(struct rtl8366_smi *smi);
|
||||
};
|
||||
|
||||
int rtl8366_smi_init(struct rtl8366_smi *smi);
|
||||
|
|
|
@ -26,7 +26,7 @@
|
|||
#endif
|
||||
|
||||
#define RTL8366S_DRIVER_DESC "Realtek RTL8366RB ethernet switch driver"
|
||||
#define RTL8366S_DRIVER_VER "0.2.0"
|
||||
#define RTL8366S_DRIVER_VER "0.2.2"
|
||||
|
||||
#define RTL8366S_PHY_NO_MAX 4
|
||||
#define RTL8366S_PHY_PAGE_MAX 7
|
||||
|
@ -1573,35 +1573,8 @@ static int rtl8366rb_mii_bus_match(struct mii_bus *bus)
|
|||
|
||||
static int rtl8366rb_setup(struct rtl8366rb *rtl)
|
||||
{
|
||||
struct rtl8366_smi *smi = &rtl->smi;
|
||||
u32 chip_id = 0;
|
||||
u32 chip_ver = 0;
|
||||
int ret;
|
||||
|
||||
ret = rtl8366_smi_read_reg(smi, RTL8366S_CHIP_ID_REG, &chip_id);
|
||||
if (ret) {
|
||||
dev_err(rtl->parent, "unable to read chip id\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
switch (chip_id) {
|
||||
case RTL8366S_CHIP_ID_8366:
|
||||
break;
|
||||
default:
|
||||
dev_err(rtl->parent, "unknown chip id (%04x)\n", chip_id);
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
ret = rtl8366_smi_read_reg(smi, RTL8366S_CHIP_VERSION_CTRL_REG,
|
||||
&chip_ver);
|
||||
if (ret) {
|
||||
dev_err(rtl->parent, "unable to read chip version\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
dev_info(rtl->parent, "RTL%04x ver. %u chip found\n",
|
||||
chip_id, chip_ver & RTL8366S_CHIP_VERSION_MASK);
|
||||
|
||||
ret = rtl8366rb_reset_chip(rtl);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
@ -1610,6 +1583,43 @@ static int rtl8366rb_setup(struct rtl8366rb *rtl)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static int rtl8366rb_detect(struct rtl8366_smi *smi)
|
||||
{
|
||||
u32 chip_id = 0;
|
||||
u32 chip_ver = 0;
|
||||
int ret;
|
||||
|
||||
ret = rtl8366_smi_read_reg(smi, RTL8366S_CHIP_ID_REG, &chip_id);
|
||||
if (ret) {
|
||||
dev_err(smi->parent, "unable to read chip id\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
switch (chip_id) {
|
||||
case RTL8366S_CHIP_ID_8366:
|
||||
break;
|
||||
default:
|
||||
dev_err(smi->parent, "unknown chip id (%04x)\n", chip_id);
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
ret = rtl8366_smi_read_reg(smi, RTL8366S_CHIP_VERSION_CTRL_REG,
|
||||
&chip_ver);
|
||||
if (ret) {
|
||||
dev_err(smi->parent, "unable to read chip version\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
dev_info(smi->parent, "RTL%04x ver. %u chip found\n",
|
||||
chip_id, chip_ver & RTL8366S_CHIP_VERSION_MASK);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct rtl8366_smi_ops rtl8366rb_smi_ops = {
|
||||
.detect = rtl8366rb_detect,
|
||||
};
|
||||
|
||||
static int __init rtl8366rb_probe(struct platform_device *pdev)
|
||||
{
|
||||
static int rtl8366_smi_version_printed;
|
||||
|
@ -1642,6 +1652,7 @@ static int __init rtl8366rb_probe(struct platform_device *pdev)
|
|||
smi->parent = &pdev->dev;
|
||||
smi->gpio_sda = pdata->gpio_sda;
|
||||
smi->gpio_sck = pdata->gpio_sck;
|
||||
smi->ops = &rtl8366rb_smi_ops;
|
||||
|
||||
err = rtl8366_smi_init(smi);
|
||||
if (err)
|
||||
|
|
|
@ -26,7 +26,7 @@
|
|||
#endif
|
||||
|
||||
#define RTL8366S_DRIVER_DESC "Realtek RTL8366S ethernet switch driver"
|
||||
#define RTL8366S_DRIVER_VER "0.2.1"
|
||||
#define RTL8366S_DRIVER_VER "0.2.2"
|
||||
|
||||
#define RTL8366S_PHY_NO_MAX 4
|
||||
#define RTL8366S_PHY_PAGE_MAX 7
|
||||
|
@ -1542,35 +1542,8 @@ static int rtl8366s_mii_bus_match(struct mii_bus *bus)
|
|||
|
||||
static int rtl8366s_setup(struct rtl8366s *rtl)
|
||||
{
|
||||
struct rtl8366_smi *smi = &rtl->smi;
|
||||
u32 chip_id = 0;
|
||||
u32 chip_ver = 0;
|
||||
int ret;
|
||||
|
||||
ret = rtl8366_smi_read_reg(smi, RTL8366S_CHIP_ID_REG, &chip_id);
|
||||
if (ret) {
|
||||
dev_err(rtl->parent, "unable to read chip id\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
switch (chip_id) {
|
||||
case RTL8366S_CHIP_ID_8366:
|
||||
break;
|
||||
default:
|
||||
dev_err(rtl->parent, "unknown chip id (%04x)\n", chip_id);
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
ret = rtl8366_smi_read_reg(smi, RTL8366S_CHIP_VERSION_CTRL_REG,
|
||||
&chip_ver);
|
||||
if (ret) {
|
||||
dev_err(rtl->parent, "unable to read chip version\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
dev_info(rtl->parent, "RTL%04x ver. %u chip found\n",
|
||||
chip_id, chip_ver & RTL8366S_CHIP_VERSION_MASK);
|
||||
|
||||
ret = rtl8366s_reset_chip(rtl);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
@ -1579,6 +1552,43 @@ static int rtl8366s_setup(struct rtl8366s *rtl)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static int rtl8366s_detect(struct rtl8366_smi *smi)
|
||||
{
|
||||
u32 chip_id = 0;
|
||||
u32 chip_ver = 0;
|
||||
int ret;
|
||||
|
||||
ret = rtl8366_smi_read_reg(smi, RTL8366S_CHIP_ID_REG, &chip_id);
|
||||
if (ret) {
|
||||
dev_err(smi->parent, "unable to read chip id\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
switch (chip_id) {
|
||||
case RTL8366S_CHIP_ID_8366:
|
||||
break;
|
||||
default:
|
||||
dev_err(smi->parent, "unknown chip id (%04x)\n", chip_id);
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
ret = rtl8366_smi_read_reg(smi, RTL8366S_CHIP_VERSION_CTRL_REG,
|
||||
&chip_ver);
|
||||
if (ret) {
|
||||
dev_err(smi->parent, "unable to read chip version\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
dev_info(smi->parent, "RTL%04x ver. %u chip found\n",
|
||||
chip_id, chip_ver & RTL8366S_CHIP_VERSION_MASK);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct rtl8366_smi_ops rtl8366s_smi_ops = {
|
||||
.detect = rtl8366s_detect,
|
||||
};
|
||||
|
||||
static int __init rtl8366s_probe(struct platform_device *pdev)
|
||||
{
|
||||
static int rtl8366_smi_version_printed;
|
||||
|
@ -1611,6 +1621,7 @@ static int __init rtl8366s_probe(struct platform_device *pdev)
|
|||
smi->parent = &pdev->dev;
|
||||
smi->gpio_sda = pdata->gpio_sda;
|
||||
smi->gpio_sck = pdata->gpio_sck;
|
||||
smi->ops = &rtl8366s_smi_ops;
|
||||
|
||||
err = rtl8366_smi_init(smi);
|
||||
if (err)
|
||||
|
|
Loading…
Reference in New Issue