1 | // SPDX-License-Identifier: GPL-2.0-or-later |
2 | /* |
3 | * Applied Micro X-Gene SoC Ethernet v2 Driver |
4 | * |
5 | * Copyright (c) 2017, Applied Micro Circuits Corporation |
6 | * Author(s): Iyappan Subramanian <isubramanian@apm.com> |
7 | * Keyur Chudgar <kchudgar@apm.com> |
8 | */ |
9 | |
10 | #include "main.h" |
11 | |
12 | void xge_wr_csr(struct xge_pdata *pdata, u32 offset, u32 val) |
13 | { |
14 | void __iomem *addr = pdata->resources.base_addr + offset; |
15 | |
16 | iowrite32(val, addr); |
17 | } |
18 | |
19 | u32 xge_rd_csr(struct xge_pdata *pdata, u32 offset) |
20 | { |
21 | void __iomem *addr = pdata->resources.base_addr + offset; |
22 | |
23 | return ioread32(addr); |
24 | } |
25 | |
26 | int xge_port_reset(struct net_device *ndev) |
27 | { |
28 | struct xge_pdata *pdata = netdev_priv(dev: ndev); |
29 | struct device *dev = &pdata->pdev->dev; |
30 | u32 data, wait = 10; |
31 | |
32 | xge_wr_csr(pdata, ENET_CLKEN, val: 0x3); |
33 | xge_wr_csr(pdata, ENET_SRST, val: 0xf); |
34 | xge_wr_csr(pdata, ENET_SRST, val: 0); |
35 | xge_wr_csr(pdata, CFG_MEM_RAM_SHUTDOWN, val: 1); |
36 | xge_wr_csr(pdata, CFG_MEM_RAM_SHUTDOWN, val: 0); |
37 | |
38 | do { |
39 | usleep_range(min: 100, max: 110); |
40 | data = xge_rd_csr(pdata, BLOCK_MEM_RDY); |
41 | } while (data != MEM_RDY && wait--); |
42 | |
43 | if (data != MEM_RDY) { |
44 | dev_err(dev, "ECC init failed: %x\n" , data); |
45 | return -ETIMEDOUT; |
46 | } |
47 | |
48 | xge_wr_csr(pdata, ENET_SHIM, DEVM_ARAUX_COH | DEVM_AWAUX_COH); |
49 | |
50 | return 0; |
51 | } |
52 | |
53 | static void xge_traffic_resume(struct net_device *ndev) |
54 | { |
55 | struct xge_pdata *pdata = netdev_priv(dev: ndev); |
56 | |
57 | xge_wr_csr(pdata, CFG_FORCE_LINK_STATUS_EN, val: 1); |
58 | xge_wr_csr(pdata, FORCE_LINK_STATUS, val: 1); |
59 | |
60 | xge_wr_csr(pdata, CFG_LINK_AGGR_RESUME, val: 1); |
61 | xge_wr_csr(pdata, RX_DV_GATE_REG, val: 1); |
62 | } |
63 | |
64 | void xge_port_init(struct net_device *ndev) |
65 | { |
66 | struct xge_pdata *pdata = netdev_priv(dev: ndev); |
67 | |
68 | pdata->phy_speed = SPEED_1000; |
69 | xge_mac_init(pdata); |
70 | xge_traffic_resume(ndev); |
71 | } |
72 | |