[PATCH] Pegasus: Add MAC programmability

[Davide Rizzo <elpa.rizzo-Re5JQEeQqe8AvxtiuMwx3w@public.gmane.org>]

Added capability to set mac address and to program it into EEPROM

Signed-off-by: Davide Rizzo <elpa.rizzo-Re5JQEeQqe8AvxtiuMwx3w@public.gmane.org>
---
diff -urNp linux-2.6.30.4/drivers/net/usb/pegasus.c
linux-2.6.30.4.elpa/drivers/net/usb/pegasus.c
--- linux-2.6.30.4/drivers/net/usb/pegasus.c	2009-08-13 07:14:57.000000000 +0200
+++ linux-2.6.30.4.elpa/drivers/net/usb/pegasus.c	2009-08-13
08:39:01.000000000 +0200
@@ -469,8 +467,49 @@ fail:
 		dev_warn(&pegasus->intf->dev, "%s failed\n", __func__);
 	return -ETIMEDOUT;
 }
+
+/* Got from adm 8515 starter kit */
+static const __u16 def_eeprom[] = {
+			  0x8515, 0x0170, 0x0082, 0x0409, 0x0000,
+	0x07a6, 0x8515, 0x100e, 0x202a, 0x380a, 0x0000, 0x0000, 0x0000,
+	0x030e, 0x0041, 0x0044, 0x004d, 0x0074, 0x0065, 0x006b, 0x0000,
+	0x001e, 0x0055, 0x0053, 0x0042, 0x0020, 0x0031, 0x0030, 0x002f,
+	0x032a, 0x0055, 0x0053, 0x0042, 0x0020, 0x0054, 0x006f, 0x0020,
+	0x004c, 0x0041, 0x004e, 0x0020, 0x0043, 0x006f, 0x006e, 0x0076,
+	0x0065, 0x0072, 0x0074, 0x0065, 0x0072, 0x0000, 0x0000, 0x0000,
+	0x030a, 0x0030, 0x0030, 0x0030, 0x0031, 0x0000, 0x0000, 0x0000,
+};
 #endif				/* PEGASUS_WRITE_EEPROM */

+static int pegasus_set_mac_address(struct net_device *netdev, void *p)
+{
+	struct sockaddr *addr = p;
+	pegasus_t *pegasus = (pegasus_t *) netdev_priv(netdev);
+	int i;
+
+	if (netif_running(netdev))
+		return -EBUSY;
+	memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
+	dbg("%s: Setting MAC address to ", netdev->name);
+	for (i = 0; i < 5; i++)
+		dbg("%02X:", netdev->dev_addr[i]);
+	dbg("%02X\n", netdev->dev_addr[i]);
+	/* Set the IDR registers. */
+	set_registers(pegasus, EthID, 6, netdev->dev_addr);
+#ifdef PEGASUS_WRITE_EEPROM
+	write_eprom_word(pegasus, 0,
+		(netdev->dev_addr[1] << 8) + netdev->dev_addr[0]);
+	write_eprom_word(pegasus, 1,
+		(netdev->dev_addr[3] << 8) + netdev->dev_addr[2]);
+	write_eprom_word(pegasus, 2,
+		(netdev->dev_addr[5] << 8) + netdev->dev_addr[4]);
+	for (i = 0; i < ARRAY_SIZE(def_eeprom); i++)
+		write_eprom_word(pegasus, i + 3, def_eeprom[i]);
+
+#endif                         /* PEGASUS_WRITE_EEPROM */
+	return 0;
+}
+
 static inline void get_node_id(pegasus_t * pegasus, __u8 * id)
 {
 	int i;
@@ -1492,6 +1531,7 @@ static const struct net_device_ops pegas
 	.ndo_start_xmit =		pegasus_start_xmit,
 	.ndo_set_multicast_list =	pegasus_set_multicast,
 	.ndo_get_stats =		pegasus_netdev_stats,
+	.ndo_set_mac_address =	pegasus_set_mac_address,
 	.ndo_tx_timeout =		pegasus_tx_timeout,
 	.ndo_change_mtu =		eth_change_mtu,
 	.ndo_set_mac_address =		eth_mac_addr,
--
To unsubscribe from this list: send the line "unsubscribe linux-usb" in
the body of a message to majordomo-u79uwXL29TY76Z2rM5mHXA@public.gmane.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html