]>
Commit | Line | Data |
---|---|---|
111fd19e RZ |
1 | /* |
2 | * Copyright 2012 Freescale Semiconductor, Inc. | |
3 | * Roy Zang <tie-fei.zang@freescale.com> | |
4 | * | |
5 | * This program is free software; you can redistribute it and/or | |
6 | * modify it under the terms of the GNU General Public License as | |
7 | * published by the Free Software Foundation; either version 2 of | |
8 | * the License, or (at your option) any later version. | |
9 | * | |
10 | * This program is distributed in the hope that it will be useful, | |
11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
13 | * GNU General Public License for more details. | |
14 | * | |
15 | * You should have received a copy of the GNU General Public License | |
16 | * along with this program; if not, write to the Free Software | |
17 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, | |
18 | * MA 02111-1307 USA | |
19 | */ | |
20 | ||
21 | /* MAXFRM - maximum frame length */ | |
22 | #define MAXFRM_MASK 0x0000ffff | |
23 | ||
24 | #include <common.h> | |
25 | #include <phy.h> | |
26 | #include <asm/types.h> | |
27 | #include <asm/io.h> | |
28 | #include <asm/fsl_enet.h> | |
29 | #include <asm/fsl_memac.h> | |
30 | ||
31 | #include "fm.h" | |
32 | ||
33 | static void memac_init_mac(struct fsl_enet_mac *mac) | |
34 | { | |
35 | struct memac *regs = mac->base; | |
36 | ||
37 | /* mask all interrupt */ | |
38 | out_be32(®s->imask, IMASK_MASK_ALL); | |
39 | ||
40 | /* clear all events */ | |
41 | out_be32(®s->ievent, IEVENT_CLEAR_ALL); | |
42 | ||
43 | /* set the max receive length */ | |
44 | out_be32(®s->maxfrm, mac->max_rx_len & MAXFRM_MASK); | |
45 | ||
46 | /* multicast frame reception for the hash entry disable */ | |
47 | out_be32(®s->hashtable_ctrl, 0); | |
48 | } | |
49 | ||
50 | static void memac_enable_mac(struct fsl_enet_mac *mac) | |
51 | { | |
52 | struct memac *regs = mac->base; | |
53 | ||
54 | setbits_be32(®s->command_config, MEMAC_CMD_CFG_RXTX_EN); | |
55 | } | |
56 | ||
57 | static void memac_disable_mac(struct fsl_enet_mac *mac) | |
58 | { | |
59 | struct memac *regs = mac->base; | |
60 | ||
61 | clrbits_be32(®s->command_config, MEMAC_CMD_CFG_RXTX_EN); | |
62 | } | |
63 | ||
64 | static void memac_set_mac_addr(struct fsl_enet_mac *mac, u8 *mac_addr) | |
65 | { | |
66 | struct memac *regs = mac->base; | |
67 | u32 mac_addr0, mac_addr1; | |
68 | ||
69 | /* | |
70 | * if a station address of 0x12345678ABCD, perform a write to | |
71 | * MAC_ADDR0 of 0x78563412, MAC_ADDR1 of 0x0000CDAB | |
72 | */ | |
73 | mac_addr0 = (mac_addr[3] << 24) | (mac_addr[2] << 16) | \ | |
74 | (mac_addr[1] << 8) | (mac_addr[0]); | |
75 | out_be32(®s->mac_addr_0, mac_addr0); | |
76 | ||
77 | mac_addr1 = ((mac_addr[5] << 8) | mac_addr[4]) & 0x0000ffff; | |
78 | out_be32(®s->mac_addr_1, mac_addr1); | |
79 | } | |
80 | ||
81 | static void memac_set_interface_mode(struct fsl_enet_mac *mac, | |
82 | phy_interface_t type, int speed) | |
83 | { | |
84 | /* Roy need more work here */ | |
85 | ||
86 | struct memac *regs = mac->base; | |
87 | u32 if_mode, if_status; | |
88 | ||
89 | /* clear all bits relative with interface mode */ | |
90 | if_mode = in_be32(®s->if_mode); | |
91 | if_status = in_be32(®s->if_status); | |
92 | ||
93 | /* set interface mode */ | |
94 | switch (type) { | |
95 | case PHY_INTERFACE_MODE_GMII: | |
96 | if_mode &= ~IF_MODE_MASK; | |
97 | if_mode |= IF_MODE_GMII; | |
98 | break; | |
99 | case PHY_INTERFACE_MODE_RGMII: | |
100 | if_mode |= (IF_MODE_GMII | IF_MODE_RG); | |
101 | break; | |
102 | case PHY_INTERFACE_MODE_RMII: | |
103 | if_mode |= (IF_MODE_GMII | IF_MODE_RM); | |
104 | break; | |
105 | case PHY_INTERFACE_MODE_SGMII: | |
106 | if_mode &= ~IF_MODE_MASK; | |
107 | if_mode |= (IF_MODE_GMII); | |
108 | break; | |
109 | default: | |
110 | break; | |
111 | } | |
112 | /* Enable automatic speed selection */ | |
113 | if_mode |= IF_MODE_EN_AUTO; | |
114 | ||
c5729f0b ZRR |
115 | if (type == PHY_INTERFACE_MODE_RGMII) { |
116 | if_mode &= ~IF_MODE_EN_AUTO; | |
117 | if_mode &= ~IF_MODE_SETSP_MASK; | |
118 | switch (speed) { | |
119 | case SPEED_1000: | |
120 | if_mode |= IF_MODE_SETSP_1000M; | |
121 | break; | |
122 | case SPEED_100: | |
123 | if_mode |= IF_MODE_SETSP_100M; | |
124 | break; | |
125 | case SPEED_10: | |
126 | if_mode |= IF_MODE_SETSP_10M; | |
127 | default: | |
128 | break; | |
129 | } | |
130 | } | |
131 | ||
111fd19e RZ |
132 | debug(" %s, if_mode = %x\n", __func__, if_mode); |
133 | debug(" %s, if_status = %x\n", __func__, if_status); | |
134 | out_be32(®s->if_mode, if_mode); | |
135 | return; | |
136 | } | |
137 | ||
138 | void init_memac(struct fsl_enet_mac *mac, void *base, | |
139 | void *phyregs, int max_rx_len) | |
140 | { | |
141 | mac->base = base; | |
142 | mac->phyregs = phyregs; | |
143 | mac->max_rx_len = max_rx_len; | |
144 | mac->init_mac = memac_init_mac; | |
145 | mac->enable_mac = memac_enable_mac; | |
146 | mac->disable_mac = memac_disable_mac; | |
147 | mac->set_mac_addr = memac_set_mac_addr; | |
148 | mac->set_if_mode = memac_set_interface_mode; | |
149 | } |