add stmac read mac form eeprom

hc

2023-12-09 b22da3d8526a935aa31e086e63f60ff3246cb61c

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
/*
 * (C) Copyright 2016 Beniamino Galvani <b.galvani@gmail.com>
 *
 * SPDX-License-Identifier:    GPL-2.0+
 *
 * Secure monitor calls.
 */
 
#include <common.h>
#include <asm/arch/gxbb.h>
#include <linux/kernel.h>
 
#define FN_GET_SHARE_MEM_INPUT_BASE    0x82000020
#define FN_GET_SHARE_MEM_OUTPUT_BASE    0x82000021
#define FN_EFUSE_READ            0x82000030
#define FN_EFUSE_WRITE            0x82000031
 
static void *shmem_input;
static void *shmem_output;
 
static void meson_init_shmem(void)
{
    struct pt_regs regs;
 
    if (shmem_input && shmem_output)
        return;
 
    regs.regs[0] = FN_GET_SHARE_MEM_INPUT_BASE;
    smc_call(&regs);
    shmem_input = (void *)regs.regs[0];
 
    regs.regs[0] = FN_GET_SHARE_MEM_OUTPUT_BASE;
    smc_call(&regs);
    shmem_output = (void *)regs.regs[0];
 
    debug("Secure Monitor shmem: 0x%p 0x%p\n", shmem_input, shmem_output);
}
 
ssize_t meson_sm_read_efuse(uintptr_t offset, void *buffer, size_t size)
{
    struct pt_regs regs;
 
    meson_init_shmem();
 
    regs.regs[0] = FN_EFUSE_READ;
    regs.regs[1] = offset;
    regs.regs[2] = size;
 
    smc_call(&regs);
 
    if (regs.regs[0] == 0)
        return -1;
 
    memcpy(buffer, shmem_output, min(size, regs.regs[0]));
 
    return regs.regs[0];
}