54 lines
1.1 KiB
C
54 lines
1.1 KiB
C
|
// SPDX-License-Identifier: GPL-2.0+
|
||
|
|
/*
|
||
|
|
* Miscellaneous Snapdragon functionality
|
||
|
|
*
|
||
|
|
* (C) Copyright 2018 Ramon Fried <ramon.fried@gmail.com>
|
||
|
|
*
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <common.h>
|
||
|
|
#include <mmc.h>
|
||
|
|
#include <asm/arch/misc.h>
|
||
|
|
|
||
|
|
/* UNSTUFF_BITS macro taken from Linux Kernel: drivers/mmc/core/sd.c */
|
||
|
|
#define UNSTUFF_BITS(resp, start, size) \
|
||
|
|
({ \
|
||
|
|
const int __size = size; \
|
||
|
|
const u32 __mask = (__size < 32 ? 1 << __size : 0) - 1; \
|
||
|
|
const int __off = 3 - ((start) / 32); \
|
||
|
|
const int __shft = (start) & 31; \
|
||
|
|
u32 __res; \
|
||
|
|
\
|
||
|
|
__res = resp[__off] >> __shft; \
|
||
|
|
if (__size + __shft > 32) \
|
||
|
|
__res |= resp[__off - 1] << ((32 - __shft) % 32); \
|
||
|
|
__res & __mask; \
|
||
|
|
})
|
||
|
|
|
||
|
|
u32 msm_board_serial(void)
|
||
|
|
{
|
||
|
|
struct mmc *mmc_dev;
|
||
|
|
|
||
|
|
mmc_dev = find_mmc_device(0);
|
||
|
|
if (!mmc_dev)
|
||
|
|
return 0;
|
||
|
|
|
||
|
|
return UNSTUFF_BITS(mmc_dev->cid, 16, 32);
|
||
|
|
}
|
||
|
|
|
||
|
|
void msm_generate_mac_addr(u8 *mac)
|
||
|
|
{
|
||
|
|
int i;
|
||
|
|
char sn[9];
|
||
|
|
|
||
|
|
snprintf(sn, 8, "%08x", msm_board_serial());
|
||
|
|
|
||
|
|
/* fill in the mac with serialno, use locally adminstrated pool */
|
||
|
|
mac[0] = 0x02;
|
||
|
|
mac[1] = 00;
|
||
|
|
for (i = 3; i >= 0; i--) {
|
||
|
|
mac[i + 2] = simple_strtoul(&sn[2 * i], NULL, 16);
|
||
|
|
sn[2 * i] = 0;
|
||
|
|
}
|
||
|
|
}
|