1
2
3
4
5
6#include <common.h>
7#include <asm/types.h>
8#include <asm/io.h>
9#include <fsl_dtsec.h>
10#include <fsl_mdio.h>
11#include <phy.h>
12
13#include "fm.h"
14
15#define RCTRL_INIT (RCTRL_GRS | RCTRL_UPROM)
16#define TCTRL_INIT TCTRL_GTS
17#define MACCFG1_INIT MACCFG1_SOFT_RST
18
19#define MACCFG2_INIT (MACCFG2_PRE_LEN(0x7) | MACCFG2_LEN_CHECK | \
20 MACCFG2_PAD_CRC | MACCFG2_FULL_DUPLEX | \
21 MACCFG2_IF_MODE_NIBBLE)
22
23
24#define MAXFRM_MASK 0x00003fff
25
26static void dtsec_init_mac(struct fsl_enet_mac *mac)
27{
28 struct dtsec *regs = mac->base;
29
30
31 out_be32(®s->maccfg1, MACCFG1_SOFT_RST);
32 udelay(1000);
33
34
35 out_be32(®s->maccfg1, 0);
36
37
38 out_be32(®s->rctrl, RCTRL_INIT);
39 udelay(1000);
40
41
42 out_be32(®s->tctrl, TCTRL_INIT);
43 udelay(1000);
44
45
46 out_be32(®s->imask, IMASK_MASK_ALL);
47
48
49 out_be32(®s->ievent, IEVENT_CLEAR_ALL);
50
51
52 out_be32(®s->maxfrm, mac->max_rx_len & MAXFRM_MASK);
53
54
55 out_be32(®s->ecntrl, ECNTRL_DEFAULT);
56
57
58
59
60
61 out_be32(®s->maccfg2, MACCFG2_INIT);
62}
63
64static void dtsec_enable_mac(struct fsl_enet_mac *mac)
65{
66 struct dtsec *regs = mac->base;
67
68
69 setbits_be32(®s->maccfg1, MACCFG1_RXTX_EN);
70
71
72 clrbits_be32(®s->rctrl, RCTRL_GRS);
73
74
75 clrbits_be32(®s->tctrl, TCTRL_GTS);
76}
77
78static void dtsec_disable_mac(struct fsl_enet_mac *mac)
79{
80 struct dtsec *regs = mac->base;
81
82
83 setbits_be32(®s->rctrl, RCTRL_GRS);
84
85
86 setbits_be32(®s->tctrl, TCTRL_GTS);
87
88
89 clrbits_be32(®s->maccfg1, MACCFG1_RXTX_EN);
90}
91
92static void dtsec_set_mac_addr(struct fsl_enet_mac *mac, u8 *mac_addr)
93{
94 struct dtsec *regs = mac->base;
95 u32 mac_addr1, mac_addr2;
96
97
98
99
100
101 mac_addr1 = (mac_addr[5] << 24) | (mac_addr[4] << 16) | \
102 (mac_addr[3] << 8) | (mac_addr[2]);
103 out_be32(®s->macstnaddr1, mac_addr1);
104
105 mac_addr2 = ((mac_addr[1] << 24) | (mac_addr[0] << 16)) & 0xffff0000;
106 out_be32(®s->macstnaddr2, mac_addr2);
107}
108
109static void dtsec_set_interface_mode(struct fsl_enet_mac *mac,
110 phy_interface_t type, int speed)
111{
112 struct dtsec *regs = mac->base;
113 u32 ecntrl, maccfg2;
114
115
116 ecntrl = in_be32(®s->ecntrl);
117 ecntrl &= ~(ECNTRL_TBIM | ECNTRL_GMIIM | ECNTRL_RPM |
118 ECNTRL_R100M | ECNTRL_SGMIIM);
119
120 maccfg2 = in_be32(®s->maccfg2);
121 maccfg2 &= ~MACCFG2_IF_MODE_MASK;
122
123 if (speed == SPEED_1000)
124 maccfg2 |= MACCFG2_IF_MODE_BYTE;
125 else
126 maccfg2 |= MACCFG2_IF_MODE_NIBBLE;
127
128
129 switch (type) {
130 case PHY_INTERFACE_MODE_GMII:
131 ecntrl |= ECNTRL_GMIIM;
132 break;
133 case PHY_INTERFACE_MODE_RGMII:
134 ecntrl |= (ECNTRL_GMIIM | ECNTRL_RPM);
135 if (speed == SPEED_100)
136 ecntrl |= ECNTRL_R100M;
137 break;
138 case PHY_INTERFACE_MODE_RMII:
139 if (speed == SPEED_100)
140 ecntrl |= ECNTRL_R100M;
141 break;
142 case PHY_INTERFACE_MODE_SGMII:
143 ecntrl |= (ECNTRL_SGMIIM | ECNTRL_TBIM);
144 if (speed == SPEED_100)
145 ecntrl |= ECNTRL_R100M;
146 break;
147 default:
148 break;
149 }
150
151 out_be32(®s->ecntrl, ecntrl);
152 out_be32(®s->maccfg2, maccfg2);
153}
154
155void init_dtsec(struct fsl_enet_mac *mac, void *base,
156 void *phyregs, int max_rx_len)
157{
158 mac->base = base;
159 mac->phyregs = phyregs;
160 mac->max_rx_len = max_rx_len;
161 mac->init_mac = dtsec_init_mac;
162 mac->enable_mac = dtsec_enable_mac;
163 mac->disable_mac = dtsec_disable_mac;
164 mac->set_mac_addr = dtsec_set_mac_addr;
165 mac->set_if_mode = dtsec_set_interface_mode;
166}
167