net: Adds Fast Ethernet Controller driver for Armada100

This patch adds support for Fast Ethernet Controller driver for Armada100 series.

Signed-off-by Ajay Bhargav <[email protected]>

drivers/net/armada100_fec.c new file +36 -0

+		*value = reg_data & 0x1f;
+		return 0;
+	}
+
+	/* check parameters */
+	if (phy_addr > PHY_MASK) {
+		printf("ARMD100 FEC: (%s) Invalid phy address: 0x%X\n",
+				__func__, phy_addr);
+		return -EINVAL;
+	}
+	if (phy_reg > PHY_MASK) {
+		printf("ARMD100 FEC: (%s) Invalid register offset: 0x%X\n",
+				__func__, phy_reg);
+		return -EINVAL;
+	}
+
+	/* wait for the SMI register to become available */
+	if (armdfec_phy_timeout(&regs->smi, SMI_BUSY, FALSE)) {
+		printf("ARMD100 FEC: (%s) PHY busy timeout\n",	__func__);
+		return -1;
+	}
+
+	writel((phy_addr << 16) | (phy_reg << 21) | SMI_OP_R, &regs->smi);
+
+	/* now wait for the data to be valid */
+	if (armdfec_phy_timeout(&regs->smi, SMI_R_VALID, TRUE)) {
+		val = readl(&regs->smi);
+		printf("ARMD100 FEC: (%s) PHY Read timeout, val=0x%x\n",
+				__func__, val);
+		return -1;
+	}
+	val = readl(&regs->smi);
+	*value = val & 0xffff;
+
+	return 0;
+}

drivers/net/armada100_fec.c new file +30 -0

+static int add_del_hash_entry(struct armdfec_device *darmdfec, u32 mach,
+			      u32 macl, u32 rd, u32 skip, int del)
+{
+	struct addr_table_entry_t *entry, *start;
+	u32 newhi;
+	u32 newlo;
+	u32 i;
+
+	newlo = (((mach >> 4) & 0xf) << 15)
+		| (((mach >> 0) & 0xf) << 11)
+		| (((mach >> 12) & 0xf) << 7)
+		| (((mach >> 8) & 0xf) << 3)
+		| (((macl >> 20) & 0x1) << 31)
+		| (((macl >> 16) & 0xf) << 27)
+		| (((macl >> 28) & 0xf) << 23)
+		| (((macl >> 24) & 0xf) << 19)
+		| (skip << HTESKIP) | (rd << HTERDBIT)
+		| HTEVALID;
+
+	newhi = (((macl >> 4) & 0xf) << 15)
+		| (((macl >> 0) & 0xf) << 11)
+		| (((macl >> 12) & 0xf) << 7)
+		| (((macl >> 8) & 0xf) << 3)
+		| (((macl >> 21) & 0x7) << 0);
+
+	/*
+	 * Pick the appropriate table, start scanning for free/reusable
+	 * entries at the index obtained by hashing the specified MAC address
+	 */
+	start = (struct addr_table_entry_t *) (darmdfec->htpr);

drivers/net/armada100_fec.c new file +10 -0

+
+	if (i == HOP_NUMBER) {
+		if (!del) {
+			printf("ARMD100 FEC: (%s) table section is full\n",
+					__func__);
+			return -ENOSPC;
+		} else {
+			return 0;
+		}
+	}

drivers/net/armada100_fec.c new file +2 -0

+	if ((mtu > MAX_PKT_SIZE) || (mtu < 64))
+		return -EINVAL;

drivers/net/armada100_fec.c new file +14 -0

+static void update_hash_table_mac_address(struct armdfec_device *darmdfec,
+					  u8 *oaddr, u8 *addr)
+{
+	u32 mach;
+	u32 macl;
+
+	/* Delete old entry */
+	if (oaddr) {
+		mach = (oaddr[0] << 8) | oaddr[1];
+		macl = (oaddr[2] << 24) | (oaddr[3] << 16) |
+			(oaddr[4] << 8) | oaddr[5];
+		add_del_hash_entry(darmdfec, mach, macl, 1, 0, HASH_DELETE);
+	}
+

Quoted 1 line · On Tuesday, August 30, 2011 01:44:40 Ajay Bhargav wrote:

+static void update_hash_table_mac_address(struct armdfec_device

*darmdfec,

Quoted 6 lines

drivers/net/armada100_fec.c new file +6 -0

+					  u8 *oaddr, u8 *addr)
+{
+	u32 mach;
+	u32 macl;
+
+	/* Delete old entry */

drivers/net/armada100_fec.c

Quoted 10 lines

drivers/net/armada100_fec.c new file +10 -0

+	if (oaddr) {
+		mach = (oaddr[0] << 8) | oaddr[1];
+		macl = (oaddr[2] << 24) | (oaddr[3] << 16) |
+			(oaddr[4] << 8) | oaddr[5];
+		add_del_hash_entry(darmdfec, mach, macl, 1, 0, HASH_DELETE);
+	}
+
+	/* Add new entry */
+	mach = (addr[0] << 8) | addr[1];
+	macl = (addr[2] << 24) | (addr[3] << 16) | (addr[4] << 8) |

addr[5];

drivers/net/armada100_fec.c

Quoted 7 lines

drivers/net/armada100_fec.c new file +5 -0

+	add_del_hash_entry(darmdfec, mach, macl, 1, 0, HASH_ADD);
+}
...
+static int armdfec_init(struct eth_device *dev, bd_t *bd)
+{
...
+	update_hash_table_mac_address(darmdfec, dev->enetaddr,

dev->enetaddr);

i think something got lost along the way here :)

you'll probably want to have oaddr[] be a static local in update_hash_table_mac_address and use that to delete the old one when it
differs from the new one, and then copy the new one into the static local.
-mike

Quoted 29 lines · ----- "Mike Frysinger

Quoted 1 line · On Tuesday, August 30, 2011 01:44:40 Ajay Bhargav wrote:

+static void update_hash_table_mac_address(struct armdfec_device

*darmdfec,

Quoted 6 lines

drivers/net/armada100_fec.c new file +6 -0

+					  u8 *oaddr, u8 *addr)
+{
+	u32 mach;
+	u32 macl;
+
+	/* Delete old entry */

drivers/net/armada100_fec.c

Quoted 10 lines

drivers/net/armada100_fec.c new file +10 -0

+	if (oaddr) {
+		mach = (oaddr[0] << 8) | oaddr[1];
+		macl = (oaddr[2] << 24) | (oaddr[3] << 16) |
+			(oaddr[4] << 8) | oaddr[5];
+		add_del_hash_entry(darmdfec, mach, macl, 1, 0, HASH_DELETE);
+	}
+
+	/* Add new entry */
+	mach = (addr[0] << 8) | addr[1];
+	macl = (addr[2] << 24) | (addr[3] << 16) | (addr[4] << 8) |

addr[5];

drivers/net/armada100_fec.c

Quoted 7 lines

drivers/net/armada100_fec.c new file +5 -0

+	add_del_hash_entry(darmdfec, mach, macl, 1, 0, HASH_ADD);
+}
...
+static int armdfec_init(struct eth_device *dev, bd_t *bd)
+{
...
+	update_hash_table_mac_address(darmdfec, dev->enetaddr,

dev->enetaddr);

Quoted 4 lines

i think something got lost along the way here :)

you'll probably want to have oaddr[] be a static local in update_hash_table_mac_address and use that to delete the old one

when

Quoted 4 lines

it
differs from the new one, and then copy the new one into the static local.
-mike

You can have multiple entries in Hash table for different MAC addresses.
The reason old entry is deleted because it may be possible that hash entry
in the list is skipped but not invalidated so the same entry is made valid
in the list after removing the old one and updating list with new entry.
The calculated has for a particular MAC address is going to be same.

Thanks,
Ajay Bhargav