write in 30M

hc

2024-02-20 ea08eeccae9297f7aabd2ef7f0c2517ac4549acc

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
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
/*
 * MSMC controller utilities
 *
 * (C) Copyright 2012-2014
 *     Texas Instruments Incorporated, <www.ti.com>
 *
 * SPDX-License-Identifier:     GPL-2.0+
 */
 
#include <common.h>
#include <asm/arch/msmc.h>
 
struct mpax {
    u32    mpaxl;
    u32    mpaxh;
};
 
struct msms_regs {
    u32    pid;
    u32    _res_04;
    u32    smcerrar;
    u32    smcerrxr;
    u32    smedcc;
    u32    smcea;
    u32    smsecc;
    u32    smpfar;
    u32    smpfxr;
    u32    smpfr;
    u32    smpfcr;
    u32    _res_2c;
    u32    sbndc[8];
    u32    sbndm;
    u32    sbnde;
    u32    _res_58;
    u32    cfglck;
    u32    cfgulck;
    u32    cfglckstat;
    u32    sms_mpax_lck;
    u32    sms_mpax_ulck;
    u32    sms_mpax_lckstat;
    u32    ses_mpax_lck;
    u32    ses_mpax_ulck;
    u32    ses_mpax_lckstat;
    u32    smestat;
    u32    smirstat;
    u32    smirc;
    u32    smiestat;
    u32    smiec;
    u32    _res_94_c0[12];
    u32    smncerrar;
    u32    smncerrxr;
    u32    smncea;
    u32    _res_d0_1fc[76];
    struct mpax sms[16][8];
    struct mpax ses[16][8];
};
 
 
void msmc_share_all_segments(int priv_id)
{
    struct msms_regs *msmc = (struct msms_regs *)KS2_MSMC_CTRL_BASE;
    int j;
 
    for (j = 0; j < 8; j++) {
        msmc->sms[priv_id][j].mpaxh &= 0xffffff7ful;
        msmc->ses[priv_id][j].mpaxh &= 0xffffff7ful;
    }
}
 
void msmc_map_ses_segment(int priv_id, int ses_pair,
              u32 src_pfn, u32 dst_pfn, enum mpax_seg_size size)
{
    struct msms_regs *msmc = (struct msms_regs *)KS2_MSMC_CTRL_BASE;
 
    msmc->ses[priv_id][ses_pair].mpaxh = src_pfn << 12 |
                         (size & 0x1f) | 0x80;
    msmc->ses[priv_id][ses_pair].mpaxl = dst_pfn << 8 | 0x3f;
}
 
void msmc_get_ses_mpax(int priv_id, int ses_pair, u32 *mpax)
{
    struct msms_regs *msmc = (struct msms_regs *)KS2_MSMC_CTRL_BASE;
 
    *mpax++ = msmc->ses[priv_id][ses_pair].mpaxl;
    *mpax = msmc->ses[priv_id][ses_pair].mpaxh;
}
 
void msmc_set_ses_mpax(int priv_id, int ses_pair, u32 *mpax)
{
    struct msms_regs *msmc = (struct msms_regs *)KS2_MSMC_CTRL_BASE;
 
    msmc->ses[priv_id][ses_pair].mpaxl = *mpax++;
    msmc->ses[priv_id][ses_pair].mpaxh = *mpax;
}