arch/c6x/kernel/soc.c

   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
  18 struct soc_ops soc_ops;
  19
  20 int soc_get_exception(void)
  21 {
  22         if (!soc_ops.get_exception)
  23                 return -1;
  24         return soc_ops.get_exception();
  25 }
  26
  27 void soc_assert_event(unsigned int evt)
  28 {
  29         if (soc_ops.assert_event)
  30                 soc_ops.assert_event(evt);
  31 }
  32
  33 static u8 cmdline_mac[6];
  34
  35 static 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  */
  64 int 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 }
  91 EXPORT_SYMBOL_GPL(soc_mac_addr);