|
|
@@ -0,0 +1,323 @@
|
|
|
+// Copyright 2019 Espressif Systems (Shanghai) PTE LTD
|
|
|
+//
|
|
|
+// Licensed under the Apache License, Version 2.0 (the "License");
|
|
|
+// you may not use this file except in compliance with the License.
|
|
|
+// You may obtain a copy of the License at
|
|
|
+//
|
|
|
+// http://www.apache.org/licenses/LICENSE-2.0
|
|
|
+//
|
|
|
+// Unless required by applicable law or agreed to in writing, software
|
|
|
+// distributed under the License is distributed on an "AS IS" BASIS,
|
|
|
+// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
|
+// See the License for the specific language governing permissions and
|
|
|
+// limitations under the License.
|
|
|
+#include <string.h>
|
|
|
+#include <stdlib.h>
|
|
|
+#include <sys/cdefs.h>
|
|
|
+#include "esp_log.h"
|
|
|
+#include "esp_eth.h"
|
|
|
+#include "eth_phy_regs_struct.h"
|
|
|
+#include "freertos/FreeRTOS.h"
|
|
|
+#include "freertos/task.h"
|
|
|
+#include "driver/gpio.h"
|
|
|
+#include "esp_rom_gpio.h"
|
|
|
+
|
|
|
+static const char *TAG = "ksz8041";
|
|
|
+#define PHY_CHECK(a, str, goto_tag, ...) \
|
|
|
+ do \
|
|
|
+ { \
|
|
|
+ if (!(a)) \
|
|
|
+ { \
|
|
|
+ ESP_LOGE(TAG, "%s(%d): " str, __FUNCTION__, __LINE__, ##__VA_ARGS__); \
|
|
|
+ goto goto_tag; \
|
|
|
+ } \
|
|
|
+ } while (0)
|
|
|
+
|
|
|
+/***************Vendor Specific Register***************/
|
|
|
+/**
|
|
|
+ * @brief PC2R(PHY Control 2 Register)
|
|
|
+ *
|
|
|
+ */
|
|
|
+typedef union {
|
|
|
+ struct {
|
|
|
+ uint32_t hp_mdix : 1; /* HP Auto MDI/MDI-X Mode */
|
|
|
+ uint32_t mdi_x_select : 1; /* MDI/MDI-X Select */
|
|
|
+ uint32_t pairswap_dis : 1; /* Disable Auto MDI/MDI-X */
|
|
|
+ uint32_t energy_det : 1; /* Presence of Signal on RX+/- Wire Pair */
|
|
|
+ uint32_t force_link : 1; /* Force Link Pass */
|
|
|
+ uint32_t power_saving : 1; /* Enable Powering Saving */
|
|
|
+ uint32_t irq_level : 1; /* Interrupt Pin Active Level */
|
|
|
+ uint32_t jabber : 1; /* Enable Jabber Counter */
|
|
|
+ uint32_t auto_nego_comp : 1; /* Auto Negotiation Complete */
|
|
|
+ uint32_t flow_ctl_cap : 1; /* Flow Control Capable */
|
|
|
+ uint32_t phy_iso : 1; /* PHY in Isolate Mode */
|
|
|
+ uint32_t op_mode_ind : 3; /* Operation Mode Indication */
|
|
|
+ uint32_t en_sqe_test : 1; /* Enable SQE Test */
|
|
|
+ uint32_t dis_data_scr: 1; /* Disable Scrambler */
|
|
|
+ };
|
|
|
+ uint32_t val;
|
|
|
+} pc2r_reg_t;
|
|
|
+#define ETH_PHY_PC2R_REG_ADDR (0x1F)
|
|
|
+
|
|
|
+typedef struct {
|
|
|
+ esp_eth_phy_t parent;
|
|
|
+ esp_eth_mediator_t *eth;
|
|
|
+ uint32_t addr;
|
|
|
+ uint32_t reset_timeout_ms;
|
|
|
+ uint32_t autonego_timeout_ms;
|
|
|
+ eth_link_t link_status;
|
|
|
+ int reset_gpio_num;
|
|
|
+} phy_ksz8041_t;
|
|
|
+
|
|
|
+static esp_err_t ksz8041_update_link_duplex_speed(phy_ksz8041_t *ksz8041)
|
|
|
+{
|
|
|
+ esp_eth_mediator_t *eth = ksz8041->eth;
|
|
|
+ eth_speed_t speed = ETH_SPEED_10M;
|
|
|
+ eth_duplex_t duplex = ETH_DUPLEX_HALF;
|
|
|
+ bmsr_reg_t bmsr;
|
|
|
+ pc2r_reg_t pc2r;
|
|
|
+ PHY_CHECK(eth->phy_reg_read(eth, ksz8041->addr, ETH_PHY_BMSR_REG_ADDR, &(bmsr.val)) == ESP_OK,
|
|
|
+ "read BMSR failed", err);
|
|
|
+ eth_link_t link = bmsr.link_status ? ETH_LINK_UP : ETH_LINK_DOWN;
|
|
|
+ /* check if link status changed */
|
|
|
+ if (ksz8041->link_status != link) {
|
|
|
+ /* when link up, read negotiation result */
|
|
|
+ if (link == ETH_LINK_UP) {
|
|
|
+ PHY_CHECK(eth->phy_reg_read(eth, ksz8041->addr, ETH_PHY_PC2R_REG_ADDR, &(pc2r.val)) == ESP_OK,
|
|
|
+ "read PC2R failed", err);
|
|
|
+ switch (pc2r.op_mode_ind) {
|
|
|
+ case 1: //10Base-T half-duplex
|
|
|
+ speed = ETH_SPEED_10M;
|
|
|
+ duplex = ETH_DUPLEX_HALF;
|
|
|
+ break;
|
|
|
+ case 2: //100Base-TX half-duplex
|
|
|
+ speed = ETH_SPEED_100M;
|
|
|
+ duplex = ETH_DUPLEX_HALF;
|
|
|
+ break;
|
|
|
+ case 5: //10Base-T full-duplex
|
|
|
+ speed = ETH_SPEED_10M;
|
|
|
+ duplex = ETH_DUPLEX_FULL;
|
|
|
+ break;
|
|
|
+ case 6: //100Base-TX full-duplex
|
|
|
+ speed = ETH_SPEED_100M;
|
|
|
+ duplex = ETH_DUPLEX_FULL;
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ PHY_CHECK(eth->on_state_changed(eth, ETH_STATE_SPEED, (void *)speed) == ESP_OK,
|
|
|
+ "change speed failed", err);
|
|
|
+ PHY_CHECK(eth->on_state_changed(eth, ETH_STATE_DUPLEX, (void *)duplex) == ESP_OK,
|
|
|
+ "change duplex failed", err);
|
|
|
+ }
|
|
|
+ PHY_CHECK(eth->on_state_changed(eth, ETH_STATE_LINK, (void *)link) == ESP_OK,
|
|
|
+ "change link failed", err);
|
|
|
+ ksz8041->link_status = link;
|
|
|
+ }
|
|
|
+ return ESP_OK;
|
|
|
+err:
|
|
|
+ return ESP_FAIL;
|
|
|
+}
|
|
|
+
|
|
|
+static esp_err_t ksz8041_set_mediator(esp_eth_phy_t *phy, esp_eth_mediator_t *eth)
|
|
|
+{
|
|
|
+ PHY_CHECK(eth, "can't set mediator to null", err);
|
|
|
+ phy_ksz8041_t *ksz8041 = __containerof(phy, phy_ksz8041_t, parent);
|
|
|
+ ksz8041->eth = eth;
|
|
|
+ return ESP_OK;
|
|
|
+err:
|
|
|
+ return ESP_ERR_INVALID_ARG;
|
|
|
+}
|
|
|
+
|
|
|
+static esp_err_t ksz8041_get_link(esp_eth_phy_t *phy)
|
|
|
+{
|
|
|
+ phy_ksz8041_t *ksz8041 = __containerof(phy, phy_ksz8041_t, parent);
|
|
|
+ /* Update information about link, speed, duplex */
|
|
|
+ PHY_CHECK(ksz8041_update_link_duplex_speed(ksz8041) == ESP_OK, "update link duplex speed failed", err);
|
|
|
+ return ESP_OK;
|
|
|
+err:
|
|
|
+ return ESP_FAIL;
|
|
|
+}
|
|
|
+
|
|
|
+static esp_err_t ksz8041_reset(esp_eth_phy_t *phy)
|
|
|
+{
|
|
|
+ phy_ksz8041_t *ksz8041 = __containerof(phy, phy_ksz8041_t, parent);
|
|
|
+ ksz8041->link_status = ETH_LINK_DOWN;
|
|
|
+ esp_eth_mediator_t *eth = ksz8041->eth;
|
|
|
+ bmcr_reg_t bmcr = {.reset = 1};
|
|
|
+ PHY_CHECK(eth->phy_reg_write(eth, ksz8041->addr, ETH_PHY_BMCR_REG_ADDR, bmcr.val) == ESP_OK,
|
|
|
+ "write BMCR failed", err);
|
|
|
+ /* wait for reset complete */
|
|
|
+ uint32_t to = 0;
|
|
|
+ for (to = 0; to < ksz8041->reset_timeout_ms / 10; to++) {
|
|
|
+ vTaskDelay(pdMS_TO_TICKS(10));
|
|
|
+ PHY_CHECK(eth->phy_reg_read(eth, ksz8041->addr, ETH_PHY_BMCR_REG_ADDR, &(bmcr.val)) == ESP_OK,
|
|
|
+ "read BMCR failed", err);
|
|
|
+ if (!bmcr.reset) {
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ PHY_CHECK(to < ksz8041->reset_timeout_ms / 10, "reset timeout", err);
|
|
|
+ return ESP_OK;
|
|
|
+err:
|
|
|
+ return ESP_FAIL;
|
|
|
+}
|
|
|
+
|
|
|
+static esp_err_t ksz8041_reset_hw(esp_eth_phy_t *phy)
|
|
|
+{
|
|
|
+ phy_ksz8041_t *ksz8041 = __containerof(phy, phy_ksz8041_t, parent);
|
|
|
+ if (ksz8041->reset_gpio_num >= 0) {
|
|
|
+ esp_rom_gpio_pad_select_gpio(ksz8041->reset_gpio_num);
|
|
|
+ gpio_set_direction(ksz8041->reset_gpio_num, GPIO_MODE_OUTPUT);
|
|
|
+ gpio_set_level(ksz8041->reset_gpio_num, 0);
|
|
|
+ ets_delay_us(100); // insert min input assert time
|
|
|
+ gpio_set_level(ksz8041->reset_gpio_num, 1);
|
|
|
+ }
|
|
|
+ return ESP_OK;
|
|
|
+}
|
|
|
+
|
|
|
+static esp_err_t ksz8041_negotiate(esp_eth_phy_t *phy)
|
|
|
+{
|
|
|
+ phy_ksz8041_t *ksz8041 = __containerof(phy, phy_ksz8041_t, parent);
|
|
|
+ esp_eth_mediator_t *eth = ksz8041->eth;
|
|
|
+ /* Restart auto negotiation */
|
|
|
+ bmcr_reg_t bmcr = {
|
|
|
+ .speed_select = 1, /* 100Mbps */
|
|
|
+ .duplex_mode = 1, /* Full Duplex */
|
|
|
+ .en_auto_nego = 1, /* Auto Negotiation */
|
|
|
+ .restart_auto_nego = 1 /* Restart Auto Negotiation */
|
|
|
+ };
|
|
|
+ PHY_CHECK(eth->phy_reg_write(eth, ksz8041->addr, ETH_PHY_BMCR_REG_ADDR, bmcr.val) == ESP_OK, "write BMCR failed", err);
|
|
|
+ /* Wait for auto negotiation complete */
|
|
|
+ bmsr_reg_t bmsr;
|
|
|
+ pc2r_reg_t pc2r;
|
|
|
+ int32_t to = 0;
|
|
|
+ for (to = 0; to < ksz8041->autonego_timeout_ms / 10; to++) {
|
|
|
+ vTaskDelay(pdMS_TO_TICKS(10));
|
|
|
+ PHY_CHECK(eth->phy_reg_read(eth, ksz8041->addr, ETH_PHY_BMSR_REG_ADDR, &(bmsr.val)) == ESP_OK,
|
|
|
+ "read BMSR failed", err);
|
|
|
+ PHY_CHECK(eth->phy_reg_read(eth, ksz8041->addr, ETH_PHY_PC2R_REG_ADDR, &(pc2r.val)) == ESP_OK,
|
|
|
+ "read PC2R failed", err);
|
|
|
+ if (bmsr.auto_nego_complete && pc2r.auto_nego_comp) {
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ /* Auto negotiation failed, maybe no network cable plugged in, so output a warning */
|
|
|
+ if (to >= ksz8041->autonego_timeout_ms / 10) {
|
|
|
+ ESP_LOGW(TAG, "auto negotiation timeout");
|
|
|
+ }
|
|
|
+ /* Updata information about link, speed, duplex */
|
|
|
+ PHY_CHECK(ksz8041_update_link_duplex_speed(ksz8041) == ESP_OK, "update link duplex speed failed", err);
|
|
|
+ return ESP_OK;
|
|
|
+err:
|
|
|
+ return ESP_FAIL;
|
|
|
+}
|
|
|
+
|
|
|
+static esp_err_t ksz8041_pwrctl(esp_eth_phy_t *phy, bool enable)
|
|
|
+{
|
|
|
+ phy_ksz8041_t *ksz8041 = __containerof(phy, phy_ksz8041_t, parent);
|
|
|
+ esp_eth_mediator_t *eth = ksz8041->eth;
|
|
|
+ bmcr_reg_t bmcr;
|
|
|
+ PHY_CHECK(eth->phy_reg_read(eth, ksz8041->addr, ETH_PHY_BMCR_REG_ADDR, &(bmcr.val)) == ESP_OK,
|
|
|
+ "read BMCR failed", err);
|
|
|
+ if (!enable) {
|
|
|
+ /* General Power Down Mode */
|
|
|
+ bmcr.power_down = 1;
|
|
|
+ } else {
|
|
|
+ /* Normal operation Mode */
|
|
|
+ bmcr.power_down = 0;
|
|
|
+ }
|
|
|
+ PHY_CHECK(eth->phy_reg_write(eth, ksz8041->addr, ETH_PHY_BMCR_REG_ADDR, bmcr.val) == ESP_OK,
|
|
|
+ "write BMCR failed", err);
|
|
|
+ PHY_CHECK(eth->phy_reg_read(eth, ksz8041->addr, ETH_PHY_BMCR_REG_ADDR, &(bmcr.val)) == ESP_OK,
|
|
|
+ "read BMCR failed", err);
|
|
|
+ if (!enable) {
|
|
|
+ PHY_CHECK(bmcr.power_down == 1, "power down failed", err);
|
|
|
+ } else {
|
|
|
+ PHY_CHECK(bmcr.power_down == 0, "power up failed", err);
|
|
|
+ }
|
|
|
+ return ESP_OK;
|
|
|
+err:
|
|
|
+ return ESP_FAIL;
|
|
|
+}
|
|
|
+
|
|
|
+static esp_err_t ksz8041_set_addr(esp_eth_phy_t *phy, uint32_t addr)
|
|
|
+{
|
|
|
+ phy_ksz8041_t *ksz8041 = __containerof(phy, phy_ksz8041_t, parent);
|
|
|
+ ksz8041->addr = addr;
|
|
|
+ return ESP_OK;
|
|
|
+}
|
|
|
+
|
|
|
+static esp_err_t ksz8041_get_addr(esp_eth_phy_t *phy, uint32_t *addr)
|
|
|
+{
|
|
|
+ PHY_CHECK(addr, "addr can't be null", err);
|
|
|
+ phy_ksz8041_t *ksz8041 = __containerof(phy, phy_ksz8041_t, parent);
|
|
|
+ *addr = ksz8041->addr;
|
|
|
+ return ESP_OK;
|
|
|
+err:
|
|
|
+ return ESP_ERR_INVALID_ARG;
|
|
|
+}
|
|
|
+
|
|
|
+static esp_err_t ksz8041_del(esp_eth_phy_t *phy)
|
|
|
+{
|
|
|
+ phy_ksz8041_t *ksz8041 = __containerof(phy, phy_ksz8041_t, parent);
|
|
|
+ free(ksz8041);
|
|
|
+ return ESP_OK;
|
|
|
+}
|
|
|
+
|
|
|
+static esp_err_t ksz8041_init(esp_eth_phy_t *phy)
|
|
|
+{
|
|
|
+ phy_ksz8041_t *ksz8041 = __containerof(phy, phy_ksz8041_t, parent);
|
|
|
+ esp_eth_mediator_t *eth = ksz8041->eth;
|
|
|
+ /* Power on Ethernet PHY */
|
|
|
+ PHY_CHECK(ksz8041_pwrctl(phy, true) == ESP_OK, "power control failed", err);
|
|
|
+ /* Reset Ethernet PHY */
|
|
|
+ PHY_CHECK(ksz8041_reset(phy) == ESP_OK, "reset failed", err);
|
|
|
+ /* Check PHY ID */
|
|
|
+ phyidr1_reg_t id1;
|
|
|
+ phyidr2_reg_t id2;
|
|
|
+ PHY_CHECK(eth->phy_reg_read(eth, ksz8041->addr, ETH_PHY_IDR1_REG_ADDR, &(id1.val)) == ESP_OK,
|
|
|
+ "read ID1 failed", err);
|
|
|
+ PHY_CHECK(eth->phy_reg_read(eth, ksz8041->addr, ETH_PHY_IDR2_REG_ADDR, &(id2.val)) == ESP_OK,
|
|
|
+ "read ID2 failed", err);
|
|
|
+ PHY_CHECK(id1.oui_msb == 0x22 && id2.oui_lsb == 0x5 && id2.vendor_model == 0x11, "wrong chip ID", err);
|
|
|
+ return ESP_OK;
|
|
|
+err:
|
|
|
+ return ESP_FAIL;
|
|
|
+}
|
|
|
+
|
|
|
+static esp_err_t ksz8041_deinit(esp_eth_phy_t *phy)
|
|
|
+{
|
|
|
+ /* Power off Ethernet PHY */
|
|
|
+ PHY_CHECK(ksz8041_pwrctl(phy, false) == ESP_OK, "power control failed", err);
|
|
|
+ return ESP_OK;
|
|
|
+err:
|
|
|
+ return ESP_FAIL;
|
|
|
+}
|
|
|
+
|
|
|
+esp_eth_phy_t *esp_eth_phy_new_ksz8041(const eth_phy_config_t *config)
|
|
|
+{
|
|
|
+ PHY_CHECK(config, "can't set phy config to null", err);
|
|
|
+ phy_ksz8041_t *ksz8041 = calloc(1, sizeof(phy_ksz8041_t));
|
|
|
+ PHY_CHECK(ksz8041, "calloc ksz8041 failed", err);
|
|
|
+ ksz8041->addr = config->phy_addr;
|
|
|
+ ksz8041->reset_gpio_num = config->reset_gpio_num;
|
|
|
+ ksz8041->reset_timeout_ms = config->reset_timeout_ms;
|
|
|
+ ksz8041->link_status = ETH_LINK_DOWN;
|
|
|
+ ksz8041->autonego_timeout_ms = config->autonego_timeout_ms;
|
|
|
+ ksz8041->parent.reset = ksz8041_reset;
|
|
|
+ ksz8041->parent.reset_hw = ksz8041_reset_hw;
|
|
|
+ ksz8041->parent.init = ksz8041_init;
|
|
|
+ ksz8041->parent.deinit = ksz8041_deinit;
|
|
|
+ ksz8041->parent.set_mediator = ksz8041_set_mediator;
|
|
|
+ ksz8041->parent.negotiate = ksz8041_negotiate;
|
|
|
+ ksz8041->parent.get_link = ksz8041_get_link;
|
|
|
+ ksz8041->parent.pwrctl = ksz8041_pwrctl;
|
|
|
+ ksz8041->parent.get_addr = ksz8041_get_addr;
|
|
|
+ ksz8041->parent.set_addr = ksz8041_set_addr;
|
|
|
+ ksz8041->parent.del = ksz8041_del;
|
|
|
+
|
|
|
+ return &(ksz8041->parent);
|
|
|
+err:
|
|
|
+ return NULL;
|
|
|
+}
|