+static int at91emac_write_hwaddr(struct eth_device *netdev)
+{
+ at91_emac_t *emac;
+ emac = (at91_emac_t *) netdev->iobase;
+
+ at91_periph_clk_enable(ATMEL_ID_EMAC);
+
+ debug_cond(DEBUG_AT91EMAC,
+ "init MAC-ADDR %02x:%02x:%02x:%02x:%02x:%02x\n",
+ netdev->enetaddr[5], netdev->enetaddr[4], netdev->enetaddr[3],
+ netdev->enetaddr[2], netdev->enetaddr[1], netdev->enetaddr[0]);
+ writel( (netdev->enetaddr[0] | netdev->enetaddr[1] << 8 |
+ netdev->enetaddr[2] << 16 | netdev->enetaddr[3] << 24),
+ &emac->sa2l);
+ writel((netdev->enetaddr[4] | netdev->enetaddr[5] << 8), &emac->sa2h);
+ debug_cond(DEBUG_AT91EMAC, "init MAC-ADDR %x%x\n",
+ readl(&emac->sa2h), readl(&emac->sa2l));
+ return 0;
+}
+