[mirror_edk2.git] / Tools / Source / TianoTools / Common / PeiLib / Ipf / PeCoffLoaderEx.c

/*++\r
\r
Copyright (c) 2004, Intel Corporation                                                         \r
All rights reserved. This program and the accompanying materials                          \r
are licensed and made available under the terms and conditions of the BSD License         \r
which accompanies this distribution.  The full text of the license may be found at        \r
http://opensource.org/licenses/bsd-license.php                                            \r
                                                                                          \r
THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,                     \r
WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.             \r
\r
Module Name:\r
\r
    PeCoffLoaderEx.c\r
\r
Abstract:\r
\r
    Fixes Intel Itanium(TM) specific relocation types\r
\r
\r
Revision History\r
\r
--*/\r
\r
#include "TianoCommon.h"\r
#include "EfiImage.h"\r
\r
#define EXT_IMM64(Value, Address, Size, InstPos, ValPos)  \\r
    Value |= (((UINT64)((*(Address) >> InstPos) & (((UINT64)1 << Size) - 1))) << ValPos)\r
\r
#define INS_IMM64(Value, Address, Size, InstPos, ValPos)  \\r
    *(UINT32*)Address = (*(UINT32*)Address & ~(((1 << Size) - 1) << InstPos)) | \\r
          ((UINT32)((((UINT64)Value >> ValPos) & (((UINT64)1 << Size) - 1))) << InstPos)\r
\r
#define IMM64_IMM7B_INST_WORD_X         3  \r
#define IMM64_IMM7B_SIZE_X              7  \r
#define IMM64_IMM7B_INST_WORD_POS_X     4  \r
#define IMM64_IMM7B_VAL_POS_X           0  \r
\r
#define IMM64_IMM9D_INST_WORD_X         3  \r
#define IMM64_IMM9D_SIZE_X              9  \r
#define IMM64_IMM9D_INST_WORD_POS_X     18  \r
#define IMM64_IMM9D_VAL_POS_X           7  \r
\r
#define IMM64_IMM5C_INST_WORD_X         3  \r
#define IMM64_IMM5C_SIZE_X              5  \r
#define IMM64_IMM5C_INST_WORD_POS_X     13  \r
#define IMM64_IMM5C_VAL_POS_X           16  \r
\r
#define IMM64_IC_INST_WORD_X            3  \r
#define IMM64_IC_SIZE_X                 1  \r
#define IMM64_IC_INST_WORD_POS_X        12  \r
#define IMM64_IC_VAL_POS_X              21  \r
\r
#define IMM64_IMM41a_INST_WORD_X        1  \r
#define IMM64_IMM41a_SIZE_X             10  \r
#define IMM64_IMM41a_INST_WORD_POS_X    14  \r
#define IMM64_IMM41a_VAL_POS_X          22  \r
\r
#define IMM64_IMM41b_INST_WORD_X        1  \r
#define IMM64_IMM41b_SIZE_X             8  \r
#define IMM64_IMM41b_INST_WORD_POS_X    24  \r
#define IMM64_IMM41b_VAL_POS_X          32  \r
\r
#define IMM64_IMM41c_INST_WORD_X        2  \r
#define IMM64_IMM41c_SIZE_X             23  \r
#define IMM64_IMM41c_INST_WORD_POS_X    0  \r
#define IMM64_IMM41c_VAL_POS_X          40  \r
\r
#define IMM64_SIGN_INST_WORD_X          3  \r
#define IMM64_SIGN_SIZE_X               1  \r
#define IMM64_SIGN_INST_WORD_POS_X      27  \r
#define IMM64_SIGN_VAL_POS_X            63  \r
\r
EFI_STATUS\r
PeCoffLoaderRelocateImageEx (\r
  IN UINT16      *Reloc,\r
  IN OUT CHAR8   *Fixup, \r
  IN OUT CHAR8   **FixupData,\r
  IN UINT64      Adjust\r
  )\r
/*++\r
\r
Routine Description:\r
\r
  Performs an Itanium-based specific relocation fixup\r
\r
Arguments:\r
\r
  Reloc      - Pointer to the relocation record\r
\r
  Fixup      - Pointer to the address to fix up\r
\r
  FixupData  - Pointer to a buffer to log the fixups\r
\r
  Adjust     - The offset to adjust the fixup\r
\r
Returns:\r
\r
  Status code\r
\r
--*/\r
{\r
  UINT64      *F64;\r
  UINT64      FixupVal;\r
\r
  switch ((*Reloc) >> 12) {\r
\r
    case EFI_IMAGE_REL_BASED_DIR64:\r
      F64 = (UINT64 *) Fixup;\r
      *F64 = *F64 + (UINT64) Adjust;\r
      if (*FixupData != NULL) {\r
        *FixupData = ALIGN_POINTER(*FixupData, sizeof(UINT64));\r
        *(UINT64 *)(*FixupData) = *F64;\r
        *FixupData = *FixupData + sizeof(UINT64);\r
      }\r
      break;\r
\r
    case EFI_IMAGE_REL_BASED_IA64_IMM64:\r
\r
      //\r
      // Align it to bundle address before fixing up the\r
      // 64-bit immediate value of the movl instruction.\r
      //\r
\r
      Fixup = (CHAR8 *)((UINTN) Fixup & (UINTN) ~(15));\r
      FixupVal = (UINT64)0;\r
                       \r
      // \r
      // Extract the lower 32 bits of IMM64 from bundle\r
      //\r
      EXT_IMM64(FixupVal,\r
                (UINT32 *)Fixup + IMM64_IMM7B_INST_WORD_X,\r
                IMM64_IMM7B_SIZE_X,\r
                IMM64_IMM7B_INST_WORD_POS_X,\r
                IMM64_IMM7B_VAL_POS_X\r
                );\r
\r
      EXT_IMM64(FixupVal,\r
                (UINT32 *)Fixup + IMM64_IMM9D_INST_WORD_X,\r
                IMM64_IMM9D_SIZE_X,\r
                IMM64_IMM9D_INST_WORD_POS_X,\r
                IMM64_IMM9D_VAL_POS_X\r
                );\r
\r
      EXT_IMM64(FixupVal,\r
                (UINT32 *)Fixup + IMM64_IMM5C_INST_WORD_X,\r
                IMM64_IMM5C_SIZE_X,\r
                IMM64_IMM5C_INST_WORD_POS_X,\r
                IMM64_IMM5C_VAL_POS_X\r
                );\r
\r
      EXT_IMM64(FixupVal,\r
                (UINT32 *)Fixup + IMM64_IC_INST_WORD_X,\r
                IMM64_IC_SIZE_X,\r
                IMM64_IC_INST_WORD_POS_X,\r
                IMM64_IC_VAL_POS_X\r
                );\r
\r
      EXT_IMM64(FixupVal,\r
                (UINT32 *)Fixup + IMM64_IMM41a_INST_WORD_X,\r
                IMM64_IMM41a_SIZE_X,\r
                IMM64_IMM41a_INST_WORD_POS_X,\r
                IMM64_IMM41a_VAL_POS_X\r
                );\r
                       \r
      // \r
      // Update 64-bit address\r
      //\r
      FixupVal += Adjust;\r
\r
      // \r
      // Insert IMM64 into bundle\r
      //\r
      INS_IMM64(FixupVal,\r
                ((UINT32 *)Fixup + IMM64_IMM7B_INST_WORD_X),\r
                IMM64_IMM7B_SIZE_X,\r
                IMM64_IMM7B_INST_WORD_POS_X,\r
                IMM64_IMM7B_VAL_POS_X\r
                );\r
\r
      INS_IMM64(FixupVal,\r
                ((UINT32 *)Fixup + IMM64_IMM9D_INST_WORD_X),\r
                IMM64_IMM9D_SIZE_X,\r
                IMM64_IMM9D_INST_WORD_POS_X,\r
                IMM64_IMM9D_VAL_POS_X\r
                );\r
\r
      INS_IMM64(FixupVal,\r
                ((UINT32 *)Fixup + IMM64_IMM5C_INST_WORD_X),\r
                IMM64_IMM5C_SIZE_X,\r
                IMM64_IMM5C_INST_WORD_POS_X,\r
                IMM64_IMM5C_VAL_POS_X\r
                );\r
\r
      INS_IMM64(FixupVal,\r
                ((UINT32 *)Fixup + IMM64_IC_INST_WORD_X),\r
                IMM64_IC_SIZE_X,\r
                IMM64_IC_INST_WORD_POS_X,\r
                IMM64_IC_VAL_POS_X\r
                );\r
\r
      INS_IMM64(FixupVal,\r
                ((UINT32 *)Fixup + IMM64_IMM41a_INST_WORD_X),\r
                IMM64_IMM41a_SIZE_X,\r
                IMM64_IMM41a_INST_WORD_POS_X,\r
                IMM64_IMM41a_VAL_POS_X\r
                );\r
\r
      INS_IMM64(FixupVal,\r
                ((UINT32 *)Fixup + IMM64_IMM41b_INST_WORD_X),\r
                IMM64_IMM41b_SIZE_X,\r
                IMM64_IMM41b_INST_WORD_POS_X,\r
                IMM64_IMM41b_VAL_POS_X\r
                );\r
\r
      INS_IMM64(FixupVal,\r
                ((UINT32 *)Fixup + IMM64_IMM41c_INST_WORD_X),\r
                IMM64_IMM41c_SIZE_X,\r
                IMM64_IMM41c_INST_WORD_POS_X,\r
                IMM64_IMM41c_VAL_POS_X\r
                );\r
\r
      INS_IMM64(FixupVal,\r
                ((UINT32 *)Fixup + IMM64_SIGN_INST_WORD_X),\r
                IMM64_SIGN_SIZE_X,\r
                IMM64_SIGN_INST_WORD_POS_X,\r
                IMM64_SIGN_VAL_POS_X\r
                );\r
\r
      F64 = (UINT64 *) Fixup;\r
      if (*FixupData != NULL) {\r
        *FixupData = ALIGN_POINTER(*FixupData, sizeof(UINT64));\r
        *(UINT64 *)(*FixupData) = *F64;\r
        *FixupData = *FixupData + sizeof(UINT64);\r
      }\r
      break;\r
\r
    default:\r
      return EFI_UNSUPPORTED;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
Commit	Line	Data
878ddf1f	1	/*++\r
	2	\r
	3	Copyright (c) 2004, Intel Corporation \r
	4	All rights reserved. This program and the accompanying materials \r
	5	are licensed and made available under the terms and conditions of the BSD License \r
	6	which accompanies this distribution. The full text of the license may be found at \r
	7	http://opensource.org/licenses/bsd-license.php \r
	8	\r
	9	THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS, \r
	10	WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED. \r
	11	\r
	12	Module Name:\r
	13	\r
	14	PeCoffLoaderEx.c\r
	15	\r
	16	Abstract:\r
	17	\r
	18	Fixes Intel Itanium(TM) specific relocation types\r
	19	\r
	20	\r
	21	Revision History\r
	22	\r
	23	--*/\r
	24	\r
	25	#include "TianoCommon.h"\r
	26	#include "EfiImage.h"\r
	27	\r
	28	#define EXT_IMM64(Value, Address, Size, InstPos, ValPos) \\r
	29	Value \|= (((UINT64)((*(Address) >> InstPos) & (((UINT64)1 << Size) - 1))) << ValPos)\r
	30	\r
	31	#define INS_IMM64(Value, Address, Size, InstPos, ValPos) \\r
	32	(UINT32)Address = ((UINT32)Address & ~(((1 << Size) - 1) << InstPos)) \| \\r
	33	((UINT32)((((UINT64)Value >> ValPos) & (((UINT64)1 << Size) - 1))) << InstPos)\r
	34	\r
	35	#define IMM64_IMM7B_INST_WORD_X 3 \r
	36	#define IMM64_IMM7B_SIZE_X 7 \r
	37	#define IMM64_IMM7B_INST_WORD_POS_X 4 \r
	38	#define IMM64_IMM7B_VAL_POS_X 0 \r
	39	\r
	40	#define IMM64_IMM9D_INST_WORD_X 3 \r
	41	#define IMM64_IMM9D_SIZE_X 9 \r
	42	#define IMM64_IMM9D_INST_WORD_POS_X 18 \r
	43	#define IMM64_IMM9D_VAL_POS_X 7 \r
	44	\r
	45	#define IMM64_IMM5C_INST_WORD_X 3 \r
	46	#define IMM64_IMM5C_SIZE_X 5 \r
	47	#define IMM64_IMM5C_INST_WORD_POS_X 13 \r
	48	#define IMM64_IMM5C_VAL_POS_X 16 \r
	49	\r
	50	#define IMM64_IC_INST_WORD_X 3 \r
	51	#define IMM64_IC_SIZE_X 1 \r
	52	#define IMM64_IC_INST_WORD_POS_X 12 \r
	53	#define IMM64_IC_VAL_POS_X 21 \r
	54	\r
	55	#define IMM64_IMM41a_INST_WORD_X 1 \r
	56	#define IMM64_IMM41a_SIZE_X 10 \r
	57	#define IMM64_IMM41a_INST_WORD_POS_X 14 \r
	58	#define IMM64_IMM41a_VAL_POS_X 22 \r
	59	\r
	60	#define IMM64_IMM41b_INST_WORD_X 1 \r
	61	#define IMM64_IMM41b_SIZE_X 8 \r
	62	#define IMM64_IMM41b_INST_WORD_POS_X 24 \r
	63	#define IMM64_IMM41b_VAL_POS_X 32 \r
	64	\r
65	#define IMM64_IMM41c_INST_WORD_X 2 \r
66	#define IMM64_IMM41c_SIZE_X 23 \r
67	#define IMM64_IMM41c_INST_WORD_POS_X 0 \r
68	#define IMM64_IMM41c_VAL_POS_X 40 \r
69	\r
70	#define IMM64_SIGN_INST_WORD_X 3 \r
71	#define IMM64_SIGN_SIZE_X 1 \r
72	#define IMM64_SIGN_INST_WORD_POS_X 27 \r
73	#define IMM64_SIGN_VAL_POS_X 63 \r
74	\r
75	EFI_STATUS\r
76	PeCoffLoaderRelocateImageEx (\r
77	IN UINT16 *Reloc,\r
78	IN OUT CHAR8 *Fixup, \r
79	IN OUT CHAR8 **FixupData,\r
80	IN UINT64 Adjust\r
81	)\r
82	/*++\r
83	\r
84	Routine Description:\r
85	\r
86	Performs an Itanium-based specific relocation fixup\r
87	\r
88	Arguments:\r
89	\r
90	Reloc - Pointer to the relocation record\r
91	\r
92	Fixup - Pointer to the address to fix up\r
93	\r
94	FixupData - Pointer to a buffer to log the fixups\r
95	\r
96	Adjust - The offset to adjust the fixup\r
97	\r
98	Returns:\r
99	\r
100	Status code\r
101	\r
102	--*/\r
103	{\r
104	UINT64 *F64;\r
105	UINT64 FixupVal;\r
106	\r
107	switch ((*Reloc) >> 12) {\r
108	\r
109	case EFI_IMAGE_REL_BASED_DIR64:\r
110	F64 = (UINT64 *) Fixup;\r
111	F64 = F64 + (UINT64) Adjust;\r
112	if (*FixupData != NULL) {\r
113	FixupData = ALIGN_POINTER(FixupData, sizeof(UINT64));\r
114	(UINT64 )(FixupData) = F64;\r
115	FixupData = FixupData + sizeof(UINT64);\r
116	}\r
117	break;\r
118	\r
119	case EFI_IMAGE_REL_BASED_IA64_IMM64:\r
120	\r
121	//\r
122	// Align it to bundle address before fixing up the\r
123	// 64-bit immediate value of the movl instruction.\r
124	//\r
125	\r
126	Fixup = (CHAR8 *)((UINTN) Fixup & (UINTN) ~(15));\r
127	FixupVal = (UINT64)0;\r
128	\r
129	// \r
130	// Extract the lower 32 bits of IMM64 from bundle\r
131	//\r
132	EXT_IMM64(FixupVal,\r
133	(UINT32 *)Fixup + IMM64_IMM7B_INST_WORD_X,\r
134	IMM64_IMM7B_SIZE_X,\r
135	IMM64_IMM7B_INST_WORD_POS_X,\r
136	IMM64_IMM7B_VAL_POS_X\r
137	);\r
138	\r
139	EXT_IMM64(FixupVal,\r
140	(UINT32 *)Fixup + IMM64_IMM9D_INST_WORD_X,\r
141	IMM64_IMM9D_SIZE_X,\r
142	IMM64_IMM9D_INST_WORD_POS_X,\r
143	IMM64_IMM9D_VAL_POS_X\r
144	);\r
145	\r
146	EXT_IMM64(FixupVal,\r
147	(UINT32 *)Fixup + IMM64_IMM5C_INST_WORD_X,\r
148	IMM64_IMM5C_SIZE_X,\r
149	IMM64_IMM5C_INST_WORD_POS_X,\r
150	IMM64_IMM5C_VAL_POS_X\r
151	);\r
152	\r
153	EXT_IMM64(FixupVal,\r
154	(UINT32 *)Fixup + IMM64_IC_INST_WORD_X,\r
155	IMM64_IC_SIZE_X,\r
156	IMM64_IC_INST_WORD_POS_X,\r
157	IMM64_IC_VAL_POS_X\r
158	);\r
159	\r
160	EXT_IMM64(FixupVal,\r
161	(UINT32 *)Fixup + IMM64_IMM41a_INST_WORD_X,\r
162	IMM64_IMM41a_SIZE_X,\r
163	IMM64_IMM41a_INST_WORD_POS_X,\r
164	IMM64_IMM41a_VAL_POS_X\r
165	);\r
166	\r
167	// \r
168	// Update 64-bit address\r
169	//\r
170	FixupVal += Adjust;\r
171	\r
172	// \r
173	// Insert IMM64 into bundle\r
174	//\r
175	INS_IMM64(FixupVal,\r
176	((UINT32 *)Fixup + IMM64_IMM7B_INST_WORD_X),\r
177	IMM64_IMM7B_SIZE_X,\r
178	IMM64_IMM7B_INST_WORD_POS_X,\r
179	IMM64_IMM7B_VAL_POS_X\r
180	);\r
181	\r
182	INS_IMM64(FixupVal,\r
183	((UINT32 *)Fixup + IMM64_IMM9D_INST_WORD_X),\r
184	IMM64_IMM9D_SIZE_X,\r
185	IMM64_IMM9D_INST_WORD_POS_X,\r
186	IMM64_IMM9D_VAL_POS_X\r
187	);\r
188	\r
189	INS_IMM64(FixupVal,\r
190	((UINT32 *)Fixup + IMM64_IMM5C_INST_WORD_X),\r
191	IMM64_IMM5C_SIZE_X,\r
192	IMM64_IMM5C_INST_WORD_POS_X,\r
193	IMM64_IMM5C_VAL_POS_X\r
194	);\r
195	\r
196	INS_IMM64(FixupVal,\r
197	((UINT32 *)Fixup + IMM64_IC_INST_WORD_X),\r
198	IMM64_IC_SIZE_X,\r
199	IMM64_IC_INST_WORD_POS_X,\r
200	IMM64_IC_VAL_POS_X\r
201	);\r
202	\r
203	INS_IMM64(FixupVal,\r
204	((UINT32 *)Fixup + IMM64_IMM41a_INST_WORD_X),\r
205	IMM64_IMM41a_SIZE_X,\r
206	IMM64_IMM41a_INST_WORD_POS_X,\r
207	IMM64_IMM41a_VAL_POS_X\r
208	);\r
209	\r
210	INS_IMM64(FixupVal,\r
211	((UINT32 *)Fixup + IMM64_IMM41b_INST_WORD_X),\r
212	IMM64_IMM41b_SIZE_X,\r
213	IMM64_IMM41b_INST_WORD_POS_X,\r
214	IMM64_IMM41b_VAL_POS_X\r
215	);\r
216	\r
217	INS_IMM64(FixupVal,\r
218	((UINT32 *)Fixup + IMM64_IMM41c_INST_WORD_X),\r
219	IMM64_IMM41c_SIZE_X,\r
220	IMM64_IMM41c_INST_WORD_POS_X,\r
221	IMM64_IMM41c_VAL_POS_X\r
222	);\r
223	\r
224	INS_IMM64(FixupVal,\r
225	((UINT32 *)Fixup + IMM64_SIGN_INST_WORD_X),\r
226	IMM64_SIGN_SIZE_X,\r
227	IMM64_SIGN_INST_WORD_POS_X,\r
228	IMM64_SIGN_VAL_POS_X\r
229	);\r
230	\r
231	F64 = (UINT64 *) Fixup;\r
232	if (*FixupData != NULL) {\r
233	FixupData = ALIGN_POINTER(FixupData, sizeof(UINT64));\r
234	(UINT64 )(FixupData) = F64;\r
235	FixupData = FixupData + sizeof(UINT64);\r
236	}\r
237	break;\r
238	\r
239	default:\r
240	return EFI_UNSUPPORTED;\r
241	}\r
242	\r
243	return EFI_SUCCESS;\r
244	}\r