1/* 2 * Miscellaneous SoC-specific hooks. 3 * 4 * Copyright (C) 2011 Texas Instruments Incorporated 5 * Author: Mark Salter <msalter@redhat.com> 6 * 7 * This program is free software; you can redistribute it and/or modify 8 * it under the terms of the GNU General Public License version 2 as 9 * published by the Free Software Foundation. 10 */ 11#include <linux/module.h> 12#include <linux/ctype.h> 13#include <linux/etherdevice.h> 14#include <asm/setup.h> 15#include <asm/soc.h> 16 17struct soc_ops soc_ops; 18 19int soc_get_exception(void) 20{ 21 if (!soc_ops.get_exception) 22 return -1; 23 return soc_ops.get_exception(); 24} 25 26void soc_assert_event(unsigned int evt) 27{ 28 if (soc_ops.assert_event) 29 soc_ops.assert_event(evt); 30} 31 32static u8 cmdline_mac[6]; 33 34static int __init get_mac_addr_from_cmdline(char *str) 35{ 36 int count, i, val; 37 38 for (count = 0; count < 6 && *str; count++, str += 3) { 39 if (!isxdigit(str[0]) || !isxdigit(str[1])) 40 return 0; 41 if (str[2] != ((count < 5) ? ':' : '\0')) 42 return 0; 43 44 for (i = 0, val = 0; i < 2; i++) { 45 val = val << 4; 46 val |= isdigit(str[i]) ? 47 str[i] - '0' : toupper(str[i]) - 'A' + 10; 48 } 49 cmdline_mac[count] = val; 50 } 51 return 1; 52} 53__setup("emac_addr=", get_mac_addr_from_cmdline); 54 55/* 56 * Setup the MAC address for SoC ethernet devices. 57 * 58 * Before calling this function, the ethernet driver will have 59 * initialized the addr with local-mac-address from the device 60 * tree (if found). Allow command line to override, but not 61 * the fused address. 62 */ 63int soc_mac_addr(unsigned int index, u8 *addr) 64{ 65 int i, have_dt_mac = 0, have_cmdline_mac = 0, have_fuse_mac = 0; 66 67 for (i = 0; i < 6; i++) { 68 if (cmdline_mac[i]) 69 have_cmdline_mac = 1; 70 if (c6x_fuse_mac[i]) 71 have_fuse_mac = 1; 72 if (addr[i]) 73 have_dt_mac = 1; 74 } 75 76 /* cmdline overrides all */ 77 if (have_cmdline_mac) 78 memcpy(addr, cmdline_mac, 6); 79 else if (!have_dt_mac) { 80 if (have_fuse_mac) 81 memcpy(addr, c6x_fuse_mac, 6); 82 else 83 eth_random_addr(addr); 84 } 85 86 /* adjust for specific EMAC device */ 87 addr[5] += index * c6x_num_cores; 88 return 1; 89} 90EXPORT_SYMBOL_GPL(soc_mac_addr); 91