mirror of
https://github.com/logicog/RTLPlayground.git
synced 2026-08-30 14:52:51 +08:00
Add duplex setting in PHY speed configuration
This commit is contained in:
+13
-3
@@ -184,8 +184,9 @@ void phy_config_8224(void) __banked
|
|||||||
/*
|
/*
|
||||||
* Set Speed of a PHY
|
* Set Speed of a PHY
|
||||||
* See e.g. RTL8221B datasheet
|
* See e.g. RTL8221B datasheet
|
||||||
|
* duplex: 0: half, 1: full, 2: both
|
||||||
*/
|
*/
|
||||||
void phy_set_speed(uint8_t port, uint8_t speed) __banked
|
void phy_set_speed(uint8_t port, uint8_t speed, uint8_t duplex) __banked
|
||||||
{
|
{
|
||||||
uint16_t v;
|
uint16_t v;
|
||||||
phy_read(port, PHY_MMD_CTRL, 0xa610);
|
phy_read(port, PHY_MMD_CTRL, 0xa610);
|
||||||
@@ -213,10 +214,20 @@ void phy_set_speed(uint8_t port, uint8_t speed) __banked
|
|||||||
phy_write(port, PHY_MMD_AN, 0x00, 0x2000); // Clear bit 12: No Autoneg, Set Extended Pages (bit 13)
|
phy_write(port, PHY_MMD_AN, 0x00, 0x2000); // Clear bit 12: No Autoneg, Set Extended Pages (bit 13)
|
||||||
if (speed == PHY_SPEED_10M) {
|
if (speed == PHY_SPEED_10M) {
|
||||||
phy_write(port, PHY_MMD_AN, 0x20, 0x6001);
|
phy_write(port, PHY_MMD_AN, 0x20, 0x6001);
|
||||||
|
if (!duplex)
|
||||||
|
phy_write(port, PHY_MMD_AN, 0x10, 0x1421);
|
||||||
|
else if (duplex == 1)
|
||||||
|
phy_write(port, PHY_MMD_AN, 0x10, 0x1441);
|
||||||
|
else
|
||||||
phy_write(port, PHY_MMD_AN, 0x10, 0x1461);
|
phy_write(port, PHY_MMD_AN, 0x10, 0x1461);
|
||||||
phy_modify(port, PHY_MMD_CTRL, 0xa412, 0x0200, 0x0000);
|
phy_modify(port, PHY_MMD_CTRL, 0xa412, 0x0200, 0x0000);
|
||||||
} else if (speed == PHY_SPEED_100M) {
|
} else if (speed == PHY_SPEED_100M) {
|
||||||
phy_write(port, PHY_MMD_AN, 0x20, 0x6001);
|
phy_write(port, PHY_MMD_AN, 0x20, 0x6001);
|
||||||
|
if (!duplex)
|
||||||
|
phy_write(port, PHY_MMD_AN, 0x10, 0x1481);
|
||||||
|
if (duplex == 1)
|
||||||
|
phy_write(port, PHY_MMD_AN, 0x10, 0x1501);
|
||||||
|
else
|
||||||
phy_write(port, PHY_MMD_AN, 0x10, 0x1581);
|
phy_write(port, PHY_MMD_AN, 0x10, 0x1581);
|
||||||
phy_modify(port, PHY_MMD_CTRL, 0xa412, 0x0200, 0x0000);
|
phy_modify(port, PHY_MMD_CTRL, 0xa412, 0x0200, 0x0000);
|
||||||
} else {
|
} else {
|
||||||
@@ -286,8 +297,7 @@ void phy_show(uint8_t port) __banked
|
|||||||
print_string("\nLink speed: ");
|
print_string("\nLink speed: ");
|
||||||
phy_read(port, PHY_MMD_CTRL, 0xA434);
|
phy_read(port, PHY_MMD_CTRL, 0xA434);
|
||||||
v = SFR_DATA_U16;
|
v = SFR_DATA_U16;
|
||||||
v = ((v & 0x0600) >> 7) | ((v & 0x0030) >> 4);
|
switch(((v & 0x0600) >> 7) | ((v & 0x0030) >> 4)) {
|
||||||
switch(v) {
|
|
||||||
case 0:
|
case 0:
|
||||||
print_string("10M");
|
print_string("10M");
|
||||||
break;
|
break;
|
||||||
|
|||||||
+1
-1
@@ -13,7 +13,7 @@
|
|||||||
void rtl8224_phy_enable(void) __banked;
|
void rtl8224_phy_enable(void) __banked;
|
||||||
void phy_config(uint8_t phy) __banked;
|
void phy_config(uint8_t phy) __banked;
|
||||||
void phy_config_8224(void) __banked;
|
void phy_config_8224(void) __banked;
|
||||||
void phy_set_speed(uint8_t port, uint8_t speed) __banked;
|
void phy_set_speed(uint8_t port, uint8_t speed, uint8_t duplex) __banked;
|
||||||
void phy_set_duplex(uint8_t port, uint8_t fullduplex) __banked;
|
void phy_set_duplex(uint8_t port, uint8_t fullduplex) __banked;
|
||||||
void phy_show(uint8_t port) __banked;
|
void phy_show(uint8_t port) __banked;
|
||||||
void phy_reset(uint8_t port) __banked;
|
void phy_reset(uint8_t port) __banked;
|
||||||
|
|||||||
Reference in New Issue
Block a user