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
|
/* Copyright (c) 2017-2019, The Linux Foundation. All rights reserved.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2 and
* only version 2 as published by the Free Software Foundation.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
*/
#include "hab.h"
#include <linux/of.h>
/*
* set valid mmid value in tbl to show this is valid entry. All inputs here are
* normalized to 1 based integer
*/
static int fill_vmid_mmid_tbl(struct vmid_mmid_desc *tbl, int32_t vm_start,
int32_t vm_range, int32_t mmid_start,
int32_t mmid_range, int32_t be)
{
int ret = 0;
int i = 0, j = 0;
for (i = vm_start; i < vm_start+vm_range; i++) {
tbl[i].vmid = i; /* set valid vmid value to make it usable */
for (j = mmid_start; j < mmid_start + mmid_range; j++) {
/* sanity check */
if (tbl[i].mmid[j] != HABCFG_VMID_INVALID) {
pr_err("overwrite previous setting vmid %d, mmid %d, be %d\n",
i, j, tbl[i].is_listener[j]);
}
tbl[i].mmid[j] = j;
tbl[i].is_listener[j] = be; /* BE IS listen */
}
}
return ret;
}
void dump_settings(struct local_vmid *settings)
{
(void)settings;
pr_debug("self vmid is %d\n", settings->self);
}
int fill_default_gvm_settings(struct local_vmid *settings, int vmid_local,
int mmid_start, int mmid_end)
{
int32_t be = HABCFG_BE_FALSE;
int32_t range = 1;
int32_t vmremote = 0; /* default to host[0] as local is guest[2] */
settings->self = vmid_local;
/* default gvm always talks to host as vm0 */
return fill_vmid_mmid_tbl(settings->vmid_mmid_list, vmremote, range,
mmid_start/100, (mmid_end-mmid_start)/100+1, be);
}
/* device tree based parser */
static int hab_parse_dt(struct local_vmid *settings)
{
int result, i;
struct device_node *hab_node = NULL;
struct device_node *mmid_grp_node = NULL;
const char *role = NULL;
int tmp = -1, vmids_num;
u32 vmids[16];
int32_t grp_start_id, be;
/* parse device tree*/
pr_debug("parsing hab node in device tree...\n");
hab_node = of_find_compatible_node(NULL, NULL, "qcom,hab");
if (!hab_node) {
pr_err("no hab device tree node\n");
return -ENODEV;
}
/* read the local vmid of this VM, like 0 for host, 1 for AGL GVM */
result = of_property_read_u32(hab_node, "vmid", &tmp);
if (result) {
pr_err("failed to read local vmid, result = %d\n", result);
return result;
}
pr_debug("local vmid = %d\n", tmp);
settings->self = tmp;
for_each_child_of_node(hab_node, mmid_grp_node) {
/* read the group starting id */
result = of_property_read_u32(mmid_grp_node,
"grp-start-id", &tmp);
if (result) {
pr_err("failed to read grp-start-id, result = %d\n",
result);
return result;
}
pr_debug("grp-start-id = %d\n", tmp);
grp_start_id = tmp;
/* read the role(fe/be) of these pchans in this mmid group */
result = of_property_read_string(mmid_grp_node, "role", &role);
if (result) {
pr_err("failed to get role, result = %d\n", result);
return result;
}
pr_debug("local role of this mmid group is %s\n", role);
if (!strcmp(role, "be"))
be = 1;
else
be = 0;
/* read the remote vmids for these pchans in this mmid group */
vmids_num = of_property_count_elems_of_size(mmid_grp_node,
"remote-vmids", sizeof(u32));
result = of_property_read_u32_array(mmid_grp_node,
"remote-vmids", vmids, vmids_num);
if (result) {
pr_err("failed to read remote-vmids, result = %d\n",
result);
return result;
}
for (i = 0; i < vmids_num; i++) {
pr_debug("vmids_num = %d, vmids[%d] = %d\n",
vmids_num, i, vmids[i]);
result = fill_vmid_mmid_tbl(
settings->vmid_mmid_list,
vmids[i], 1,
grp_start_id/100, 1, be);
if (result) {
pr_err("fill_vmid_mmid_tbl failed\n");
return result;
}
}
}
dump_settings(settings);
return 0;
}
/*
* 0: successful
* negative: various failure core
*/
int hab_parse(struct local_vmid *settings)
{
int ret = 0;
ret = hab_parse_dt(settings);
return ret;
}
|
