#include "cphy.h"
#include "elmer0.h"
#define MV88x2010_LINK_STATUS_BUGS 1
static int led_init(struct cphy *cphy)
{
(void) mdio_write(cphy, 0x3, 0x8304, 0xdddd);
return 0;
}
static int led_link(struct cphy *cphy, u32 do_enable)
{
u32 led = 0;
#define LINK_ENABLE_BIT 0x1
(void) mdio_read(cphy, 0x1, 0x7, &led);
if (do_enable & LINK_ENABLE_BIT) {
led |= LINK_ENABLE_BIT;
(void) mdio_write(cphy, 0x1, 0x7, led);
} else {
led &= ~LINK_ENABLE_BIT;
(void) mdio_write(cphy, 0x1, 0x7, led);
}
return 0;
}
static int mv88x201x_reset(struct cphy *cphy, int wait)
{
return 0;
}
static int mv88x201x_interrupt_enable(struct cphy *cphy)
{
(void) mdio_write(cphy, 0x1, 0x9002, 0x1);
if (t1_is_asic(cphy->adapter)) {
u32 elmer;
(void) t1_tpi_read(cphy->adapter, A_ELMER0_INT_ENABLE, &elmer);
elmer |= ELMER0_GP_BIT6;
(void) t1_tpi_write(cphy->adapter, A_ELMER0_INT_ENABLE, elmer);
}
return 0;
}
static int mv88x201x_interrupt_disable(struct cphy *cphy)
{
(void) mdio_write(cphy, 0x1, 0x9002, 0x0);
if (t1_is_asic(cphy->adapter)) {
u32 elmer;
(void) t1_tpi_read(cphy->adapter, A_ELMER0_INT_ENABLE, &elmer);
elmer &= ~ELMER0_GP_BIT6;
(void) t1_tpi_write(cphy->adapter, A_ELMER0_INT_ENABLE, elmer);
}
return 0;
}
static int mv88x201x_interrupt_clear(struct cphy *cphy)
{
u32 elmer;
u32 val;
#ifdef MV88x2010_LINK_STATUS_BUGS
(void) mdio_read(cphy, 0x1, 0x9003, &val);
(void) mdio_read(cphy, 0x1, 0x9004, &val);
(void) mdio_read(cphy, 0x1, 0x9005, &val);
(void) mdio_read(cphy, 0x1, 0x1, &val);
#endif
(void) mdio_read(cphy, 0x1, 0x1, &val);
(void) mdio_read(cphy, 0x1, 0x9005, &val);
#ifdef MV88x2010_LINK_STATUS_BUGS
(void) mdio_read(cphy, 0x1, 0x9003, &val);
(void) mdio_read(cphy, 0x1, 0x9004, &val);
#endif
if (t1_is_asic(cphy->adapter)) {
(void) t1_tpi_read(cphy->adapter, A_ELMER0_INT_CAUSE, &elmer);
elmer |= ELMER0_GP_BIT6;
(void) t1_tpi_write(cphy->adapter, A_ELMER0_INT_CAUSE, elmer);
}
return 0;
}
static int mv88x201x_interrupt_handler(struct cphy *cphy)
{
(void) mv88x201x_interrupt_clear(cphy);
return cphy_cause_link_change;
}
static int mv88x201x_set_loopback(struct cphy *cphy, int on)
{
return 0;
}
static int mv88x201x_get_link_status(struct cphy *cphy, int *link_ok,
int *speed, int *duplex, int *fc)
{
u32 val = 0;
#define LINK_STATUS_BIT 0x4
if (link_ok) {
(void) mdio_read(cphy, 0x1, 0x1, &val);
val &= LINK_STATUS_BIT;
*link_ok = (val == LINK_STATUS_BIT);
(void) led_link(cphy, *link_ok);
}
if (speed)
*speed = SPEED_10000;
if (duplex)
*duplex = DUPLEX_FULL;
if (fc)
*fc = PAUSE_RX | PAUSE_TX;
return 0;
}
static void mv88x201x_destroy(struct cphy *cphy)
{
t1_os_free((void *) cphy, sizeof(*cphy));
}
#ifdef C99_NOT_SUPPORTED
static struct cphy_ops mv88x201x_ops = {
mv88x201x_destroy,
mv88x201x_reset,
mv88x201x_interrupt_enable,
mv88x201x_interrupt_disable,
mv88x201x_interrupt_clear,
mv88x201x_interrupt_handler,
NULL,
NULL,
NULL,
NULL,
mv88x201x_set_loopback,
NULL,
mv88x201x_get_link_status,
};
#else
static struct cphy_ops mv88x201x_ops = {
.destroy = mv88x201x_destroy,
.reset = mv88x201x_reset,
.interrupt_enable = mv88x201x_interrupt_enable,
.interrupt_disable = mv88x201x_interrupt_disable,
.interrupt_clear = mv88x201x_interrupt_clear,
.interrupt_handler = mv88x201x_interrupt_handler,
.get_link_status = mv88x201x_get_link_status,
.set_loopback = mv88x201x_set_loopback,
};
#endif
static struct cphy *mv88x201x_phy_create(adapter_t *adapter, int phy_addr,
struct mdio_ops *mdio_ops)
{
u32 val;
struct cphy *cphy = t1_os_malloc_wait_zero(sizeof(*cphy));
if (!cphy)
return NULL;
cphy_init(cphy, adapter, phy_addr, &mv88x201x_ops, mdio_ops);
(void) mdio_read(cphy, 0x3, 0x8300, &val);
(void) mdio_write(cphy, 0x3, 0x8300, val | 1);
(void) mdio_read(cphy, 0x1, 0x8, &val);
(void) mdio_read(cphy, 0x3, 0x8, &val);
(void) led_init(cphy);
return cphy;
}
static int mv88x201x_phy_reset(adapter_t *adapter)
{
u32 val;
(void) t1_tpi_read(adapter, A_ELMER0_GPO, &val);
val &= ~4;
(void) t1_tpi_write(adapter, A_ELMER0_GPO, val);
DELAY_MS(100);
(void) t1_tpi_write(adapter, A_ELMER0_GPO, val | 4);
DELAY_MS(1000);
(void) t1_tpi_read(adapter, A_ELMER0_GPO, &val);
val |= 0x8000;
(void) t1_tpi_write(adapter, A_ELMER0_GPO, val);
DELAY_US(100);
return 0;
}
struct gphy t1_mv88x201x_ops = {
mv88x201x_phy_create,
mv88x201x_phy_reset
};