2 * net/dsa/mv88e6060.c - Driver for Marvell 88e6060 switch chips
3 * Copyright (c) 2008 Marvell Semiconductor
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
11 #include <linux/list.h>
12 #include <linux/netdevice.h>
13 #include <linux/phy.h>
16 #define REG_PORT(p) (8 + (p))
17 #define REG_GLOBAL 0x0f
19 static int reg_read(struct dsa_switch
*ds
, int addr
, int reg
)
21 return mdiobus_read(ds
->master_mii_bus
, addr
, reg
);
24 #define REG_READ(addr, reg) \
28 __ret = reg_read(ds, addr, reg); \
35 static int reg_write(struct dsa_switch
*ds
, int addr
, int reg
, u16 val
)
37 return mdiobus_write(ds
->master_mii_bus
, addr
, reg
, val
);
40 #define REG_WRITE(addr, reg, val) \
44 __ret = reg_write(ds, addr, reg, val); \
49 static char *mv88e6060_probe(struct mii_bus
*bus
, int sw_addr
)
53 ret
= mdiobus_read(bus
, REG_PORT(0), 0x03);
57 return "Marvell 88E6060";
63 static int mv88e6060_switch_reset(struct dsa_switch
*ds
)
69 * Set all ports to the disabled state.
71 for (i
= 0; i
< 6; i
++) {
72 ret
= REG_READ(REG_PORT(i
), 0x04);
73 REG_WRITE(REG_PORT(i
), 0x04, ret
& 0xfffc);
77 * Wait for transmit queues to drain.
84 REG_WRITE(REG_GLOBAL
, 0x0A, 0xa130);
87 * Wait up to one second for reset to complete.
89 for (i
= 0; i
< 1000; i
++) {
90 ret
= REG_READ(REG_GLOBAL
, 0x00);
91 if ((ret
& 0x8000) == 0x0000)
102 static int mv88e6060_setup_global(struct dsa_switch
*ds
)
105 * Disable discarding of frames with excessive collisions,
106 * set the maximum frame size to 1536 bytes, and mask all
109 REG_WRITE(REG_GLOBAL
, 0x04, 0x0800);
112 * Enable automatic address learning, set the address
113 * database size to 1024 entries, and set the default aging
116 REG_WRITE(REG_GLOBAL
, 0x0a, 0x2130);
121 static int mv88e6060_setup_port(struct dsa_switch
*ds
, int p
)
123 int addr
= REG_PORT(p
);
126 * Do not force flow control, disable Ingress and Egress
127 * Header tagging, disable VLAN tunneling, and set the port
128 * state to Forwarding. Additionally, if this is the CPU
129 * port, enable Ingress and Egress Trailer tagging mode.
131 REG_WRITE(addr
, 0x04, (p
== ds
->cpu_port
) ? 0x4103 : 0x0003);
134 * Port based VLAN map: give each port its own address
135 * database, allow the CPU port to talk to each of the 'real'
136 * ports, and allow each of the 'real' ports to only talk to
139 REG_WRITE(addr
, 0x06,
141 ((p
== ds
->cpu_port
) ?
142 ds
->valid_port_mask
:
143 (1 << ds
->cpu_port
)));
146 * Port Association Vector: when learning source addresses
147 * of packets, add the address to the address database using
148 * a port bitmap that has only the bit for this port set and
149 * the other bits clear.
151 REG_WRITE(addr
, 0x0b, 1 << p
);
156 static int mv88e6060_setup(struct dsa_switch
*ds
)
161 ret
= mv88e6060_switch_reset(ds
);
165 /* @@@ initialise atu */
167 ret
= mv88e6060_setup_global(ds
);
171 for (i
= 0; i
< 6; i
++) {
172 ret
= mv88e6060_setup_port(ds
, i
);
180 static int mv88e6060_set_addr(struct dsa_switch
*ds
, u8
*addr
)
182 REG_WRITE(REG_GLOBAL
, 0x01, (addr
[0] << 8) | addr
[1]);
183 REG_WRITE(REG_GLOBAL
, 0x02, (addr
[2] << 8) | addr
[3]);
184 REG_WRITE(REG_GLOBAL
, 0x03, (addr
[4] << 8) | addr
[5]);
189 static int mv88e6060_port_to_phy_addr(int port
)
191 if (port
>= 0 && port
<= 5)
196 static int mv88e6060_phy_read(struct dsa_switch
*ds
, int port
, int regnum
)
200 addr
= mv88e6060_port_to_phy_addr(port
);
204 return reg_read(ds
, addr
, regnum
);
208 mv88e6060_phy_write(struct dsa_switch
*ds
, int port
, int regnum
, u16 val
)
212 addr
= mv88e6060_port_to_phy_addr(port
);
216 return reg_write(ds
, addr
, regnum
, val
);
219 static void mv88e6060_poll_link(struct dsa_switch
*ds
)
223 for (i
= 0; i
< DSA_MAX_PORTS
; i
++) {
224 struct net_device
*dev
;
225 int uninitialized_var(port_status
);
236 if (dev
->flags
& IFF_UP
) {
237 port_status
= reg_read(ds
, REG_PORT(i
), 0x00);
241 link
= !!(port_status
& 0x1000);
245 if (netif_carrier_ok(dev
)) {
246 printk(KERN_INFO
"%s: link down\n", dev
->name
);
247 netif_carrier_off(dev
);
252 speed
= (port_status
& 0x0100) ? 100 : 10;
253 duplex
= (port_status
& 0x0200) ? 1 : 0;
254 fc
= ((port_status
& 0xc000) == 0xc000) ? 1 : 0;
256 if (!netif_carrier_ok(dev
)) {
257 printk(KERN_INFO
"%s: link up, %d Mb/s, %s duplex, "
258 "flow control %sabled\n", dev
->name
,
259 speed
, duplex
? "full" : "half",
261 netif_carrier_on(dev
);
266 static struct dsa_switch_driver mv88e6060_switch_driver
= {
267 .tag_protocol
= htons(ETH_P_TRAILER
),
268 .probe
= mv88e6060_probe
,
269 .setup
= mv88e6060_setup
,
270 .set_addr
= mv88e6060_set_addr
,
271 .phy_read
= mv88e6060_phy_read
,
272 .phy_write
= mv88e6060_phy_write
,
273 .poll_link
= mv88e6060_poll_link
,
276 int __init
mv88e6060_init(void)
278 register_switch_driver(&mv88e6060_switch_driver
);
281 module_init(mv88e6060_init
);
283 void __exit
mv88e6060_cleanup(void)
285 unregister_switch_driver(&mv88e6060_switch_driver
);
287 module_exit(mv88e6060_cleanup
);