lib/efi_loader/efi_runtime.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  *  EFI application runtime services
   4  *
   5  *  Copyright (c) 2016 Alexander Graf
   6  */
   7
   8 #include <common.h>
   9 #include <command.h>
  10 #include <cpu_func.h>
  11 #include <dm.h>
  12 #include <elf.h>
  13 #include <efi_loader.h>
  14 #include <rtc.h>
  15 #include <u-boot/crc.h>
  16
  17 /* For manual relocation support */
  18 DECLARE_GLOBAL_DATA_PTR;
  19
  20 struct efi_runtime_mmio_list {
  21         struct list_head link;
  22         void **ptr;
  23         u64 paddr;
  24         u64 len;
  25 };
  26
  27 /* This list contains all runtime available mmio regions */
  28 LIST_HEAD(efi_runtime_mmio);
  29
  30 static efi_status_t __efi_runtime EFIAPI efi_unimplemented(void);
  31
  32 /*
  33  * TODO([email protected]): These defines and structures should come from the ELF
  34  * header for each architecture (or a generic header) rather than being repeated
  35  * here.
  36  */
  37 #if defined(__aarch64__)
  38 #define R_RELATIVE      R_AARCH64_RELATIVE
  39 #define R_MASK          0xffffffffULL
  40 #define IS_RELA         1
  41 #elif defined(__arm__)
  42 #define R_RELATIVE      R_ARM_RELATIVE
  43 #define R_MASK          0xffULL
  44 #elif defined(__i386__)
  45 #define R_RELATIVE      R_386_RELATIVE
  46 #define R_MASK          0xffULL
  47 #elif defined(__x86_64__)
  48 #define R_RELATIVE      R_X86_64_RELATIVE
  49 #define R_MASK          0xffffffffULL
  50 #define IS_RELA         1
  51 #elif defined(__riscv)
  52 #define R_RELATIVE      R_RISCV_RELATIVE
  53 #define R_MASK          0xffULL
  54 #define IS_RELA         1
  55
  56 struct dyn_sym {
  57         ulong foo1;
  58         ulong addr;
  59         u32 foo2;
  60         u32 foo3;
  61 };
  62 #if (__riscv_xlen == 32)
  63 #define R_ABSOLUTE      R_RISCV_32
  64 #define SYM_INDEX       8
  65 #elif (__riscv_xlen == 64)
  66 #define R_ABSOLUTE      R_RISCV_64
  67 #define SYM_INDEX       32
  68 #else
  69 #error unknown riscv target
  70 #endif
  71 #else
  72 #error Need to add relocation awareness
  73 #endif
  74
  75 struct elf_rel {
  76         ulong *offset;
  77         ulong info;
  78 };
  79
  80 struct elf_rela {
  81         ulong *offset;
  82         ulong info;
  83         long addend;
  84 };
  85
  86 static __efi_runtime_data struct efi_mem_desc *efi_virtmap;
  87 static __efi_runtime_data efi_uintn_t efi_descriptor_count;
  88 static __efi_runtime_data efi_uintn_t efi_descriptor_size;
  89
  90 /*
  91  * EFI runtime code lives in two stages. In the first stage, U-Boot and an EFI
  92  * payload are running concurrently at the same time. In this mode, we can
  93  * handle a good number of runtime callbacks
  94  */
  95
  96 efi_status_t efi_init_runtime_supported(void)
  97 {
  98         u16 efi_runtime_services_supported =
  99                                 EFI_RT_SUPPORTED_SET_VIRTUAL_ADDRESS_MAP |
 100                                 EFI_RT_SUPPORTED_CONVERT_POINTER;
 101
 102         /*
 103          * This value must be synced with efi_runtime_detach_list
 104          * as well as efi_runtime_services.
 105          */
 106 #ifdef CONFIG_EFI_HAVE_RUNTIME_RESET
 107         efi_runtime_services_supported |= EFI_RT_SUPPORTED_RESET_SYSTEM;
 108 #endif
 109
 110         return EFI_CALL(efi_set_variable(L"RuntimeServicesSupported",
 111                                          &efi_global_variable_guid,
 112                                          EFI_VARIABLE_BOOTSERVICE_ACCESS |
 113                                          EFI_VARIABLE_RUNTIME_ACCESS,
 114                                          sizeof(efi_runtime_services_supported),
 115                                          &efi_runtime_services_supported));
 116 }
 117
 118 /**
 119  * efi_update_table_header_crc32() - Update crc32 in table header
 120  *
 121  * @table:      EFI table
 122  */
 123 void __efi_runtime efi_update_table_header_crc32(struct efi_table_hdr *table)
 124 {
 125         table->crc32 = 0;
 126         table->crc32 = crc32(0, (const unsigned char *)table,
 127                              table->headersize);
 128 }
 129
 130 /**
 131  * efi_reset_system_boottime() - reset system at boot time
 132  *
 133  * This function implements the ResetSystem() runtime service before
 134  * SetVirtualAddressMap() is called.
 135  *
 136  * See the Unified Extensible Firmware Interface (UEFI) specification for
 137  * details.
 138  *
 139  * @reset_type:         type of reset to perform
 140  * @reset_status:       status code for the reset
 141  * @data_size:          size of reset_data
 142  * @reset_data:         information about the reset
 143  */
 144 static void EFIAPI efi_reset_system_boottime(
 145                         enum efi_reset_type reset_type,
 146                         efi_status_t reset_status,
 147                         unsigned long data_size, void *reset_data)
 148 {
 149         struct efi_event *evt;
 150
 151         EFI_ENTRY("%d %lx %lx %p", reset_type, reset_status, data_size,
 152                   reset_data);
 153
 154         /* Notify reset */
 155         list_for_each_entry(evt, &efi_events, link) {
 156                 if (evt->group &&
 157                     !guidcmp(evt->group,
 158                              &efi_guid_event_group_reset_system)) {
 159                         efi_signal_event(evt);
 160                         break;
 161                 }
 162         }
 163         switch (reset_type) {
 164         case EFI_RESET_COLD:
 165         case EFI_RESET_WARM:
 166         case EFI_RESET_PLATFORM_SPECIFIC:
 167                 do_reset(NULL, 0, 0, NULL);
 168                 break;
 169         case EFI_RESET_SHUTDOWN:
 170 #ifdef CONFIG_CMD_POWEROFF
 171                 do_poweroff(NULL, 0, 0, NULL);
 172 #endif
 173                 break;
 174         }
 175
 176         while (1) { }
 177 }
 178
 179 /**
 180  * efi_get_time_boottime() - get current time at boot time
 181  *
 182  * This function implements the GetTime runtime service before
 183  * SetVirtualAddressMap() is called.
 184  *
 185  * See the Unified Extensible Firmware Interface (UEFI) specification
 186  * for details.
 187  *
 188  * @time:               pointer to structure to receive current time
 189  * @capabilities:       pointer to structure to receive RTC properties
 190  * Returns:             status code
 191  */
 192 static efi_status_t EFIAPI efi_get_time_boottime(
 193                         struct efi_time *time,
 194                         struct efi_time_cap *capabilities)
 195 {
 196 #ifdef CONFIG_EFI_GET_TIME
 197         efi_status_t ret = EFI_SUCCESS;
 198         struct rtc_time tm;
 199         struct udevice *dev;
 200
 201         EFI_ENTRY("%p %p", time, capabilities);
 202
 203         if (!time) {
 204                 ret = EFI_INVALID_PARAMETER;
 205                 goto out;
 206         }
 207         if (uclass_get_device(UCLASS_RTC, 0, &dev) ||
 208             dm_rtc_get(dev, &tm)) {
 209                 ret = EFI_UNSUPPORTED;
 210                 goto out;
 211         }
 212         if (dm_rtc_get(dev, &tm)) {
 213                 ret = EFI_DEVICE_ERROR;
 214                 goto out;
 215         }
 216
 217         memset(time, 0, sizeof(*time));
 218         time->year = tm.tm_year;
 219         time->month = tm.tm_mon;
 220         time->day = tm.tm_mday;
 221         time->hour = tm.tm_hour;
 222         time->minute = tm.tm_min;
 223         time->second = tm.tm_sec;
 224         if (tm.tm_isdst)
 225                 time->daylight =
 226                         EFI_TIME_ADJUST_DAYLIGHT | EFI_TIME_IN_DAYLIGHT;
 227         time->timezone = EFI_UNSPECIFIED_TIMEZONE;
 228
 229         if (capabilities) {
 230                 /* Set reasonable dummy values */
 231                 capabilities->resolution = 1;           /* 1 Hz */
 232                 capabilities->accuracy = 100000000;     /* 100 ppm */
 233                 capabilities->sets_to_zero = false;
 234         }
 235 out:
 236         return EFI_EXIT(ret);
 237 #else
 238         EFI_ENTRY("%p %p", time, capabilities);
 239         return EFI_EXIT(EFI_UNSUPPORTED);
 240 #endif
 241 }
 242
 243 #ifdef CONFIG_EFI_SET_TIME
 244
 245 /**
 246  * efi_validate_time() - checks if timestamp is valid
 247  *
 248  * @time:       timestamp to validate
 249  * Returns:     0 if timestamp is valid, 1 otherwise
 250  */
 251 static int efi_validate_time(struct efi_time *time)
 252 {
 253         return (!time ||
 254                 time->year < 1900 || time->year > 9999 ||
 255                 !time->month || time->month > 12 || !time->day ||
 256                 time->day > rtc_month_days(time->month - 1, time->year) ||
 257                 time->hour > 23 || time->minute > 59 || time->second > 59 ||
 258                 time->nanosecond > 999999999 ||
 259                 time->daylight &
 260                 ~(EFI_TIME_IN_DAYLIGHT | EFI_TIME_ADJUST_DAYLIGHT) ||
 261                 ((time->timezone < -1440 || time->timezone > 1440) &&
 262                 time->timezone != EFI_UNSPECIFIED_TIMEZONE));
 263 }
 264
 265 #endif
 266
 267 /**
 268  * efi_set_time_boottime() - set current time
 269  *
 270  * This function implements the SetTime() runtime service before
 271  * SetVirtualAddressMap() is called.
 272  *
 273  * See the Unified Extensible Firmware Interface (UEFI) specification
 274  * for details.
 275  *
 276  * @time:               pointer to structure to with current time
 277  * Returns:             status code
 278  */
 279 static efi_status_t EFIAPI efi_set_time_boottime(struct efi_time *time)
 280 {
 281 #ifdef CONFIG_EFI_SET_TIME
 282         efi_status_t ret = EFI_SUCCESS;
 283         struct rtc_time tm;
 284         struct udevice *dev;
 285
 286         EFI_ENTRY("%p", time);
 287
 288         if (efi_validate_time(time)) {
 289                 ret = EFI_INVALID_PARAMETER;
 290                 goto out;
 291         }
 292
 293         if (uclass_get_device(UCLASS_RTC, 0, &dev)) {
 294                 ret = EFI_UNSUPPORTED;
 295                 goto out;
 296         }
 297
 298         memset(&tm, 0, sizeof(tm));
 299         tm.tm_year = time->year;
 300         tm.tm_mon = time->month;
 301         tm.tm_mday = time->day;
 302         tm.tm_hour = time->hour;
 303         tm.tm_min = time->minute;
 304         tm.tm_sec = time->second;
 305         tm.tm_isdst = time->daylight ==
 306                       (EFI_TIME_ADJUST_DAYLIGHT | EFI_TIME_IN_DAYLIGHT);
 307         /* Calculate day of week */
 308         rtc_calc_weekday(&tm);
 309
 310         if (dm_rtc_set(dev, &tm))
 311                 ret = EFI_DEVICE_ERROR;
 312 out:
 313         return EFI_EXIT(ret);
 314 #else
 315         EFI_ENTRY("%p", time);
 316         return EFI_EXIT(EFI_UNSUPPORTED);
 317 #endif
 318 }
 319 /**
 320  * efi_reset_system() - reset system
 321  *
 322  * This function implements the ResetSystem() runtime service after
 323  * SetVirtualAddressMap() is called. It only executes an endless loop.
 324  * Boards may override the helpers below to implement reset functionality.
 325  *
 326  * See the Unified Extensible Firmware Interface (UEFI) specification for
 327  * details.
 328  *
 329  * @reset_type:         type of reset to perform
 330  * @reset_status:       status code for the reset
 331  * @data_size:          size of reset_data
 332  * @reset_data:         information about the reset
 333  */
 334 void __weak __efi_runtime EFIAPI efi_reset_system(
 335                         enum efi_reset_type reset_type,
 336                         efi_status_t reset_status,
 337                         unsigned long data_size, void *reset_data)
 338 {
 339         /* Nothing we can do */
 340         while (1) { }
 341 }
 342
 343 /**
 344  * efi_reset_system_init() - initialize the reset driver
 345  *
 346  * Boards may override this function to initialize the reset driver.
 347  */
 348 efi_status_t __weak efi_reset_system_init(void)
 349 {
 350         return EFI_SUCCESS;
 351 }
 352
 353 /**
 354  * efi_get_time() - get current time
 355  *
 356  * This function implements the GetTime runtime service after
 357  * SetVirtualAddressMap() is called. As the U-Boot driver are not available
 358  * anymore only an error code is returned.
 359  *
 360  * See the Unified Extensible Firmware Interface (UEFI) specification
 361  * for details.
 362  *
 363  * @time:               pointer to structure to receive current time
 364  * @capabilities:       pointer to structure to receive RTC properties
 365  * Returns:             status code
 366  */
 367 efi_status_t __weak __efi_runtime EFIAPI efi_get_time(
 368                         struct efi_time *time,
 369                         struct efi_time_cap *capabilities)
 370 {
 371         return EFI_UNSUPPORTED;
 372 }
 373
 374 /**
 375  * efi_set_time() - set current time
 376  *
 377  * This function implements the SetTime runtime service after
 378  * SetVirtualAddressMap() is called. As the U-Boot driver are not available
 379  * anymore only an error code is returned.
 380  *
 381  * See the Unified Extensible Firmware Interface (UEFI) specification
 382  * for details.
 383  *
 384  * @time:               pointer to structure to with current time
 385  * Returns:             status code
 386  */
 387 efi_status_t __weak __efi_runtime EFIAPI efi_set_time(struct efi_time *time)
 388 {
 389         return EFI_UNSUPPORTED;
 390 }
 391
 392 /**
 393  * efi_is_runtime_service_pointer() - check if pointer points to runtime table
 394  *
 395  * @p:          pointer to check
 396  * Return:      true if the pointer points to a service function pointer in the
 397  *              runtime table
 398  */
 399 static bool efi_is_runtime_service_pointer(void *p)
 400 {
 401         return (p >= (void *)&efi_runtime_services.get_time &&
 402                 p <= (void *)&efi_runtime_services.query_variable_info) ||
 403                p == (void *)&efi_events.prev ||
 404                p == (void *)&efi_events.next;
 405 }
 406
 407 /**
 408  * efi_runtime_detach() - detach unimplemented runtime functions
 409  */
 410 void efi_runtime_detach(void)
 411 {
 412         efi_runtime_services.reset_system = efi_reset_system;
 413         efi_runtime_services.get_time = efi_get_time;
 414         efi_runtime_services.set_time = efi_set_time;
 415
 416         /* Update CRC32 */
 417         efi_update_table_header_crc32(&efi_runtime_services.hdr);
 418 }
 419
 420 /**
 421  * efi_set_virtual_address_map_runtime() - change from physical to virtual
 422  *                                         mapping
 423  *
 424  * This function implements the SetVirtualAddressMap() runtime service after
 425  * it is first called.
 426  *
 427  * See the Unified Extensible Firmware Interface (UEFI) specification for
 428  * details.
 429  *
 430  * @memory_map_size:    size of the virtual map
 431  * @descriptor_size:    size of an entry in the map
 432  * @descriptor_version: version of the map entries
 433  * @virtmap:            virtual address mapping information
 434  * Return:              status code EFI_UNSUPPORTED
 435  */
 436 static __efi_runtime efi_status_t EFIAPI efi_set_virtual_address_map_runtime(
 437                         efi_uintn_t memory_map_size,
 438                         efi_uintn_t descriptor_size,
 439                         uint32_t descriptor_version,
 440                         struct efi_mem_desc *virtmap)
 441 {
 442         return EFI_UNSUPPORTED;
 443 }
 444
 445 /**
 446  * efi_convert_pointer_runtime() - convert from physical to virtual pointer
 447  *
 448  * This function implements the ConvertPointer() runtime service after
 449  * the first call to SetVirtualAddressMap().
 450  *
 451  * See the Unified Extensible Firmware Interface (UEFI) specification for
 452  * details.
 453  *
 454  * @debug_disposition:  indicates if pointer may be converted to NULL
 455  * @address:            pointer to be converted
 456  * Return:              status code EFI_UNSUPPORTED
 457  */
 458 static __efi_runtime efi_status_t EFIAPI efi_convert_pointer_runtime(
 459                         efi_uintn_t debug_disposition, void **address)
 460 {
 461         return EFI_UNSUPPORTED;
 462 }
 463
 464 /**
 465  * efi_convert_pointer_runtime() - convert from physical to virtual pointer
 466  *
 467  * This function implements the ConvertPointer() runtime service until
 468  * the first call to SetVirtualAddressMap().
 469  *
 470  * See the Unified Extensible Firmware Interface (UEFI) specification for
 471  * details.
 472  *
 473  * @debug_disposition:  indicates if pointer may be converted to NULL
 474  * @address:            pointer to be converted
 475  * Return:              status code EFI_UNSUPPORTED
 476  */
 477 static __efi_runtime efi_status_t EFIAPI efi_convert_pointer(
 478                         efi_uintn_t debug_disposition, void **address)
 479 {
 480         efi_physical_addr_t addr = (uintptr_t)*address;
 481         efi_uintn_t i;
 482         efi_status_t ret = EFI_NOT_FOUND;
 483
 484         EFI_ENTRY("%zu %p", debug_disposition, address);
 485
 486         if (!efi_virtmap) {
 487                 ret = EFI_UNSUPPORTED;
 488                 goto out;
 489         }
 490
 491         if (!address) {
 492                 ret = EFI_INVALID_PARAMETER;
 493                 goto out;
 494         }
 495
 496         for (i = 0; i < efi_descriptor_count; i++) {
 497                 struct efi_mem_desc *map = (void *)efi_virtmap +
 498                                            (efi_descriptor_size * i);
 499
 500                 if (addr >= map->physical_start &&
 501                     (addr < map->physical_start
 502                             + (map->num_pages << EFI_PAGE_SHIFT))) {
 503                         *address = (void *)(uintptr_t)
 504                                    (addr + map->virtual_start -
 505                                     map->physical_start);
 506
 507                         ret = EFI_SUCCESS;
 508                         break;
 509                 }
 510         }
 511
 512 out:
 513         return EFI_EXIT(ret);
 514 }
 515
 516 static __efi_runtime void efi_relocate_runtime_table(ulong offset)
 517 {
 518         ulong patchoff;
 519         void **pos;
 520
 521         /* Relocate the runtime services pointers */
 522         patchoff = offset - gd->relocaddr;
 523         for (pos = (void **)&efi_runtime_services.get_time;
 524              pos <= (void **)&efi_runtime_services.query_variable_info; ++pos) {
 525                 if (*pos)
 526                         *pos += patchoff;
 527         }
 528
 529         /*
 530          * The entry for SetVirtualAddress() must point to a physical address.
 531          * After the first execution the service must return EFI_UNSUPPORTED.
 532          */
 533         efi_runtime_services.set_virtual_address_map =
 534                         &efi_set_virtual_address_map_runtime;
 535
 536         /*
 537          * The entry for ConvertPointer() must point to a physical address.
 538          * The service is not usable after SetVirtualAddress().
 539          */
 540         efi_runtime_services.convert_pointer = &efi_convert_pointer_runtime;
 541
 542         /*
 543          * TODO: Update UEFI variable RuntimeServicesSupported removing flags
 544          * EFI_RT_SUPPORTED_SET_VIRTUAL_ADDRESS_MAP and
 545          * EFI_RT_SUPPORTED_CONVERT_POINTER as required by the UEFI spec 2.8.
 546          */
 547
 548         /* Update CRC32 */
 549         efi_update_table_header_crc32(&efi_runtime_services.hdr);
 550 }
 551
 552 /* Relocate EFI runtime to uboot_reloc_base = offset */
 553 void efi_runtime_relocate(ulong offset, struct efi_mem_desc *map)
 554 {
 555 #ifdef IS_RELA
 556         struct elf_rela *rel = (void*)&__efi_runtime_rel_start;
 557 #else
 558         struct elf_rel *rel = (void*)&__efi_runtime_rel_start;
 559         static ulong lastoff = CONFIG_SYS_TEXT_BASE;
 560 #endif
 561
 562         debug("%s: Relocating to offset=%lx\n", __func__, offset);
 563         for (; (ulong)rel < (ulong)&__efi_runtime_rel_stop; rel++) {
 564                 ulong base = CONFIG_SYS_TEXT_BASE;
 565                 ulong *p;
 566                 ulong newaddr;
 567
 568                 p = (void*)((ulong)rel->offset - base) + gd->relocaddr;
 569
 570                 /*
 571                  * The runtime services table is updated in
 572                  * efi_relocate_runtime_table()
 573                  */
 574                 if (map && efi_is_runtime_service_pointer(p))
 575                         continue;
 576
 577                 debug("%s: rel->info=%#lx *p=%#lx rel->offset=%p\n", __func__,
 578                       rel->info, *p, rel->offset);
 579
 580                 switch (rel->info & R_MASK) {
 581                 case R_RELATIVE:
 582 #ifdef IS_RELA
 583                 newaddr = rel->addend + offset - CONFIG_SYS_TEXT_BASE;
 584 #else
 585                 newaddr = *p - lastoff + offset;
 586 #endif
 587                         break;
 588 #ifdef R_ABSOLUTE
 589                 case R_ABSOLUTE: {
 590                         ulong symidx = rel->info >> SYM_INDEX;
 591                         extern struct dyn_sym __dyn_sym_start[];
 592                         newaddr = __dyn_sym_start[symidx].addr + offset;
 593 #ifdef IS_RELA
 594                         newaddr -= CONFIG_SYS_TEXT_BASE;
 595 #endif
 596                         break;
 597                 }
 598 #endif
 599                 default:
 600                         printf("%s: Unknown relocation type %llx\n",
 601                                __func__, rel->info & R_MASK);
 602                         continue;
 603                 }
 604
 605                 /* Check if the relocation is inside bounds */
 606                 if (map && ((newaddr < map->virtual_start) ||
 607                     newaddr > (map->virtual_start +
 608                               (map->num_pages << EFI_PAGE_SHIFT)))) {
 609                         printf("%s: Relocation at %p is out of range (%lx)\n",
 610                                __func__, p, newaddr);
 611                         continue;
 612                 }
 613
 614                 debug("%s: Setting %p to %lx\n", __func__, p, newaddr);
 615                 *p = newaddr;
 616                 flush_dcache_range((ulong)p & ~(EFI_CACHELINE_SIZE - 1),
 617                         ALIGN((ulong)&p[1], EFI_CACHELINE_SIZE));
 618         }
 619
 620 #ifndef IS_RELA
 621         lastoff = offset;
 622 #endif
 623
 624         invalidate_icache_all();
 625 }
 626
 627 /**
 628  * efi_set_virtual_address_map() - change from physical to virtual mapping
 629  *
 630  * This function implements the SetVirtualAddressMap() runtime service.
 631  *
 632  * See the Unified Extensible Firmware Interface (UEFI) specification for
 633  * details.
 634  *
 635  * @memory_map_size:    size of the virtual map
 636  * @descriptor_size:    size of an entry in the map
 637  * @descriptor_version: version of the map entries
 638  * @virtmap:            virtual address mapping information
 639  * Return:              status code
 640  */
 641 static efi_status_t EFIAPI efi_set_virtual_address_map(
 642                         efi_uintn_t memory_map_size,
 643                         efi_uintn_t descriptor_size,
 644                         uint32_t descriptor_version,
 645                         struct efi_mem_desc *virtmap)
 646 {
 647         efi_uintn_t n = memory_map_size / descriptor_size;
 648         efi_uintn_t i;
 649         efi_status_t ret = EFI_INVALID_PARAMETER;
 650         int rt_code_sections = 0;
 651         struct efi_event *event;
 652
 653         EFI_ENTRY("%zx %zx %x %p", memory_map_size, descriptor_size,
 654                   descriptor_version, virtmap);
 655
 656         if (descriptor_version != EFI_MEMORY_DESCRIPTOR_VERSION ||
 657             descriptor_size < sizeof(struct efi_mem_desc))
 658                 goto out;
 659
 660         efi_virtmap = virtmap;
 661         efi_descriptor_size = descriptor_size;
 662         efi_descriptor_count = n;
 663
 664         /*
 665          * TODO:
 666          * Further down we are cheating. While really we should implement
 667          * SetVirtualAddressMap() events and ConvertPointer() to allow
 668          * dynamically loaded drivers to expose runtime services, we don't
 669          * today.
 670          *
 671          * So let's ensure we see exactly one single runtime section, as
 672          * that is the built-in one. If we see more (or less), someone must
 673          * have tried adding or removing to that which we don't support yet.
 674          * In that case, let's better fail rather than expose broken runtime
 675          * services.
 676          */
 677         for (i = 0; i < n; i++) {
 678                 struct efi_mem_desc *map = (void*)virtmap +
 679                                            (descriptor_size * i);
 680
 681                 if (map->type == EFI_RUNTIME_SERVICES_CODE)
 682                         rt_code_sections++;
 683         }
 684
 685         if (rt_code_sections != 1) {
 686                 /*
 687                  * We expose exactly one single runtime code section, so
 688                  * something is definitely going wrong.
 689                  */
 690                 goto out;
 691         }
 692
 693         /* Notify EVT_SIGNAL_VIRTUAL_ADDRESS_CHANGE */
 694         list_for_each_entry(event, &efi_events, link) {
 695                 if (event->notify_function)
 696                         EFI_CALL_VOID(event->notify_function(
 697                                         event, event->notify_context));
 698         }
 699
 700         /* Rebind mmio pointers */
 701         for (i = 0; i < n; i++) {
 702                 struct efi_mem_desc *map = (void*)virtmap +
 703                                            (descriptor_size * i);
 704                 struct list_head *lhandle;
 705                 efi_physical_addr_t map_start = map->physical_start;
 706                 efi_physical_addr_t map_len = map->num_pages << EFI_PAGE_SHIFT;
 707                 efi_physical_addr_t map_end = map_start + map_len;
 708                 u64 off = map->virtual_start - map_start;
 709
 710                 /* Adjust all mmio pointers in this region */
 711                 list_for_each(lhandle, &efi_runtime_mmio) {
 712                         struct efi_runtime_mmio_list *lmmio;
 713
 714                         lmmio = list_entry(lhandle,
 715                                            struct efi_runtime_mmio_list,
 716                                            link);
 717                         if ((map_start <= lmmio->paddr) &&
 718                             (map_end >= lmmio->paddr)) {
 719                                 uintptr_t new_addr = lmmio->paddr + off;
 720                                 *lmmio->ptr = (void *)new_addr;
 721                         }
 722                 }
 723                 if ((map_start <= (uintptr_t)systab.tables) &&
 724                     (map_end >= (uintptr_t)systab.tables)) {
 725                         char *ptr = (char *)systab.tables;
 726
 727                         ptr += off;
 728                         systab.tables = (struct efi_configuration_table *)ptr;
 729                 }
 730         }
 731
 732         /* Relocate the runtime. See TODO above */
 733         for (i = 0; i < n; i++) {
 734                 struct efi_mem_desc *map;
 735
 736                 map = (void*)virtmap + (descriptor_size * i);
 737                 if (map->type == EFI_RUNTIME_SERVICES_CODE) {
 738                         ulong new_offset = map->virtual_start -
 739                                            map->physical_start + gd->relocaddr;
 740
 741                         efi_relocate_runtime_table(new_offset);
 742                         efi_runtime_relocate(new_offset, map);
 743                         ret = EFI_SUCCESS;
 744                         goto out;
 745                 }
 746         }
 747
 748 out:
 749         return EFI_EXIT(ret);
 750 }
 751
 752 /**
 753  * efi_add_runtime_mmio() - add memory-mapped IO region
 754  *
 755  * This function adds a memory-mapped IO region to the memory map to make it
 756  * available at runtime.
 757  *
 758  * @mmio_ptr:           pointer to a pointer to the start of the memory-mapped
 759  *                      IO region
 760  * @len:                size of the memory-mapped IO region
 761  * Returns:             status code
 762  */
 763 efi_status_t efi_add_runtime_mmio(void *mmio_ptr, u64 len)
 764 {
 765         struct efi_runtime_mmio_list *newmmio;
 766         u64 pages = (len + EFI_PAGE_MASK) >> EFI_PAGE_SHIFT;
 767         uint64_t addr = *(uintptr_t *)mmio_ptr;
 768         efi_status_t ret;
 769
 770         ret = efi_add_memory_map(addr, pages, EFI_MMAP_IO, false);
 771         if (ret != EFI_SUCCESS)
 772                 return EFI_OUT_OF_RESOURCES;
 773
 774         newmmio = calloc(1, sizeof(*newmmio));
 775         if (!newmmio)
 776                 return EFI_OUT_OF_RESOURCES;
 777         newmmio->ptr = mmio_ptr;
 778         newmmio->paddr = *(uintptr_t *)mmio_ptr;
 779         newmmio->len = len;
 780         list_add_tail(&newmmio->link, &efi_runtime_mmio);
 781
 782         return EFI_SUCCESS;
 783 }
 784
 785 /*
 786  * In the second stage, U-Boot has disappeared. To isolate our runtime code
 787  * that at this point still exists from the rest, we put it into a special
 788  * section.
 789  *
 790  *        !!WARNING!!
 791  *
 792  * This means that we can not rely on any code outside of this file in any
 793  * function or variable below this line.
 794  *
 795  * Please keep everything fully self-contained and annotated with
 796  * __efi_runtime and __efi_runtime_data markers.
 797  */
 798
 799 /*
 800  * Relocate the EFI runtime stub to a different place. We need to call this
 801  * the first time we expose the runtime interface to a user and on set virtual
 802  * address map calls.
 803  */
 804
 805 /**
 806  * efi_unimplemented() - replacement function, returns EFI_UNSUPPORTED
 807  *
 808  * This function is used after SetVirtualAddressMap() is called as replacement
 809  * for services that are not available anymore due to constraints of the U-Boot
 810  * implementation.
 811  *
 812  * Return:      EFI_UNSUPPORTED
 813  */
 814 static efi_status_t __efi_runtime EFIAPI efi_unimplemented(void)
 815 {
 816         return EFI_UNSUPPORTED;
 817 }
 818
 819 /**
 820  * efi_update_capsule() - process information from operating system
 821  *
 822  * This function implements the UpdateCapsule() runtime service.
 823  *
 824  * See the Unified Extensible Firmware Interface (UEFI) specification for
 825  * details.
 826  *
 827  * @capsule_header_array:       pointer to array of virtual pointers
 828  * @capsule_count:              number of pointers in capsule_header_array
 829  * @scatter_gather_list:        pointer to arry of physical pointers
 830  * Returns:                     status code
 831  */
 832 efi_status_t __efi_runtime EFIAPI efi_update_capsule(
 833                         struct efi_capsule_header **capsule_header_array,
 834                         efi_uintn_t capsule_count,
 835                         u64 scatter_gather_list)
 836 {
 837         return EFI_UNSUPPORTED;
 838 }
 839
 840 /**
 841  * efi_query_capsule_caps() - check if capsule is supported
 842  *
 843  * This function implements the QueryCapsuleCapabilities() runtime service.
 844  *
 845  * See the Unified Extensible Firmware Interface (UEFI) specification for
 846  * details.
 847  *
 848  * @capsule_header_array:       pointer to array of virtual pointers
 849  * @capsule_count:              number of pointers in capsule_header_array
 850  * @maximum_capsule_size:       maximum capsule size
 851  * @reset_type:                 type of reset needed for capsule update
 852  * Returns:                     status code
 853  */
 854 efi_status_t __efi_runtime EFIAPI efi_query_capsule_caps(
 855                         struct efi_capsule_header **capsule_header_array,
 856                         efi_uintn_t capsule_count,
 857                         u64 *maximum_capsule_size,
 858                         u32 *reset_type)
 859 {
 860         return EFI_UNSUPPORTED;
 861 }
 862
 863 struct efi_runtime_services __efi_runtime_data efi_runtime_services = {
 864         .hdr = {
 865                 .signature = EFI_RUNTIME_SERVICES_SIGNATURE,
 866                 .revision = EFI_SPECIFICATION_VERSION,
 867                 .headersize = sizeof(struct efi_runtime_services),
 868         },
 869         .get_time = &efi_get_time_boottime,
 870         .set_time = &efi_set_time_boottime,
 871         .get_wakeup_time = (void *)&efi_unimplemented,
 872         .set_wakeup_time = (void *)&efi_unimplemented,
 873         .set_virtual_address_map = &efi_set_virtual_address_map,
 874         .convert_pointer = efi_convert_pointer,
 875         .get_variable = efi_get_variable,
 876         .get_next_variable_name = efi_get_next_variable_name,
 877         .set_variable = efi_set_variable,
 878         .get_next_high_mono_count = (void *)&efi_unimplemented,
 879         .reset_system = &efi_reset_system_boottime,
 880         .update_capsule = efi_update_capsule,
 881         .query_capsule_caps = efi_query_capsule_caps,
 882         .query_variable_info = efi_query_variable_info,
 883 };