of.c 1.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384
  1. /*
  2. * Copyright (C) Paul Mackerras 1997.
  3. *
  4. * This program is free software; you can redistribute it and/or
  5. * modify it under the terms of the GNU General Public License
  6. * as published by the Free Software Foundation; either version
  7. * 2 of the License, or (at your option) any later version.
  8. */
  9. #include <stdarg.h>
  10. #include <stddef.h>
  11. #include "types.h"
  12. #include "elf.h"
  13. #include "string.h"
  14. #include "stdio.h"
  15. #include "page.h"
  16. #include "ops.h"
  17. #include "of.h"
  18. /* Value picked to match that used by yaboot */
  19. #define PROG_START 0x01400000 /* only used on 64-bit systems */
  20. #define RAM_END (512<<20) /* Fixme: use OF */
  21. #define ONE_MB 0x100000
  22. static unsigned long claim_base;
  23. static void *of_try_claim(unsigned long size)
  24. {
  25. unsigned long addr = 0;
  26. if (claim_base == 0)
  27. claim_base = _ALIGN_UP((unsigned long)_end, ONE_MB);
  28. for(; claim_base < RAM_END; claim_base += ONE_MB) {
  29. #ifdef DEBUG
  30. printf(" trying: 0x%08lx\n\r", claim_base);
  31. #endif
  32. addr = (unsigned long)of_claim(claim_base, size, 0);
  33. if ((void *)addr != (void *)-1)
  34. break;
  35. }
  36. if (addr == 0)
  37. return NULL;
  38. claim_base = PAGE_ALIGN(claim_base + size);
  39. return (void *)addr;
  40. }
  41. static void of_image_hdr(const void *hdr)
  42. {
  43. const Elf64_Ehdr *elf64 = hdr;
  44. if (elf64->e_ident[EI_CLASS] == ELFCLASS64) {
  45. /*
  46. * Maintain a "magic" minimum address. This keeps some older
  47. * firmware platforms running.
  48. */
  49. if (claim_base < PROG_START)
  50. claim_base = PROG_START;
  51. }
  52. }
  53. void platform_init(unsigned long a1, unsigned long a2, void *promptr)
  54. {
  55. platform_ops.image_hdr = of_image_hdr;
  56. platform_ops.malloc = of_try_claim;
  57. platform_ops.exit = of_exit;
  58. platform_ops.vmlinux_alloc = of_vmlinux_alloc;
  59. dt_ops.finddevice = of_finddevice;
  60. dt_ops.getprop = of_getprop;
  61. dt_ops.setprop = of_setprop;
  62. of_console_init();
  63. of_init(promptr);
  64. loader_info.promptr = promptr;
  65. if (a1 && a2 && a2 != 0xdeadbeef) {
  66. loader_info.initrd_addr = a1;
  67. loader_info.initrd_size = a2;
  68. }
  69. }