arch/arm/mach-rockchip/misc.c

   1 /* SPDX-License-Identifier: GPL-2.0+ */
   2 /*
   3  * RK3399: Architecture common definitions
   4  *
   5  * Copyright (C) 2019 Collabora Inc - https://www.collabora.com/
   6  *      Rohan Garg <rohan.garg@collabora.com>
   7  *
   8  * Based on puma-rk3399.c:
   9  *      (C) Copyright 2017 Theobroma Systems Design und Consulting GmbH
  10  */
  11
  12 #include <common.h>
  13 #include <env.h>
  14 #include <dm.h>
  15 #include <dm/uclass-internal.h>
  16 #include <misc.h>
  17 #include <u-boot/sha256.h>
  18
  19 #include <asm/arch-rockchip/misc.h>
  20
  21 int rockchip_setup_macaddr(void)
  22 {
  23 #if CONFIG_IS_ENABLED(CMD_NET)
  24         int ret;
  25         const char *cpuid = env_get("cpuid#");
  26         u8 hash[SHA256_SUM_LEN];
  27         int size = sizeof(hash);
  28         u8 mac_addr[6];
  29
  30         /* Only generate a MAC address, if none is set in the environment */
  31         if (env_get("ethaddr"))
  32                 return -1;
  33
  34         if (!cpuid) {
  35                 debug("%s: could not retrieve 'cpuid#'\n", __func__);
  36                 return -1;
  37         }
  38
  39         ret = hash_block("sha256", (void *)cpuid, strlen(cpuid), hash, &size);
  40         if (ret) {
  41                 debug("%s: failed to calculate SHA256\n", __func__);
  42                 return -1;
  43         }
  44
  45         /* Copy 6 bytes of the hash to base the MAC address on */
  46         memcpy(mac_addr, hash, 6);
  47
  48         /* Make this a valid MAC address and set it */
  49         mac_addr[0] &= 0xfe;  /* clear multicast bit */
  50         mac_addr[0] |= 0x02;  /* set local assignment bit (IEEE802) */
  51         eth_env_set_enetaddr("ethaddr", mac_addr);
  52 #endif
  53         return 0;
  54 }
  55
  56 int rockchip_cpuid_from_efuse(const u32 cpuid_offset,
  57                               const u32 cpuid_length,
  58                               u8 *cpuid)
  59 {
  60 #if CONFIG_IS_ENABLED(ROCKCHIP_EFUSE)
  61         struct udevice *dev;
  62         int ret;
  63
  64         /* retrieve the device */
  65         ret = uclass_get_device_by_driver(UCLASS_MISC,
  66                                           DM_GET_DRIVER(rockchip_efuse), &dev);
  67         if (ret) {
  68                 debug("%s: could not find efuse device\n", __func__);
  69                 return -1;
  70         }
  71
  72         /* read the cpu_id range from the efuses */
  73         ret = misc_read(dev, cpuid_offset, cpuid, cpuid_length);
  74         if (ret) {
  75                 debug("%s: reading cpuid from the efuses failed\n",
  76                       __func__);
  77                 return -1;
  78         }
  79 #endif
  80         return 0;
  81 }
  82
  83 int rockchip_cpuid_set(const u8 *cpuid, const u32 cpuid_length)
  84 {
  85         u8 low[cpuid_length / 2], high[cpuid_length / 2];
  86         char cpuid_str[cpuid_length * 2 + 1];
  87         u64 serialno;
  88         char serialno_str[17];
  89         int i;
  90
  91         memset(cpuid_str, 0, sizeof(cpuid_str));
  92         for (i = 0; i < 16; i++)
  93                 sprintf(&cpuid_str[i * 2], "%02x", cpuid[i]);
  94
  95         debug("cpuid: %s\n", cpuid_str);
  96
  97         /*
  98          * Mix the cpuid bytes using the same rules as in
  99          *   ${linux}/drivers/soc/rockchip/rockchip-cpuinfo.c
 100          */
 101         for (i = 0; i < 8; i++) {
 102                 low[i] = cpuid[1 + (i << 1)];
 103                 high[i] = cpuid[i << 1];
 104         }
 105
 106         serialno = crc32_no_comp(0, low, 8);
 107         serialno |= (u64)crc32_no_comp(serialno, high, 8) << 32;
 108         snprintf(serialno_str, sizeof(serialno_str), "%016llx", serialno);
 109
 110         env_set("cpuid#", cpuid_str);
 111         env_set("serial#", serialno_str);
 112
 113         return 0;
 114 }