|
31 | 31 | #include <stdlib.h>
|
32 | 32 |
|
33 | 33 | #include "addrxlat-priv.h"
|
| 34 | +#include <linux/version.h> |
34 | 35 |
|
35 | 36 | /* Maximum physical address bits (architectural limit) */
|
36 | 37 | #define PA_MAX_BITS 48
|
@@ -140,3 +141,201 @@ pgt_aarch64(addrxlat_step_t *step)
|
140 | 141 |
|
141 | 142 | return ADDRXLAT_OK;
|
142 | 143 | }
|
| 144 | + |
| 145 | +#define is_linear_addr(addr, kernel_ver, va_bits) \ |
| 146 | + (((kernel_ver) < KERNEL_VERSION(5, 4, 0)) ? \ |
| 147 | + (!!((unsigned long)(addr) & (1UL << ((va_bits) - 1)))) : \ |
| 148 | + (!((unsigned long)(addr) & (1UL << ((va_bits) - 1))))) |
| 149 | + |
| 150 | +static unsigned long |
| 151 | +get_page_offset(unsigned long kernel_ver, addrxlat_addr_t va_bits) { |
| 152 | + unsigned long page_offset; |
| 153 | + |
| 154 | + if (kernel_ver < KERNEL_VERSION(5, 4, 0)) |
| 155 | + page_offset = ((0xffffffffffffffffUL) - |
| 156 | + ((1UL) << (va_bits - 1)) + 1); |
| 157 | + else |
| 158 | + page_offset = (-(1UL << va_bits)); |
| 159 | + return page_offset; |
| 160 | +} |
| 161 | + |
| 162 | +/** Determine Linux page table root. |
| 163 | + * @param ctl Initialization data. |
| 164 | + * @param[out] root Page table root address (set on successful return). |
| 165 | + * @returns Error status. |
| 166 | + */ |
| 167 | +static addrxlat_status |
| 168 | +get_linux_pgtroot(struct os_init_data *ctl, addrxlat_fulladdr_t *root) |
| 169 | +{ |
| 170 | + addrxlat_status status; |
| 171 | + addrxlat_addr_t root_va; |
| 172 | + |
| 173 | + addrxlat_addr_t va_bits; |
| 174 | + addrxlat_addr_t phys_base; |
| 175 | + addrxlat_addr_t kimage_voffset; |
| 176 | + int no_kimage_voffset = 0; |
| 177 | + |
| 178 | + unsigned long page_offset; |
| 179 | + unsigned long kernel_ver; |
| 180 | + |
| 181 | + |
| 182 | + status = get_symval(ctl->ctx, "swapper_pg_dir", |
| 183 | + &root_va); |
| 184 | + if (status != ADDRXLAT_OK) |
| 185 | + return set_error(ctl->ctx, status, |
| 186 | + "Cannot determine page table virtual address"); |
| 187 | + |
| 188 | + /* |
| 189 | + * This code will only work with vmcores produced by |
| 190 | + * Linux Kernel versions 4.12 and above. Makedumpfile |
| 191 | + * for kernels before 4.12 uses a heuristic based on |
| 192 | + * reading vmcore load segment addressess and finds |
| 193 | + * va_bits and phys_offset. This code does not support |
| 194 | + * such logic. |
| 195 | + */ |
| 196 | + status = get_number(ctl->ctx, "VA_BITS", |
| 197 | + &va_bits); |
| 198 | + if (status != ADDRXLAT_OK) |
| 199 | + return set_error(ctl->ctx, status, |
| 200 | + "Cannot determine VA_BITS"); |
| 201 | + |
| 202 | + status = get_number(ctl->ctx, "kimage_voffset" , |
| 203 | + &kimage_voffset); |
| 204 | + if (status != ADDRXLAT_OK) |
| 205 | + no_kimage_voffset = 1; |
| 206 | + |
| 207 | + kernel_ver = ctl->osdesc->ver; |
| 208 | + |
| 209 | + |
| 210 | + if (no_kimage_voffset || is_linear_addr(root_va, kernel_ver, va_bits)) { |
| 211 | + status = get_number(ctl->ctx, "PHYS_OFFSET" , |
| 212 | + &phys_base); |
| 213 | + if (status != ADDRXLAT_OK) |
| 214 | + return set_error(ctl->ctx, status, |
| 215 | + "Cannot determine PHYS_OFFSET"); |
| 216 | + |
| 217 | + page_offset = get_page_offset(kernel_ver, va_bits); |
| 218 | + |
| 219 | + if (kernel_ver < KERNEL_VERSION(5, 4, 0)) { |
| 220 | + root->addr = ((root_va & ~page_offset) + phys_base); |
| 221 | + } else { |
| 222 | + root->addr = (root_va + phys_base - page_offset); |
| 223 | + } |
| 224 | + } else { |
| 225 | + root->addr = root_va - kimage_voffset; |
| 226 | + } |
| 227 | + |
| 228 | + root->as = ADDRXLAT_KPHYSADDR; |
| 229 | + |
| 230 | + return ADDRXLAT_OK; |
| 231 | +} |
| 232 | + |
| 233 | +/* Maximum physical address bits (architectural limit) */ |
| 234 | +#define PHYSADDR_BITS_MAX 52 |
| 235 | +#define PHYSADDR_MASK ADDR_MASK(PHYSADDR_BITS_MAX) |
| 236 | +#define VIRTADDR_MAX UINT64_MAX |
| 237 | + |
| 238 | + |
| 239 | +/** Initialize a translation map for Linux/aarch64. |
| 240 | + * @param ctl Initialization data. |
| 241 | + * @returns Error status. |
| 242 | + */ |
| 243 | +static addrxlat_status |
| 244 | +map_linux_aarch64(struct os_init_data *ctl) |
| 245 | +{ |
| 246 | + static const addrxlat_paging_form_t aarch64_pf = { |
| 247 | + .pte_format = ADDRXLAT_PTE_AARCH64, |
| 248 | + .nfields = 5, |
| 249 | + .fieldsz = { 12, 9, 9, 9, 9, 9 } |
| 250 | + }; |
| 251 | + |
| 252 | + /* |
| 253 | + * Generic aarch64 layout, depends on current va_bits |
| 254 | + * |
| 255 | + * Aarch64 kernel does have a linear mapping region, the location |
| 256 | + * of which changed in the 5.4 kernel. But since it is covered |
| 257 | + * by swapper pgt anyway we don't bother to reflect it here. |
| 258 | + */ |
| 259 | + struct sys_region aarch64_layout_generic[] = { |
| 260 | + { 0, 0, /* lower half */ |
| 261 | + ADDRXLAT_SYS_METH_PGT }, |
| 262 | + |
| 263 | + { 0, VIRTADDR_MAX, /* higher half */ |
| 264 | + ADDRXLAT_SYS_METH_PGT }, |
| 265 | + SYS_REGION_END |
| 266 | + }; |
| 267 | + |
| 268 | + addrxlat_map_t *map; |
| 269 | + addrxlat_meth_t *meth; |
| 270 | + addrxlat_status status; |
| 271 | + addrxlat_addr_t va_bits; |
| 272 | + |
| 273 | + meth = &ctl->sys->meth[ADDRXLAT_SYS_METH_PGT]; |
| 274 | + meth->kind = ADDRXLAT_PGT; |
| 275 | + meth->target_as = ADDRXLAT_MACHPHYSADDR; |
| 276 | + |
| 277 | + if (ctl->popt.val[OPT_rootpgt].set) |
| 278 | + meth->param.pgt.root = ctl->popt.val[OPT_rootpgt].fulladdr; |
| 279 | + else { |
| 280 | + status = get_linux_pgtroot(ctl, &meth->param.pgt.root); |
| 281 | + if (status != ADDRXLAT_OK) |
| 282 | + return status; |
| 283 | + } |
| 284 | + |
| 285 | + meth->param.pgt.pte_mask = |
| 286 | + opt_num_default(&ctl->popt, OPT_pte_mask, 0); |
| 287 | + meth->param.pgt.pf = aarch64_pf; |
| 288 | + |
| 289 | + status = get_number(ctl->ctx, "VA_BITS", |
| 290 | + &va_bits); |
| 291 | + if (status != ADDRXLAT_OK) |
| 292 | + return set_error(ctl->ctx, status, |
| 293 | + "Cannot determine VA_BITS"); |
| 294 | + |
| 295 | + if (ctl->popt.val[OPT_levels].set) { |
| 296 | + long levels = ctl->popt.val[OPT_levels].num; |
| 297 | + if (levels < 3 || levels > 5) |
| 298 | + return bad_paging_levels(ctl->ctx, levels); |
| 299 | + meth->param.pgt.pf.nfields = levels + 1; |
| 300 | + } else |
| 301 | + meth->param.pgt.pf.nfields = ((va_bits - 12) / 9) + 1; |
| 302 | + |
| 303 | + /* layout depends on current value of va_bits */ |
| 304 | + aarch64_layout_generic[0].last = ~(-(1ull) << (va_bits)); |
| 305 | + aarch64_layout_generic[1].first = (-(1ull) << (va_bits)); |
| 306 | + |
| 307 | + status = sys_set_layout(ctl, ADDRXLAT_SYS_MAP_HW, |
| 308 | + aarch64_layout_generic); |
| 309 | + if (status != ADDRXLAT_OK) |
| 310 | + return status; |
| 311 | + |
| 312 | + map = internal_map_copy(ctl->sys->map[ADDRXLAT_SYS_MAP_HW]); |
| 313 | + if (!map) |
| 314 | + return set_error(ctl->ctx, ADDRXLAT_ERR_NOMEM, |
| 315 | + "Cannot duplicate hardware mapping"); |
| 316 | + ctl->sys->map[ADDRXLAT_SYS_MAP_KV_PHYS] = map; |
| 317 | + |
| 318 | + status = sys_set_physmaps(ctl, PHYSADDR_MASK); |
| 319 | + if (status != ADDRXLAT_OK) |
| 320 | + return status; |
| 321 | + |
| 322 | + return ADDRXLAT_OK; |
| 323 | +} |
| 324 | + |
| 325 | + |
| 326 | +/** Initialize a translation map for an aarch64 OS. |
| 327 | + * @param ctl Initialization data. |
| 328 | + * @returns Error status. |
| 329 | + */ |
| 330 | +addrxlat_status |
| 331 | +sys_aarch64(struct os_init_data *ctl) |
| 332 | +{ |
| 333 | + switch (ctl->osdesc->type) { |
| 334 | + case ADDRXLAT_OS_LINUX: |
| 335 | + return map_linux_aarch64(ctl); |
| 336 | + |
| 337 | + default: |
| 338 | + return set_error(ctl->ctx, ADDRXLAT_ERR_NOTIMPL, |
| 339 | + "OS type not implemented"); |
| 340 | + } |
| 341 | +} |
0 commit comments