aboutsummaryrefslogtreecommitdiffstats
diff options
context:
space:
mode:
Diffstat (limited to 'arch/c6x/kernel/soc.c')
-rw-r--r--arch/c6x/kernel/soc.c91
1 files changed, 91 insertions, 0 deletions
diff --git a/arch/c6x/kernel/soc.c b/arch/c6x/kernel/soc.c
new file mode 100644
index 000000000000..dd45bc39af0e
--- /dev/null
+++ b/arch/c6x/kernel/soc.c
@@ -0,0 +1,91 @@
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/system.h>
15#include <asm/setup.h>
16#include <asm/soc.h>
17
18struct soc_ops soc_ops;
19
20int soc_get_exception(void)
21{
22 if (!soc_ops.get_exception)
23 return -1;
24 return soc_ops.get_exception();
25}
26
27void soc_assert_event(unsigned int evt)
28{
29 if (soc_ops.assert_event)
30 soc_ops.assert_event(evt);
31}
32
33static u8 cmdline_mac[6];
34
35static int __init get_mac_addr_from_cmdline(char *str)
36{
37 int count, i, val;
38
39 for (count = 0; count < 6 && *str; count++, str += 3) {
40 if (!isxdigit(str[0]) || !isxdigit(str[1]))
41 return 0;
42 if (str[2] != ((count < 5) ? ':' : '\0'))
43 return 0;
44
45 for (i = 0, val = 0; i < 2; i++) {
46 val = val << 4;
47 val |= isdigit(str[i]) ?
48 str[i] - '0' : toupper(str[i]) - 'A' + 10;
49 }
50 cmdline_mac[count] = val;
51 }
52 return 1;
53}
54__setup("emac_addr=", get_mac_addr_from_cmdline);
55
56/*
57 * Setup the MAC address for SoC ethernet devices.
58 *
59 * Before calling this function, the ethernet driver will have
60 * initialized the addr with local-mac-address from the device
61 * tree (if found). Allow command line to override, but not
62 * the fused address.
63 */
64int soc_mac_addr(unsigned int index, u8 *addr)
65{
66 int i, have_dt_mac = 0, have_cmdline_mac = 0, have_fuse_mac = 0;
67
68 for (i = 0; i < 6; i++) {
69 if (cmdline_mac[i])
70 have_cmdline_mac = 1;
71 if (c6x_fuse_mac[i])
72 have_fuse_mac = 1;
73 if (addr[i])
74 have_dt_mac = 1;
75 }
76
77 /* cmdline overrides all */
78 if (have_cmdline_mac)
79 memcpy(addr, cmdline_mac, 6);
80 else if (!have_dt_mac) {
81 if (have_fuse_mac)
82 memcpy(addr, c6x_fuse_mac, 6);
83 else
84 random_ether_addr(addr);
85 }
86
87 /* adjust for specific EMAC device */
88 addr[5] += index * c6x_num_cores;
89 return 1;
90}
91EXPORT_SYMBOL_GPL(soc_mac_addr);