You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
719 lines
22 KiB
719 lines
22 KiB
/* LAN9250 Stand-alone Ethernet Controller with SPI |
|
* |
|
* Copyright (c) 2024 Mario Paja |
|
* |
|
* SPDX-License-Identifier: Apache-2.0 |
|
*/ |
|
#define DT_DRV_COMPAT microchip_lan9250 |
|
|
|
#include <zephyr/kernel.h> |
|
#include <zephyr/device.h> |
|
#include <string.h> |
|
#include <errno.h> |
|
#include <zephyr/drivers/gpio.h> |
|
#include <zephyr/drivers/spi.h> |
|
#include <zephyr/net/net_pkt.h> |
|
#include <zephyr/net/net_if.h> |
|
#include <zephyr/net/ethernet.h> |
|
#include <ethernet/eth_stats.h> |
|
|
|
#include "eth_lan9250_priv.h" |
|
|
|
LOG_MODULE_REGISTER(eth_lan9250, CONFIG_ETHERNET_LOG_LEVEL); |
|
|
|
static int lan9250_write_sys_reg(const struct device *dev, uint16_t address, uint32_t data) |
|
{ |
|
const struct lan9250_config *config = dev->config; |
|
uint8_t cmd[1] = {LAN9250_SPI_INSTR_WRITE}; |
|
uint8_t addr[2]; |
|
uint8_t instr[4]; |
|
struct spi_buf tx_buf[3]; |
|
const struct spi_buf_set tx = {.buffers = tx_buf, .count = 3}; |
|
|
|
sys_put_be16(address, addr); |
|
sys_put_le32(data, instr); |
|
|
|
tx_buf[0].buf = &cmd; |
|
tx_buf[0].len = ARRAY_SIZE(cmd); |
|
tx_buf[1].buf = addr; |
|
tx_buf[1].len = ARRAY_SIZE(addr); |
|
tx_buf[2].buf = instr; |
|
tx_buf[2].len = ARRAY_SIZE(instr); |
|
|
|
return spi_write_dt(&config->spi, &tx); |
|
} |
|
|
|
static int lan9250_read_sys_reg(const struct device *dev, uint16_t address, uint32_t *value) |
|
{ |
|
const struct lan9250_config *config = dev->config; |
|
uint8_t cmd[1] = {LAN9250_SPI_INSTR_READ}; |
|
uint8_t addr[2]; |
|
struct spi_buf tx_buf[3]; |
|
struct spi_buf rx_buf[3]; |
|
const struct spi_buf_set tx = {.buffers = tx_buf, .count = 3}; |
|
const struct spi_buf_set rx = {.buffers = rx_buf, .count = 3}; |
|
|
|
sys_put_be16(address, addr); |
|
|
|
tx_buf[0].buf = &cmd; |
|
tx_buf[0].len = ARRAY_SIZE(cmd); |
|
tx_buf[1].buf = addr; |
|
tx_buf[1].len = ARRAY_SIZE(addr); |
|
tx_buf[2].buf = NULL; |
|
tx_buf[2].len = sizeof(uint32_t); |
|
|
|
rx_buf[0].buf = NULL; |
|
rx_buf[0].len = 1; |
|
rx_buf[1].buf = NULL; |
|
rx_buf[1].len = 2; |
|
rx_buf[2].buf = value; |
|
rx_buf[2].len = sizeof(uint32_t); |
|
|
|
return spi_transceive_dt(&config->spi, &tx, &rx); |
|
} |
|
|
|
static int lan9250_wait_ready(const struct device *dev, uint16_t address, uint32_t mask, |
|
uint32_t expected, uint32_t m_second) |
|
{ |
|
uint32_t tmp; |
|
int wait_time = 0; |
|
|
|
while (true) { |
|
lan9250_read_sys_reg(dev, address, &tmp); |
|
wait_time++; |
|
k_busy_wait(USEC_PER_MSEC * 1U); |
|
if ((tmp & mask) == expected) { |
|
return 0; |
|
} else if (wait_time == m_second) { |
|
LOG_ERR("NOT READY"); |
|
return -EIO; |
|
} |
|
} |
|
} |
|
|
|
static int lan9250_read_mac_reg(const struct device *dev, uint8_t address, uint32_t *value) |
|
{ |
|
uint32_t tmp; |
|
|
|
/* Wait for MAC to be ready and send writing register command and data */ |
|
lan9250_wait_ready(dev, LAN9250_MAC_CSR_CMD, LAN9250_MAC_CSR_CMD_BUSY, 0, |
|
LAN9250_MAC_TIMEOUT); |
|
lan9250_write_sys_reg(dev, LAN9250_MAC_CSR_CMD, |
|
address | LAN9250_MAC_CSR_CMD_BUSY | LAN9250_MAC_CSR_CMD_READ); |
|
|
|
/* Wait for MAC to be ready and send writing register command and data */ |
|
lan9250_wait_ready(dev, LAN9250_MAC_CSR_CMD, LAN9250_MAC_CSR_CMD_BUSY, 0, |
|
LAN9250_MAC_TIMEOUT); |
|
lan9250_read_sys_reg(dev, LAN9250_MAC_CSR_DATA, &tmp); |
|
|
|
*value = tmp; |
|
return 0; |
|
} |
|
|
|
static int lan9250_write_mac_reg(const struct device *dev, uint8_t address, uint32_t data) |
|
{ |
|
/* Wait for MAC to be ready and send writing register command and data */ |
|
lan9250_wait_ready(dev, LAN9250_MAC_CSR_CMD, LAN9250_MAC_CSR_CMD_BUSY, 0, |
|
LAN9250_MAC_TIMEOUT); |
|
lan9250_write_sys_reg(dev, LAN9250_MAC_CSR_DATA, data); |
|
lan9250_write_sys_reg(dev, LAN9250_MAC_CSR_CMD, address | LAN9250_MAC_CSR_CMD_BUSY); |
|
|
|
/* Wait until writing MAC is done */ |
|
lan9250_wait_ready(dev, LAN9250_MAC_CSR_CMD, LAN9250_MAC_CSR_CMD_BUSY, 0, |
|
LAN9250_MAC_TIMEOUT); |
|
|
|
return 0; |
|
} |
|
|
|
static int lan9250_wait_mac_ready(const struct device *dev, uint8_t address, uint32_t mask, |
|
uint32_t expected, uint32_t m_second) |
|
{ |
|
uint32_t tmp; |
|
int wait_time = 0; |
|
|
|
while (true) { |
|
lan9250_read_mac_reg(dev, address, &tmp); |
|
wait_time++; |
|
k_msleep(1); |
|
if ((tmp & mask) == expected) { |
|
return 0; |
|
} else if (wait_time == m_second) { |
|
return -EIO; |
|
} |
|
} |
|
} |
|
|
|
static int lan9250_read_phy_reg(const struct device *dev, uint8_t address, uint16_t *value) |
|
{ |
|
uint32_t tmp; |
|
|
|
/* Wait PHY to be ready and send reading register command */ |
|
lan9250_wait_mac_ready(dev, LAN9250_HMAC_MII_ACC, LAN9250_HMAC_MII_ACC_MIIBZY, 0, |
|
LAN9250_PHY_TIMEOUT); |
|
|
|
/* Reference: Microchip Ethernet LAN9250 |
|
* https://github.com/microchip-pic-avr-solutions/ethernet-lan9250/ |
|
* |
|
* Datasheet: |
|
* https://ww1.microchip.com/downloads/aemDocuments/documents/OTH/ProductDocuments/DataSheets/00001913A.pdf |
|
* |
|
* 12.2.18 PHY REGISTERS |
|
* The PHY registers are indirectly accessed through the Host MAC MII Access Register |
|
* (HMAC_MII_ACC) and Host MAC MII Data Register (HMAC_MII_DATA). |
|
* |
|
* Write 32bit value to the indirect MAC registers |
|
* Where phy_add = 0b00001 & index = address |
|
* Data = ((phy_add & 0x1F) << 11) | ((index & 0x1F) << 6) |
|
*/ |
|
lan9250_write_mac_reg(dev, LAN9250_HMAC_MII_ACC, (1 << 11) | ((address & 0x1F) << 6)); |
|
|
|
/* Wait PHY to be ready and send reading register command */ |
|
lan9250_wait_mac_ready(dev, LAN9250_HMAC_MII_ACC, LAN9250_HMAC_MII_ACC_MIIBZY, 0, |
|
LAN9250_PHY_TIMEOUT); |
|
|
|
/* Read 32bit value from the indirect MAC registers */ |
|
lan9250_read_mac_reg(dev, LAN9250_HMAC_MII_DATA, &tmp); |
|
*value = tmp; |
|
|
|
return 0; |
|
} |
|
|
|
static int lan9250_write_phy_reg(const struct device *dev, uint8_t address, uint16_t data) |
|
{ |
|
/* Wait PHY to be ready and send reading register command */ |
|
lan9250_wait_mac_ready(dev, LAN9250_HMAC_MII_ACC, LAN9250_HMAC_MII_ACC_MIIBZY, 0, |
|
LAN9250_PHY_TIMEOUT); |
|
lan9250_write_mac_reg(dev, LAN9250_HMAC_MII_DATA, data); |
|
|
|
/* Reference: Microchip Ethernet LAN9250 |
|
* https://github.com/microchip-pic-avr-solutions/ethernet-lan9250/ |
|
* |
|
* Datasheet: |
|
* https://ww1.microchip.com/downloads/aemDocuments/documents/OTH/ProductDocuments/DataSheets/00001913A.pdf |
|
* |
|
* 12.2.18 PHY REGISTERS |
|
* The PHY registers are indirectly accessed through the Host MAC MII Access Register |
|
* (HMAC_MII_ACC) and Host MAC MII Data Register (HMAC_MII_DATA). |
|
* |
|
* Write 32bit value to the indirect MAC registers |
|
* Where phy_add = 0b00001 & index = address |
|
* Data = ((phy_add & 0x1F) << 11) | ((index & 0x1F)<< 6) | MIIWnR |
|
*/ |
|
lan9250_write_mac_reg(dev, LAN9250_HMAC_MII_ACC, |
|
(1 << 11) | ((address & 0x1F) << 6) | LAN9250_HMAC_MII_ACC_MIIW_R); |
|
|
|
/* Wait PHY to be ready and send reading register command */ |
|
lan9250_wait_mac_ready(dev, LAN9250_HMAC_MII_ACC, LAN9250_HMAC_MII_ACC_MIIBZY, 0, |
|
LAN9250_PHY_TIMEOUT); |
|
|
|
return 0; |
|
} |
|
|
|
static int lan9250_set_macaddr(const struct device *dev) |
|
{ |
|
struct lan9250_runtime *ctx = dev->data; |
|
|
|
lan9250_write_mac_reg(dev, LAN9250_HMAC_ADDRL, |
|
ctx->mac_address[0] | (ctx->mac_address[1] << 8) | |
|
(ctx->mac_address[2] << 16) | (ctx->mac_address[3] << 24)); |
|
lan9250_write_mac_reg(dev, LAN9250_HMAC_ADDRH, |
|
ctx->mac_address[4] | (ctx->mac_address[5] << 8)); |
|
|
|
return 0; |
|
} |
|
|
|
static int lan9250_hw_cfg_check(const struct device *dev) |
|
{ |
|
uint32_t tmp; |
|
|
|
do { |
|
lan9250_read_sys_reg(dev, LAN9250_HW_CFG, &tmp); |
|
k_busy_wait(USEC_PER_MSEC * 1U); |
|
} while ((tmp & LAN9250_HW_CFG_DEVICE_READY) == 0); |
|
|
|
return 0; |
|
} |
|
|
|
static int lan9250_sw_reset(const struct device *dev) |
|
{ |
|
lan9250_write_sys_reg(dev, LAN9250_RESET_CTL, |
|
LAN9250_RESET_CTL_HMAC_RST | LAN9250_RESET_CTL_PHY_RST | |
|
LAN9250_RESET_CTL_DIGITAL_RST); |
|
|
|
/* Wait until LAN9250 SPI bus is ready */ |
|
lan9250_wait_ready(dev, LAN9250_BYTE_TEST, BOTR_MASK, LAN9250_BYTE_TEST_DEFAULT, |
|
LAN9250_RESET_TIMEOUT); |
|
|
|
return 0; |
|
} |
|
|
|
static int lan9250_configure(const struct device *dev) |
|
{ |
|
uint32_t tmp; |
|
|
|
lan9250_hw_cfg_check(dev); |
|
|
|
/* Read LAN9250 hardware ID */ |
|
lan9250_read_sys_reg(dev, LAN9250_ID_REV, &tmp); |
|
if ((tmp & LAN9250_ID_REV_CHIP_ID) != LAN9250_ID_REV_CHIP_ID_DEFAULT) { |
|
LOG_ERR("ERROR: Bad Rev ID: %08x\n", tmp); |
|
return -ENODEV; |
|
} |
|
|
|
/* Configure TX FIFO size mode to be 8: |
|
* |
|
* - TX data FIFO size: 7680 |
|
* - RX data FIFO size: 7680 |
|
* - TX status FIFO size: 512 |
|
* - RX status FIFO size: 512 |
|
*/ |
|
lan9250_write_sys_reg(dev, LAN9250_HW_CFG, |
|
LAN9250_HW_CFG_MBO | LAN9250_HW_CFG_TX_FIF_SZ_8KB); |
|
|
|
/* Configure MAC automatic flow control: |
|
* |
|
* Reference: Microchip Ethernet LAN9250 |
|
* https://github.com/microchip-pic-avr-solutions/ethernet-lan9250/ |
|
* LAN_Regwrite32(AFC_CFG, 0x006E3741); |
|
* |
|
*/ |
|
lan9250_write_sys_reg(dev, LAN9250_AFC_CFG, 0x006e3741); |
|
|
|
/* Configure interrupt: |
|
* |
|
* - Interrupt De-assertion interval: 100 |
|
* - Interrupt output to pin |
|
* - Interrupt pin active output low |
|
* - Interrupt pin push-pull driver |
|
*/ |
|
lan9250_write_sys_reg(dev, LAN9250_IRQ_CFG, |
|
LAN9250_IRQ_CFG_INT_DEAS_100US | LAN9250_IRQ_CFG_IRQ_EN | |
|
LAN9250_IRQ_CFG_IRQ_TYPE_PP); |
|
|
|
/* Configure interrupt trigger source, please refer to macro |
|
* LAN9250_INT_SOURCE. |
|
*/ |
|
lan9250_write_sys_reg(dev, LAN9250_INT_EN, |
|
LAN9250_INT_EN_PHY_INT_EN | LAN9250_INT_EN_RSFL_EN); |
|
|
|
/* Disable TX data FIFO available interrupt */ |
|
lan9250_write_sys_reg(dev, LAN9250_FIFO_INT, |
|
LAN9250_FIFO_INT_TX_DATA_AVAILABLE_LEVEL | |
|
LAN9250_FIFO_INT_TX_STATUS_LEVEL); |
|
|
|
/* Configure RX: |
|
* |
|
* - RX DMA counter: Ethernet maximum packet size |
|
* - RX data offset: 4, so that need read dummy before reading data |
|
*/ |
|
lan9250_write_sys_reg(dev, LAN9250_RX_CFG, 0x06000000 | 0x00000400); |
|
|
|
/* Configure remote power management: |
|
* |
|
* - Auto wakeup |
|
* - Disable 1588 clock |
|
* - Disable 1588 timestamp unit clock |
|
* - Energy-detect |
|
* - Wake on |
|
* - Clear wakeon |
|
*/ |
|
lan9250_write_sys_reg(dev, LAN9250_PMT_CTRL, |
|
LAN9250_PMT_CTRL_PM_WAKE | LAN9250_PMT_CTRL_1588_DIS | |
|
LAN9250_PMT_CTRL_1588_TSU_DIS | LAN9250_PMT_CTRL_WOL_EN | |
|
LAN9250_PMT_CTRL_WOL_STS); |
|
|
|
/* Configure PHY basic control: |
|
* |
|
* - Auto-Negotiation for 10/100 Mbits and Half/Full Duplex |
|
*/ |
|
lan9250_write_phy_reg(dev, LAN9250_PHY_BASIC_CONTROL, |
|
LAN9250_PHY_BASIC_CONTROL_PHY_AN | |
|
LAN9250_PHY_BASIC_CONTROL_PHY_SPEED_SEL_LSB | |
|
LAN9250_PHY_BASIC_CONTROL_PHY_DUPLEX); |
|
|
|
/* Configure PHY auto-negotiation advertisement capability: |
|
* |
|
* - Asymmetric pause |
|
* - Symmetric pause |
|
* - 100Base-X half/full duplex |
|
* - 10Base-X half/full duplex |
|
* - Select IEEE802.3 |
|
*/ |
|
lan9250_write_phy_reg(dev, LAN9250_PHY_AN_ADV, |
|
LAN9250_PHY_AN_ADV_ASYM_PAUSE | LAN9250_PHY_AN_ADV_SYM_PAUSE | |
|
LAN9250_PHY_AN_ADV_100BTX_HD | LAN9250_PHY_AN_ADV_100BTX_FD | |
|
LAN9250_PHY_AN_ADV_10BT_HD | LAN9250_PHY_AN_ADV_10BT_FD | |
|
LAN9250_PHY_AN_ADV_SELECTOR_DEFAULT); |
|
|
|
/* Configure PHY special mode: |
|
* |
|
* - PHY mode = 111b, enable all capable and auto-nagotiation |
|
* - PHY address = 1, default value is fixed to 1 by manufacturer |
|
*/ |
|
lan9250_write_phy_reg(dev, LAN9250_PHY_SPECIAL_MODES, 0x00E0 | 1); |
|
|
|
/* Configure PHY special control or status indication: |
|
* |
|
* - Port auto-MDIX determined by bits 14 and 13 |
|
* - Auto-MDIX |
|
* - Disable SQE tests |
|
*/ |
|
lan9250_write_phy_reg(dev, LAN9250_PHY_SPECIAL_CONTROL_STAT_IND, |
|
LAN9250_PHY_SPECIAL_CONTROL_STAT_IND_AMDIXCTRL | |
|
LAN9250_PHY_SPECIAL_CONTROL_STAT_IND_AMDIXEN | |
|
LAN9250_PHY_SPECIAL_CONTROL_STAT_IND_SQEOFF); |
|
|
|
/* Configure PHY interrupt source: |
|
* |
|
* - Link up |
|
* - Link down |
|
*/ |
|
lan9250_write_phy_reg(dev, LAN9250_PHY_INTERRUPT_MASK, |
|
LAN9250_PHY_INTERRUPT_SOURCE_LINK_UP | |
|
LAN9250_PHY_INTERRUPT_SOURCE_LINK_DOWN); |
|
|
|
/* Configure special control or status: |
|
* |
|
* - Fixed to write 0000010b to reserved filed |
|
*/ |
|
lan9250_write_phy_reg(dev, LAN9250_PHY_SPECIAL_CONTROL_STATUS, |
|
LAN9250_PHY_MODE_CONTROL_STATUS_ALTINT); |
|
|
|
/* Clear interrupt status */ |
|
lan9250_write_sys_reg(dev, LAN9250_INT_STS, 0xFFFFFFFF); |
|
|
|
/* Configure HMAC control: |
|
* |
|
* - Automatically strip the pad field on incoming packets |
|
* - TX enable |
|
* - RX enable |
|
* - Full duplex |
|
* - Promiscuous disabled |
|
*/ |
|
lan9250_write_mac_reg(dev, LAN9250_HMAC_CR, |
|
LAN9250_HMAC_CR_PADSTR | LAN9250_HMAC_CR_TXEN | LAN9250_HMAC_CR_RXEN | |
|
LAN9250_HMAC_CR_FDPX); |
|
|
|
/* Configure TX: |
|
* |
|
* - TX enable |
|
*/ |
|
lan9250_write_sys_reg(dev, LAN9250_TX_CFG, LAN9250_TX_CFG_TX_ON); |
|
|
|
return 0; |
|
} |
|
|
|
static int lan9250_write_buf(const struct device *dev, uint8_t *data_buffer, uint16_t buf_len) |
|
{ |
|
const struct lan9250_config *config = dev->config; |
|
uint8_t cmd[1] = {LAN9250_SPI_INSTR_WRITE}; |
|
uint8_t instr[2] = {(LAN9250_TX_DATA_FIFO >> 8) & 0xFF, (LAN9250_TX_DATA_FIFO & 0xFF)}; |
|
struct spi_buf tx_buf[3]; |
|
const struct spi_buf_set tx = {.buffers = tx_buf, .count = 3}; |
|
|
|
tx_buf[0].buf = &cmd; |
|
tx_buf[0].len = ARRAY_SIZE(cmd); |
|
tx_buf[1].buf = &instr; |
|
tx_buf[1].len = ARRAY_SIZE(instr); |
|
tx_buf[2].buf = data_buffer; |
|
tx_buf[2].len = buf_len; |
|
|
|
return spi_transceive_dt(&config->spi, &tx, NULL); |
|
} |
|
|
|
static int lan9250_read_buf(const struct device *dev, uint8_t *data_buffer, uint16_t buf_len) |
|
{ |
|
const struct lan9250_config *config = dev->config; |
|
uint8_t cmd[1] = {LAN9250_SPI_INSTR_READ}; |
|
uint8_t instr[2] = {(LAN9250_RX_DATA_FIFO >> 8) & 0xFF, (LAN9250_RX_DATA_FIFO & 0xFF)}; |
|
struct spi_buf tx_buf[3]; |
|
struct spi_buf rx_buf[3]; |
|
const struct spi_buf_set tx = {.buffers = tx_buf, .count = 3}; |
|
const struct spi_buf_set rx = {.buffers = rx_buf, .count = 3}; |
|
|
|
tx_buf[0].buf = &cmd; |
|
tx_buf[0].len = ARRAY_SIZE(cmd); |
|
tx_buf[1].buf = &instr; |
|
tx_buf[1].len = ARRAY_SIZE(instr); |
|
tx_buf[2].buf = NULL; |
|
tx_buf[2].len = buf_len; |
|
|
|
rx_buf[0].buf = NULL; |
|
rx_buf[0].len = 1; |
|
rx_buf[1].buf = NULL; |
|
rx_buf[1].len = 2; |
|
rx_buf[2].buf = data_buffer; |
|
rx_buf[2].len = buf_len; |
|
|
|
return spi_transceive_dt(&config->spi, &tx, &rx); |
|
} |
|
|
|
static int lan9250_rx(const struct device *dev) |
|
{ |
|
const struct lan9250_config *config = dev->config; |
|
struct lan9250_runtime *ctx = dev->data; |
|
const uint16_t buf_rx_size = CONFIG_NET_BUF_DATA_SIZE; |
|
struct net_pkt *pkt; |
|
struct net_buf *pkt_buf; |
|
uint16_t pkt_len; |
|
uint8_t pktcnt; |
|
uint32_t tmp; |
|
|
|
/* Check valid packet count */ |
|
lan9250_read_sys_reg(dev, LAN9250_RX_FIFO_INF, &tmp); |
|
pktcnt = (tmp & 0x00ff0000) >> 16; |
|
|
|
/* Check packet length */ |
|
lan9250_read_sys_reg(dev, LAN9250_RX_STATUS_FIFO, &tmp); |
|
pkt_len = (tmp & LAN9250_RX_STS_PACKET_LEN) >> 16; |
|
|
|
if (pktcnt == 0 || pkt_len == 0) { |
|
return 0; |
|
} |
|
|
|
/* Read dummy data */ |
|
lan9250_read_sys_reg(dev, LAN9250_RX_DATA_FIFO, &tmp); |
|
pkt_len -= 4; |
|
|
|
if (pkt_len > NET_ETH_MAX_FRAME_SIZE) { |
|
LOG_ERR("Maximum frame length exceeded, it should be: %d", NET_ETH_MAX_FRAME_SIZE); |
|
eth_stats_update_errors_rx(ctx->iface); |
|
} |
|
|
|
/* Get the frame from the buffer */ |
|
pkt = net_pkt_rx_alloc_with_buffer(ctx->iface, pkt_len, AF_UNSPEC, 0, |
|
K_MSEC(config->timeout)); |
|
if (!pkt) { |
|
LOG_ERR("%s: Could not allocate rx buffer", dev->name); |
|
eth_stats_update_errors_rx(ctx->iface); |
|
return 0; |
|
} |
|
|
|
pkt_buf = pkt->buffer; |
|
|
|
do { |
|
uint8_t *data_ptr = pkt_buf->data; |
|
uint16_t data_len; |
|
|
|
if (pkt_len > buf_rx_size) { |
|
data_len = buf_rx_size; |
|
} else { |
|
data_len = pkt_len; |
|
} |
|
pkt_len -= data_len; |
|
|
|
lan9250_read_buf(dev, data_ptr, data_len); |
|
net_buf_add(pkt_buf, data_len); |
|
pkt_buf = pkt_buf->frags; |
|
} while (pkt_len > 0); |
|
|
|
lan9250_read_sys_reg(dev, LAN9250_RX_DATA_FIFO, &tmp); |
|
net_pkt_set_iface(pkt, ctx->iface); |
|
|
|
/* Feed buffer frame to IP stack */ |
|
if (net_recv_data(net_pkt_iface(pkt), pkt) < 0) { |
|
net_pkt_unref(pkt); |
|
} |
|
|
|
k_sem_give(&ctx->tx_rx_sem); |
|
|
|
return 0; |
|
} |
|
|
|
static int lan9250_tx(const struct device *dev, struct net_pkt *pkt) |
|
{ |
|
struct lan9250_runtime *ctx = dev->data; |
|
size_t len = net_pkt_get_len(pkt); |
|
uint32_t regval; |
|
uint16_t free_size; |
|
uint8_t status_size; |
|
uint32_t tmp; |
|
|
|
lan9250_read_sys_reg(dev, LAN9250_TX_FIFO_INF, ®val); |
|
status_size = (regval & LAN9250_TX_FIFO_INF_TXSUSED) >> 16; |
|
free_size = regval & LAN9250_TX_FIFO_INF_TXFREE; |
|
|
|
k_sem_take(&ctx->tx_rx_sem, K_FOREVER); |
|
|
|
/* TX command 'A' */ |
|
lan9250_write_sys_reg(dev, LAN9250_TX_DATA_FIFO, |
|
LAN9250_TX_CMD_A_INT_ON_COMP | LAN9250_TX_CMD_A_BUFFER_ALIGN_4B | |
|
LAN9250_TX_CMD_A_START_OFFSET_0B | |
|
LAN9250_TX_CMD_A_FIRST_SEG | LAN9250_TX_CMD_A_LAST_SEG | len); |
|
|
|
/* TX command 'B' */ |
|
lan9250_write_sys_reg(dev, LAN9250_TX_DATA_FIFO, LAN9250_TX_CMD_B_PACKET_TAG | len); |
|
|
|
if (net_pkt_read(pkt, ctx->buf, len)) { |
|
return -EIO; |
|
} |
|
|
|
lan9250_write_buf(dev, ctx->buf, LAN9250_ALIGN(len)); |
|
|
|
for (int i = 0; i < status_size; i++) { |
|
lan9250_read_sys_reg(dev, LAN9250_TX_STATUS_FIFO, &tmp); |
|
} |
|
|
|
k_sem_give(&ctx->tx_rx_sem); |
|
|
|
return 0; |
|
} |
|
|
|
static void lan9250_gpio_callback(const struct device *dev, struct gpio_callback *cb, uint32_t pins) |
|
{ |
|
struct lan9250_runtime *context = CONTAINER_OF(cb, struct lan9250_runtime, gpio_cb); |
|
|
|
k_sem_give(&context->int_sem); |
|
} |
|
|
|
static void lan9250_thread(void *p1, void *p2, void *p3) |
|
{ |
|
ARG_UNUSED(p2); |
|
ARG_UNUSED(p3); |
|
|
|
struct lan9250_runtime *context = p1; |
|
uint32_t int_sts; |
|
uint16_t tmp; |
|
uint32_t ier; |
|
|
|
while (true) { |
|
k_sem_take(&context->int_sem, K_FOREVER); |
|
|
|
/* Save interrupt enable register value */ |
|
lan9250_read_sys_reg(context->dev, LAN9250_INT_EN, &ier); |
|
|
|
/* Disable interrupts to release the interrupt line */ |
|
lan9250_write_sys_reg(context->dev, LAN9250_INT_EN, 0); |
|
|
|
/* Read interrupt status register */ |
|
lan9250_read_sys_reg(context->dev, LAN9250_INT_STS, &int_sts); |
|
|
|
if ((int_sts & LAN9250_INT_STS_PHY_INT) != 0) { |
|
|
|
/* Read PHY interrupt source register */ |
|
lan9250_read_phy_reg(context->dev, LAN9250_PHY_INTERRUPT_SOURCE, &tmp); |
|
if (tmp & LAN9250_PHY_INTERRUPT_SOURCE_LINK_UP) { |
|
LOG_DBG("LINK UP"); |
|
net_eth_carrier_on(context->iface); |
|
} else if (tmp & LAN9250_PHY_INTERRUPT_SOURCE_LINK_DOWN) { |
|
LOG_DBG("LINK DOWN"); |
|
net_eth_carrier_off(context->iface); |
|
} |
|
} |
|
|
|
if ((int_sts & LAN9250_INT_STS_RSFL) != 0) { |
|
lan9250_write_sys_reg(context->dev, LAN9250_INT_STS, LAN9250_INT_STS_RSFL); |
|
lan9250_rx(context->dev); |
|
} |
|
|
|
/* Re-enable interrupts */ |
|
lan9250_write_sys_reg(context->dev, LAN9250_INT_EN, ier); |
|
} |
|
} |
|
|
|
static enum ethernet_hw_caps lan9250_get_capabilities(const struct device *dev) |
|
{ |
|
ARG_UNUSED(dev); |
|
|
|
return ETHERNET_LINK_10BASE | ETHERNET_LINK_100BASE; |
|
} |
|
|
|
static void lan9250_iface_init(struct net_if *iface) |
|
{ |
|
const struct device *dev = net_if_get_device(iface); |
|
struct lan9250_runtime *context = dev->data; |
|
|
|
net_if_set_link_addr(iface, context->mac_address, sizeof(context->mac_address), |
|
NET_LINK_ETHERNET); |
|
context->iface = iface; |
|
ethernet_init(iface); |
|
|
|
net_if_carrier_off(iface); |
|
} |
|
|
|
static int lan9250_set_config(const struct device *dev, enum ethernet_config_type type, |
|
const struct ethernet_config *config) |
|
{ |
|
struct lan9250_runtime *ctx = dev->data; |
|
|
|
if (type == ETHERNET_CONFIG_TYPE_MAC_ADDRESS) { |
|
memcpy(ctx->mac_address, config->mac_address.addr, sizeof(ctx->mac_address)); |
|
lan9250_set_macaddr(dev); |
|
return net_if_set_link_addr(ctx->iface, ctx->mac_address, sizeof(ctx->mac_address), |
|
NET_LINK_ETHERNET); |
|
} |
|
|
|
return -ENOTSUP; |
|
} |
|
|
|
static const struct ethernet_api api_funcs = { |
|
.iface_api.init = lan9250_iface_init, |
|
.get_capabilities = lan9250_get_capabilities, |
|
.set_config = lan9250_set_config, |
|
.send = lan9250_tx, |
|
}; |
|
|
|
static int lan9250_init(const struct device *dev) |
|
{ |
|
const struct lan9250_config *config = dev->config; |
|
struct lan9250_runtime *context = dev->data; |
|
|
|
context->dev = dev; |
|
|
|
/* SPI config */ |
|
if (!spi_is_ready_dt(&config->spi)) { |
|
LOG_ERR("SPI master port %s not ready", config->spi.bus->name); |
|
return -EINVAL; |
|
} |
|
|
|
/* Initialize GPIO */ |
|
if (!gpio_is_ready_dt(&config->interrupt)) { |
|
LOG_ERR("GPIO port %s not ready", config->interrupt.port->name); |
|
return -EINVAL; |
|
} |
|
|
|
if (gpio_pin_configure_dt(&config->interrupt, GPIO_INPUT)) { |
|
LOG_ERR("Unable to configure GPIO pin %u", config->interrupt.pin); |
|
return -EINVAL; |
|
} |
|
|
|
gpio_init_callback(&(context->gpio_cb), lan9250_gpio_callback, BIT(config->interrupt.pin)); |
|
if (gpio_add_callback(config->interrupt.port, &(context->gpio_cb))) { |
|
return -EINVAL; |
|
} |
|
|
|
gpio_pin_interrupt_configure_dt(&config->interrupt, GPIO_INT_EDGE_TO_ACTIVE); |
|
|
|
/* Wait until LAN9250 SPI bus is ready */ |
|
lan9250_wait_ready(dev, LAN9250_BYTE_TEST, BOTR_MASK, LAN9250_BYTE_TEST_DEFAULT, |
|
LAN9250_RESET_TIMEOUT); |
|
lan9250_sw_reset(dev); |
|
lan9250_configure(dev); |
|
lan9250_set_macaddr(dev); |
|
|
|
k_thread_create(&context->thread, context->thread_stack, |
|
CONFIG_ETH_LAN9250_RX_THREAD_STACK_SIZE, lan9250_thread, context, NULL, |
|
NULL, K_PRIO_COOP(CONFIG_ETH_LAN9250_RX_THREAD_PRIO), 0, K_NO_WAIT); |
|
|
|
LOG_INF("LAN9250 Initialized"); |
|
|
|
return 0; |
|
} |
|
|
|
#define LAN9250_DEFINE(inst) \ |
|
static struct lan9250_runtime lan9250_##inst##_runtime = { \ |
|
.mac_address = DT_INST_PROP_OR(inst, local_mac_address, {0}), \ |
|
.tx_rx_sem = Z_SEM_INITIALIZER(lan9250_##inst##_runtime.tx_rx_sem, 1, UINT_MAX), \ |
|
.int_sem = Z_SEM_INITIALIZER(lan9250_##inst##_runtime.int_sem, 0, UINT_MAX), \ |
|
}; \ |
|
\ |
|
static const struct lan9250_config lan9250_##inst##_config = { \ |
|
.spi = SPI_DT_SPEC_INST_GET(inst, SPI_WORD_SET(8), 0), \ |
|
.interrupt = GPIO_DT_SPEC_INST_GET(inst, int_gpios), \ |
|
.timeout = CONFIG_ETH_LAN9250_BUF_ALLOC_TIMEOUT, \ |
|
}; \ |
|
\ |
|
ETH_NET_DEVICE_DT_INST_DEFINE(inst, lan9250_init, NULL, &lan9250_##inst##_runtime, \ |
|
&lan9250_##inst##_config, CONFIG_ETH_INIT_PRIORITY, \ |
|
&api_funcs, NET_ETH_MTU); |
|
DT_INST_FOREACH_STATUS_OKAY(LAN9250_DEFINE);
|
|
|