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
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
|
/*
* Copyright (c) 2006-2022, RT-Thread Development Team
*
* SPDX-License-Identifier: Apache-2.0
*
* Change Logs:
* Date Author Notes
* 2022-11-26 GuEe-GUI first version
*/
#include <rthw.h>
#include <mmu.h>
#include <smccc.h>
#include <cpuport.h>
#include <dt-bindings/size.h>
#define DBG_TAG "scmi.agent.smc"
#define DBG_LVL DBG_INFO
#include <rtdbg.h>
#include "agent.h"
struct scmi_agent_smc
{
int irq;
rt_uint32_t func_id;
#define SHMEM_SIZE (4 * SIZE_KB)
#define SHMEM_SHIFT 12
#define SHMEM_PAGE(x) (((rt_ubase_t)(x) >> SHMEM_SHIFT))
#define SHMEM_OFFSET(x) ((x) & (SHMEM_SIZE - 1))
rt_uint32_t param_page;
rt_uint32_t param_offset;
rt_ubase_t cap_id;
rt_bool_t done;
struct rt_spinlock lock;
struct scmi_shared_mem *shmem;
};
static void scmi_agent_smc_isr(int irqno, void *param)
{
struct scmi_agent_smc *asmc = param;
HWREG32(&asmc->done) = RT_TRUE;
rt_hw_dmb();
}
static rt_err_t scmi_agent_smc_setup(struct scmi_agent *agent,
struct rt_device *dev)
{
rt_err_t err;
rt_uint64_t shm_addr, shm_size;
struct rt_ofw_node *np = dev->ofw_node, *shmem_np;
struct scmi_agent_smc *asmc = rt_calloc(1, sizeof(*asmc));
if (!asmc)
{
return -RT_ENOMEM;
}
if ((err = rt_ofw_prop_read_u32(np, "arm,smc-id", &asmc->func_id)))
{
goto _fail;
}
shmem_np = rt_ofw_parse_phandle(np, "shmem", 0);
if (!rt_ofw_node_is_compatible(shmem_np, "arm,scmi-shmem"))
{
err = -RT_EINVAL;
rt_ofw_node_put(shmem_np);
goto _fail;
}
if ((err = rt_ofw_get_address(shmem_np, 0, &shm_addr, &shm_size)))
{
rt_ofw_node_put(shmem_np);
goto _fail;
}
rt_ofw_node_put(shmem_np);
asmc->shmem = rt_ioremap((void *)shm_addr, shm_size);
if (!asmc->shmem)
{
err = -RT_EIO;
goto _fail;
}
if (rt_ofw_node_is_compatible(np, "qcom,scmi-smc"))
{
void *cap_id_map = (void *)asmc->shmem + (shm_size - 8);
rt_memcpy(&asmc->cap_id, cap_id_map, sizeof(asmc->cap_id));
}
else
{
asmc->cap_id = ~0UL;
}
if (rt_ofw_node_is_compatible(np, "arm,scmi-smc-param"))
{
rt_ubase_t base = (rt_ubase_t)rt_kmem_v2p(asmc->shmem);
asmc->param_page = SHMEM_PAGE(base);
asmc->param_offset = SHMEM_OFFSET(base);
}
asmc->irq = rt_ofw_get_irq_by_name(np, "a2p");
if (asmc->irq >= 0)
{
rt_hw_interrupt_install(asmc->irq, scmi_agent_smc_isr, asmc, "scmi");
rt_hw_interrupt_umask(asmc->irq);
}
rt_spin_lock_init(&asmc->lock);
agent->priv = asmc;
return RT_EOK;
_fail:
if (asmc->shmem)
{
rt_iounmap(asmc->shmem);
}
rt_free(asmc);
return err;
}
static rt_err_t scmi_agent_smc_process_msg(struct scmi_agent *agent,
struct rt_scmi_msg *msg)
{
rt_err_t err;
struct arm_smccc_res_t res;
struct scmi_shared_mem *shmem;
struct scmi_agent_smc *asmc = agent->priv;
rt_spin_lock(&asmc->lock);
if (asmc->irq >= 0)
{
while (HWREG32(&asmc->done))
{
rt_hw_cpu_relax();
}
}
shmem = asmc->shmem;
if ((err = scmi_shmem_msg_write(shmem, msg)))
{
goto _out_lock;
}
if (asmc->irq >= 0)
{
HWREG32(&asmc->done) = RT_FALSE;
}
if (asmc->cap_id == ~0UL)
{
arm_smccc_smc(asmc->func_id, asmc->param_page, asmc->param_offset,
0, 0, 0, 0, 0, &res, RT_NULL);
}
else
{
arm_smccc_smc(asmc->func_id, asmc->cap_id,
0, 0, 0, 0, 0, 0, &res, RT_NULL);
}
if (res.a0)
{
err = -RT_EIO;
}
else
{
err = scmi_shmem_msg_read(shmem, msg);
}
scmi_shmem_clear_channel(shmem);
_out_lock:
rt_spin_unlock(&asmc->lock);
return err;
}
struct scmi_agent_ops scmi_agent_smc_ops =
{
.name = "smc",
.setup = scmi_agent_smc_setup,
.process_msg = scmi_agent_smc_process_msg,
};
|
