blob: 8747dad5e50daf6d61c48e5d7367a37c63c35d89 [file] [log] [blame]
Dave Allison65fcc2c2014-04-28 13:45:27 -07001/*
2 * Copyright (C) 2014 The Android Open Source Project
3 *
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at
7 *
8 * http://www.apache.org/licenses/LICENSE-2.0
9 *
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
15 */
16
Vladimir Markoa64f2492016-04-25 12:43:50 +000017#include <type_traits>
18
Dave Allison65fcc2c2014-04-28 13:45:27 -070019#include "assembler_thumb2.h"
20
Vladimir Marko80afd022015-05-19 18:08:00 +010021#include "base/bit_utils.h"
Dave Allison65fcc2c2014-04-28 13:45:27 -070022#include "base/logging.h"
23#include "entrypoints/quick/quick_entrypoints.h"
24#include "offsets.h"
25#include "thread.h"
Dave Allison65fcc2c2014-04-28 13:45:27 -070026
27namespace art {
28namespace arm {
29
Vladimir Markoa64f2492016-04-25 12:43:50 +000030template <typename Function>
31void Thumb2Assembler::Fixup::ForExpandableDependencies(Thumb2Assembler* assembler, Function fn) {
32 static_assert(
33 std::is_same<typename std::result_of<Function(FixupId, FixupId)>::type, void>::value,
34 "Incorrect signature for argument `fn`: expected (FixupId, FixupId) -> void");
35 Fixup* fixups = assembler->fixups_.data();
36 for (FixupId fixup_id = 0u, end_id = assembler->fixups_.size(); fixup_id != end_id; ++fixup_id) {
37 uint32_t target = fixups[fixup_id].target_;
38 if (target > fixups[fixup_id].location_) {
39 for (FixupId id = fixup_id + 1u; id != end_id && fixups[id].location_ < target; ++id) {
40 if (fixups[id].CanExpand()) {
41 fn(id, fixup_id);
42 }
43 }
44 } else {
45 for (FixupId id = fixup_id; id != 0u && fixups[id - 1u].location_ >= target; --id) {
46 if (fixups[id - 1u].CanExpand()) {
47 fn(id - 1u, fixup_id);
48 }
49 }
50 }
51 }
52}
53
Vladimir Marko6b756b52015-07-14 11:58:38 +010054void Thumb2Assembler::Fixup::PrepareDependents(Thumb2Assembler* assembler) {
55 // For each Fixup, it's easy to find the Fixups that it depends on as they are either
56 // the following or the preceding Fixups until we find the target. However, for fixup
57 // adjustment we need the reverse lookup, i.e. what Fixups depend on a given Fixup.
58 // This function creates a compact representation of this relationship, where we have
59 // all the dependents in a single array and Fixups reference their ranges by start
60 // index and count. (Instead of having a per-fixup vector.)
61
62 // Count the number of dependents of each Fixup.
Vladimir Marko6b756b52015-07-14 11:58:38 +010063 Fixup* fixups = assembler->fixups_.data();
Vladimir Markoa64f2492016-04-25 12:43:50 +000064 ForExpandableDependencies(
65 assembler,
66 [fixups](FixupId dependency, FixupId dependent ATTRIBUTE_UNUSED) {
67 fixups[dependency].dependents_count_ += 1u;
68 });
Vladimir Marko6b756b52015-07-14 11:58:38 +010069 // Assign index ranges in fixup_dependents_ to individual fixups. Record the end of the
70 // range in dependents_start_, we shall later decrement it as we fill in fixup_dependents_.
71 uint32_t number_of_dependents = 0u;
Vladimir Markoa64f2492016-04-25 12:43:50 +000072 for (FixupId fixup_id = 0u, end_id = assembler->fixups_.size(); fixup_id != end_id; ++fixup_id) {
Vladimir Marko6b756b52015-07-14 11:58:38 +010073 number_of_dependents += fixups[fixup_id].dependents_count_;
74 fixups[fixup_id].dependents_start_ = number_of_dependents;
75 }
76 if (number_of_dependents == 0u) {
77 return;
78 }
79 // Create and fill in the fixup_dependents_.
Vladimir Marko93205e32016-04-13 11:59:46 +010080 assembler->fixup_dependents_.resize(number_of_dependents);
81 FixupId* dependents = assembler->fixup_dependents_.data();
Vladimir Markoa64f2492016-04-25 12:43:50 +000082 ForExpandableDependencies(
83 assembler,
84 [fixups, dependents](FixupId dependency, FixupId dependent) {
85 fixups[dependency].dependents_start_ -= 1u;
86 dependents[fixups[dependency].dependents_start_] = dependent;
87 });
Vladimir Marko6b756b52015-07-14 11:58:38 +010088}
89
Vladimir Markocf93a5c2015-06-16 11:33:24 +000090void Thumb2Assembler::BindLabel(Label* label, uint32_t bound_pc) {
91 CHECK(!label->IsBound());
92
93 while (label->IsLinked()) {
94 FixupId fixup_id = label->Position(); // The id for linked Fixup.
95 Fixup* fixup = GetFixup(fixup_id); // Get the Fixup at this id.
96 fixup->Resolve(bound_pc); // Fixup can be resolved now.
Vladimir Markocf93a5c2015-06-16 11:33:24 +000097 uint32_t fixup_location = fixup->GetLocation();
98 uint16_t next = buffer_.Load<uint16_t>(fixup_location); // Get next in chain.
99 buffer_.Store<int16_t>(fixup_location, 0);
100 label->position_ = next; // Move to next.
101 }
102 label->BindTo(bound_pc);
103}
104
Andreas Gampe7cffc3b2015-10-19 21:31:53 -0700105uint32_t Thumb2Assembler::BindLiterals() {
Vladimir Markocf93a5c2015-06-16 11:33:24 +0000106 // We don't add the padding here, that's done only after adjusting the Fixup sizes.
107 uint32_t code_size = buffer_.Size();
108 for (Literal& lit : literals_) {
109 Label* label = lit.GetLabel();
110 BindLabel(label, code_size);
111 code_size += lit.GetSize();
112 }
Andreas Gampe7cffc3b2015-10-19 21:31:53 -0700113 return code_size;
114}
115
116void Thumb2Assembler::BindJumpTables(uint32_t code_size) {
117 for (JumpTable& table : jump_tables_) {
118 Label* label = table.GetLabel();
119 BindLabel(label, code_size);
120 code_size += table.GetSize();
121 }
Vladimir Markocf93a5c2015-06-16 11:33:24 +0000122}
123
124void Thumb2Assembler::AdjustFixupIfNeeded(Fixup* fixup, uint32_t* current_code_size,
125 std::deque<FixupId>* fixups_to_recalculate) {
126 uint32_t adjustment = fixup->AdjustSizeIfNeeded(*current_code_size);
127 if (adjustment != 0u) {
Vladimir Markoa64f2492016-04-25 12:43:50 +0000128 DCHECK(fixup->CanExpand());
Vladimir Markocf93a5c2015-06-16 11:33:24 +0000129 *current_code_size += adjustment;
Vladimir Marko6b756b52015-07-14 11:58:38 +0100130 for (FixupId dependent_id : fixup->Dependents(*this)) {
Vladimir Markocf93a5c2015-06-16 11:33:24 +0000131 Fixup* dependent = GetFixup(dependent_id);
132 dependent->IncreaseAdjustment(adjustment);
133 if (buffer_.Load<int16_t>(dependent->GetLocation()) == 0) {
134 buffer_.Store<int16_t>(dependent->GetLocation(), 1);
135 fixups_to_recalculate->push_back(dependent_id);
136 }
137 }
138 }
139}
140
141uint32_t Thumb2Assembler::AdjustFixups() {
Vladimir Marko6b756b52015-07-14 11:58:38 +0100142 Fixup::PrepareDependents(this);
Vladimir Markocf93a5c2015-06-16 11:33:24 +0000143 uint32_t current_code_size = buffer_.Size();
144 std::deque<FixupId> fixups_to_recalculate;
145 if (kIsDebugBuild) {
146 // We will use the placeholders in the buffer_ to mark whether the fixup has
147 // been added to the fixups_to_recalculate. Make sure we start with zeros.
148 for (Fixup& fixup : fixups_) {
149 CHECK_EQ(buffer_.Load<int16_t>(fixup.GetLocation()), 0);
150 }
151 }
152 for (Fixup& fixup : fixups_) {
153 AdjustFixupIfNeeded(&fixup, &current_code_size, &fixups_to_recalculate);
154 }
155 while (!fixups_to_recalculate.empty()) {
Vladimir Marko663c9342015-07-22 11:28:14 +0100156 do {
157 // Pop the fixup.
158 FixupId fixup_id = fixups_to_recalculate.front();
159 fixups_to_recalculate.pop_front();
160 Fixup* fixup = GetFixup(fixup_id);
161 DCHECK_NE(buffer_.Load<int16_t>(fixup->GetLocation()), 0);
162 buffer_.Store<int16_t>(fixup->GetLocation(), 0);
163 // See if it needs adjustment.
164 AdjustFixupIfNeeded(fixup, &current_code_size, &fixups_to_recalculate);
165 } while (!fixups_to_recalculate.empty());
166
Andreas Gampe7cffc3b2015-10-19 21:31:53 -0700167 if ((current_code_size & 2) != 0 && (!literals_.empty() || !jump_tables_.empty())) {
Vladimir Marko663c9342015-07-22 11:28:14 +0100168 // If we need to add padding before literals, this may just push some out of range,
169 // so recalculate all load literals. This makes up for the fact that we don't mark
170 // load literal as a dependency of all previous Fixups even though it actually is.
171 for (Fixup& fixup : fixups_) {
172 if (fixup.IsLoadLiteral()) {
173 AdjustFixupIfNeeded(&fixup, &current_code_size, &fixups_to_recalculate);
174 }
175 }
176 }
Vladimir Markocf93a5c2015-06-16 11:33:24 +0000177 }
178 if (kIsDebugBuild) {
179 // Check that no fixup is marked as being in fixups_to_recalculate anymore.
180 for (Fixup& fixup : fixups_) {
181 CHECK_EQ(buffer_.Load<int16_t>(fixup.GetLocation()), 0);
182 }
183 }
184
185 // Adjust literal pool labels for padding.
Roland Levillain14d90572015-07-16 10:52:26 +0100186 DCHECK_ALIGNED(current_code_size, 2);
Vladimir Markocf93a5c2015-06-16 11:33:24 +0000187 uint32_t literals_adjustment = current_code_size + (current_code_size & 2) - buffer_.Size();
188 if (literals_adjustment != 0u) {
189 for (Literal& literal : literals_) {
190 Label* label = literal.GetLabel();
191 DCHECK(label->IsBound());
192 int old_position = label->Position();
193 label->Reinitialize();
194 label->BindTo(old_position + literals_adjustment);
195 }
Andreas Gampe7cffc3b2015-10-19 21:31:53 -0700196 for (JumpTable& table : jump_tables_) {
197 Label* label = table.GetLabel();
198 DCHECK(label->IsBound());
199 int old_position = label->Position();
200 label->Reinitialize();
201 label->BindTo(old_position + literals_adjustment);
202 }
Vladimir Markocf93a5c2015-06-16 11:33:24 +0000203 }
204
205 return current_code_size;
206}
207
208void Thumb2Assembler::EmitFixups(uint32_t adjusted_code_size) {
209 // Move non-fixup code to its final place and emit fixups.
210 // Process fixups in reverse order so that we don't repeatedly move the same data.
211 size_t src_end = buffer_.Size();
212 size_t dest_end = adjusted_code_size;
213 buffer_.Resize(dest_end);
214 DCHECK_GE(dest_end, src_end);
215 for (auto i = fixups_.rbegin(), end = fixups_.rend(); i != end; ++i) {
216 Fixup* fixup = &*i;
217 if (fixup->GetOriginalSize() == fixup->GetSize()) {
218 // The size of this Fixup didn't change. To avoid moving the data
219 // in small chunks, emit the code to its original position.
220 fixup->Emit(&buffer_, adjusted_code_size);
221 fixup->Finalize(dest_end - src_end);
222 } else {
223 // Move the data between the end of the fixup and src_end to its final location.
224 size_t old_fixup_location = fixup->GetLocation();
225 size_t src_begin = old_fixup_location + fixup->GetOriginalSizeInBytes();
226 size_t data_size = src_end - src_begin;
227 size_t dest_begin = dest_end - data_size;
228 buffer_.Move(dest_begin, src_begin, data_size);
229 src_end = old_fixup_location;
230 dest_end = dest_begin - fixup->GetSizeInBytes();
231 // Finalize the Fixup and emit the data to the new location.
232 fixup->Finalize(dest_end - src_end);
233 fixup->Emit(&buffer_, adjusted_code_size);
234 }
235 }
236 CHECK_EQ(src_end, dest_end);
237}
238
239void Thumb2Assembler::EmitLiterals() {
240 if (!literals_.empty()) {
241 // Load literal instructions (LDR, LDRD, VLDR) require 4-byte alignment.
242 // We don't support byte and half-word literals.
243 uint32_t code_size = buffer_.Size();
Roland Levillain14d90572015-07-16 10:52:26 +0100244 DCHECK_ALIGNED(code_size, 2);
Vladimir Markocf93a5c2015-06-16 11:33:24 +0000245 if ((code_size & 2u) != 0u) {
246 Emit16(0);
247 }
248 for (Literal& literal : literals_) {
249 AssemblerBuffer::EnsureCapacity ensured(&buffer_);
250 DCHECK_EQ(static_cast<size_t>(literal.GetLabel()->Position()), buffer_.Size());
251 DCHECK(literal.GetSize() == 4u || literal.GetSize() == 8u);
252 for (size_t i = 0, size = literal.GetSize(); i != size; ++i) {
253 buffer_.Emit<uint8_t>(literal.GetData()[i]);
254 }
255 }
256 }
257}
258
Andreas Gampe7cffc3b2015-10-19 21:31:53 -0700259void Thumb2Assembler::EmitJumpTables() {
260 if (!jump_tables_.empty()) {
261 // Jump tables require 4 byte alignment. (We don't support byte and half-word jump tables.)
262 uint32_t code_size = buffer_.Size();
263 DCHECK_ALIGNED(code_size, 2);
264 if ((code_size & 2u) != 0u) {
265 Emit16(0);
266 }
267 for (JumpTable& table : jump_tables_) {
268 // Bulk ensure capacity, as this may be large.
269 size_t orig_size = buffer_.Size();
Vladimir Marko9152fed2016-04-20 14:39:47 +0100270 size_t required_capacity = orig_size + table.GetSize();
271 if (required_capacity > buffer_.Capacity()) {
272 buffer_.ExtendCapacity(required_capacity);
273 }
Andreas Gampe7cffc3b2015-10-19 21:31:53 -0700274#ifndef NDEBUG
275 buffer_.has_ensured_capacity_ = true;
276#endif
277
278 DCHECK_EQ(static_cast<size_t>(table.GetLabel()->Position()), buffer_.Size());
279 int32_t anchor_position = table.GetAnchorLabel()->Position() + 4;
280
281 for (Label* target : table.GetData()) {
282 // Ensure that the label was tracked, so that it will have the right position.
283 DCHECK(std::find(tracked_labels_.begin(), tracked_labels_.end(), target) !=
284 tracked_labels_.end());
285
286 int32_t offset = target->Position() - anchor_position;
287 buffer_.Emit<int32_t>(offset);
288 }
289
290#ifndef NDEBUG
291 buffer_.has_ensured_capacity_ = false;
292#endif
293 size_t new_size = buffer_.Size();
294 DCHECK_LE(new_size - orig_size, table.GetSize());
295 }
296 }
297}
298
Vladimir Marko10ef6942015-10-22 15:25:54 +0100299void Thumb2Assembler::PatchCFI() {
300 if (cfi().NumberOfDelayedAdvancePCs() == 0u) {
301 return;
302 }
303
304 typedef DebugFrameOpCodeWriterForAssembler::DelayedAdvancePC DelayedAdvancePC;
305 const auto data = cfi().ReleaseStreamAndPrepareForDelayedAdvancePC();
306 const std::vector<uint8_t>& old_stream = data.first;
307 const std::vector<DelayedAdvancePC>& advances = data.second;
308
309 // Refill our data buffer with patched opcodes.
310 cfi().ReserveCFIStream(old_stream.size() + advances.size() + 16);
311 size_t stream_pos = 0;
312 for (const DelayedAdvancePC& advance : advances) {
313 DCHECK_GE(advance.stream_pos, stream_pos);
314 // Copy old data up to the point where advance was issued.
315 cfi().AppendRawData(old_stream, stream_pos, advance.stream_pos);
316 stream_pos = advance.stream_pos;
317 // Insert the advance command with its final offset.
318 size_t final_pc = GetAdjustedPosition(advance.pc);
319 cfi().AdvancePC(final_pc);
320 }
321 // Copy the final segment if any.
322 cfi().AppendRawData(old_stream, stream_pos, old_stream.size());
323}
324
Vladimir Markocf93a5c2015-06-16 11:33:24 +0000325inline int16_t Thumb2Assembler::BEncoding16(int32_t offset, Condition cond) {
Roland Levillain14d90572015-07-16 10:52:26 +0100326 DCHECK_ALIGNED(offset, 2);
Vladimir Markocf93a5c2015-06-16 11:33:24 +0000327 int16_t encoding = B15 | B14;
328 if (cond != AL) {
329 DCHECK(IsInt<9>(offset));
330 encoding |= B12 | (static_cast<int32_t>(cond) << 8) | ((offset >> 1) & 0xff);
331 } else {
332 DCHECK(IsInt<12>(offset));
333 encoding |= B13 | ((offset >> 1) & 0x7ff);
334 }
335 return encoding;
336}
337
338inline int32_t Thumb2Assembler::BEncoding32(int32_t offset, Condition cond) {
Roland Levillain14d90572015-07-16 10:52:26 +0100339 DCHECK_ALIGNED(offset, 2);
Vladimir Markocf93a5c2015-06-16 11:33:24 +0000340 int32_t s = (offset >> 31) & 1; // Sign bit.
341 int32_t encoding = B31 | B30 | B29 | B28 | B15 |
342 (s << 26) | // Sign bit goes to bit 26.
343 ((offset >> 1) & 0x7ff); // imm11 goes to bits 0-10.
344 if (cond != AL) {
345 DCHECK(IsInt<21>(offset));
346 // Encode cond, move imm6 from bits 12-17 to bits 16-21 and move J1 and J2.
347 encoding |= (static_cast<int32_t>(cond) << 22) | ((offset & 0x3f000) << (16 - 12)) |
348 ((offset & (1 << 19)) >> (19 - 13)) | // Extract J1 from bit 19 to bit 13.
349 ((offset & (1 << 18)) >> (18 - 11)); // Extract J2 from bit 18 to bit 11.
350 } else {
351 DCHECK(IsInt<25>(offset));
352 int32_t j1 = ((offset >> 23) ^ s ^ 1) & 1; // Calculate J1 from I1 extracted from bit 23.
353 int32_t j2 = ((offset >> 22)^ s ^ 1) & 1; // Calculate J2 from I2 extracted from bit 22.
354 // Move imm10 from bits 12-21 to bits 16-25 and add J1 and J2.
355 encoding |= B12 | ((offset & 0x3ff000) << (16 - 12)) |
356 (j1 << 13) | (j2 << 11);
357 }
358 return encoding;
359}
360
361inline int16_t Thumb2Assembler::CbxzEncoding16(Register rn, int32_t offset, Condition cond) {
362 DCHECK(!IsHighRegister(rn));
Roland Levillain14d90572015-07-16 10:52:26 +0100363 DCHECK_ALIGNED(offset, 2);
Vladimir Markocf93a5c2015-06-16 11:33:24 +0000364 DCHECK(IsUint<7>(offset));
365 DCHECK(cond == EQ || cond == NE);
366 return B15 | B13 | B12 | B8 | (cond == NE ? B11 : 0) | static_cast<int32_t>(rn) |
367 ((offset & 0x3e) << (3 - 1)) | // Move imm5 from bits 1-5 to bits 3-7.
368 ((offset & 0x40) << (9 - 6)); // Move i from bit 6 to bit 11
369}
370
371inline int16_t Thumb2Assembler::CmpRnImm8Encoding16(Register rn, int32_t value) {
372 DCHECK(!IsHighRegister(rn));
373 DCHECK(IsUint<8>(value));
374 return B13 | B11 | (rn << 8) | value;
375}
376
377inline int16_t Thumb2Assembler::AddRdnRmEncoding16(Register rdn, Register rm) {
378 // The high bit of rn is moved across 4-bit rm.
379 return B14 | B10 | (static_cast<int32_t>(rm) << 3) |
380 (static_cast<int32_t>(rdn) & 7) | ((static_cast<int32_t>(rdn) & 8) << 4);
381}
382
383inline int32_t Thumb2Assembler::MovwEncoding32(Register rd, int32_t value) {
384 DCHECK(IsUint<16>(value));
385 return B31 | B30 | B29 | B28 | B25 | B22 |
386 (static_cast<int32_t>(rd) << 8) |
387 ((value & 0xf000) << (16 - 12)) | // Move imm4 from bits 12-15 to bits 16-19.
388 ((value & 0x0800) << (26 - 11)) | // Move i from bit 11 to bit 26.
389 ((value & 0x0700) << (12 - 8)) | // Move imm3 from bits 8-10 to bits 12-14.
390 (value & 0xff); // Keep imm8 in bits 0-7.
391}
392
393inline int32_t Thumb2Assembler::MovtEncoding32(Register rd, int32_t value) {
394 DCHECK_EQ(value & 0xffff, 0);
395 int32_t movw_encoding = MovwEncoding32(rd, (value >> 16) & 0xffff);
396 return movw_encoding | B25 | B23;
397}
398
399inline int32_t Thumb2Assembler::MovModImmEncoding32(Register rd, int32_t value) {
400 uint32_t mod_imm = ModifiedImmediate(value);
401 DCHECK_NE(mod_imm, kInvalidModifiedImmediate);
402 return B31 | B30 | B29 | B28 | B22 | B19 | B18 | B17 | B16 |
403 (static_cast<int32_t>(rd) << 8) | static_cast<int32_t>(mod_imm);
404}
405
406inline int16_t Thumb2Assembler::LdrLitEncoding16(Register rt, int32_t offset) {
407 DCHECK(!IsHighRegister(rt));
Roland Levillain14d90572015-07-16 10:52:26 +0100408 DCHECK_ALIGNED(offset, 4);
Vladimir Markocf93a5c2015-06-16 11:33:24 +0000409 DCHECK(IsUint<10>(offset));
410 return B14 | B11 | (static_cast<int32_t>(rt) << 8) | (offset >> 2);
411}
412
413inline int32_t Thumb2Assembler::LdrLitEncoding32(Register rt, int32_t offset) {
414 // NOTE: We don't support negative offset, i.e. U=0 (B23).
415 return LdrRtRnImm12Encoding(rt, PC, offset);
416}
417
418inline int32_t Thumb2Assembler::LdrdEncoding32(Register rt, Register rt2, Register rn, int32_t offset) {
Roland Levillain14d90572015-07-16 10:52:26 +0100419 DCHECK_ALIGNED(offset, 4);
Vladimir Markocf93a5c2015-06-16 11:33:24 +0000420 CHECK(IsUint<10>(offset));
421 return B31 | B30 | B29 | B27 |
422 B24 /* P = 1 */ | B23 /* U = 1 */ | B22 | 0 /* W = 0 */ | B20 |
423 (static_cast<int32_t>(rn) << 16) | (static_cast<int32_t>(rt) << 12) |
424 (static_cast<int32_t>(rt2) << 8) | (offset >> 2);
425}
426
427inline int32_t Thumb2Assembler::VldrsEncoding32(SRegister sd, Register rn, int32_t offset) {
Roland Levillain14d90572015-07-16 10:52:26 +0100428 DCHECK_ALIGNED(offset, 4);
Vladimir Markocf93a5c2015-06-16 11:33:24 +0000429 CHECK(IsUint<10>(offset));
430 return B31 | B30 | B29 | B27 | B26 | B24 |
431 B23 /* U = 1 */ | B20 | B11 | B9 |
432 (static_cast<int32_t>(rn) << 16) |
433 ((static_cast<int32_t>(sd) & 0x01) << (22 - 0)) | // Move D from bit 0 to bit 22.
434 ((static_cast<int32_t>(sd) & 0x1e) << (12 - 1)) | // Move Vd from bits 1-4 to bits 12-15.
435 (offset >> 2);
436}
437
438inline int32_t Thumb2Assembler::VldrdEncoding32(DRegister dd, Register rn, int32_t offset) {
Roland Levillain14d90572015-07-16 10:52:26 +0100439 DCHECK_ALIGNED(offset, 4);
Vladimir Markocf93a5c2015-06-16 11:33:24 +0000440 CHECK(IsUint<10>(offset));
441 return B31 | B30 | B29 | B27 | B26 | B24 |
442 B23 /* U = 1 */ | B20 | B11 | B9 | B8 |
443 (rn << 16) |
444 ((static_cast<int32_t>(dd) & 0x10) << (22 - 4)) | // Move D from bit 4 to bit 22.
445 ((static_cast<int32_t>(dd) & 0x0f) << (12 - 0)) | // Move Vd from bits 0-3 to bits 12-15.
446 (offset >> 2);
447}
448
449inline int16_t Thumb2Assembler::LdrRtRnImm5Encoding16(Register rt, Register rn, int32_t offset) {
450 DCHECK(!IsHighRegister(rt));
451 DCHECK(!IsHighRegister(rn));
Roland Levillain14d90572015-07-16 10:52:26 +0100452 DCHECK_ALIGNED(offset, 4);
Vladimir Markocf93a5c2015-06-16 11:33:24 +0000453 DCHECK(IsUint<7>(offset));
454 return B14 | B13 | B11 |
455 (static_cast<int32_t>(rn) << 3) | static_cast<int32_t>(rt) |
456 (offset << (6 - 2)); // Move imm5 from bits 2-6 to bits 6-10.
457}
458
459int32_t Thumb2Assembler::Fixup::LoadWideOrFpEncoding(Register rbase, int32_t offset) const {
460 switch (type_) {
461 case kLoadLiteralWide:
462 return LdrdEncoding32(rn_, rt2_, rbase, offset);
463 case kLoadFPLiteralSingle:
464 return VldrsEncoding32(sd_, rbase, offset);
465 case kLoadFPLiteralDouble:
466 return VldrdEncoding32(dd_, rbase, offset);
467 default:
468 LOG(FATAL) << "Unexpected type: " << static_cast<int>(type_);
469 UNREACHABLE();
470 }
471}
472
473inline int32_t Thumb2Assembler::LdrRtRnImm12Encoding(Register rt, Register rn, int32_t offset) {
474 DCHECK(IsUint<12>(offset));
475 return B31 | B30 | B29 | B28 | B27 | B23 | B22 | B20 | (rn << 16) | (rt << 12) | offset;
476}
477
Andreas Gampe7cffc3b2015-10-19 21:31:53 -0700478inline int16_t Thumb2Assembler::AdrEncoding16(Register rd, int32_t offset) {
479 DCHECK(IsUint<10>(offset));
480 DCHECK(IsAligned<4>(offset));
481 DCHECK(!IsHighRegister(rd));
482 return B15 | B13 | (rd << 8) | (offset >> 2);
483}
484
485inline int32_t Thumb2Assembler::AdrEncoding32(Register rd, int32_t offset) {
486 DCHECK(IsUint<12>(offset));
487 // Bit 26: offset[11]
488 // Bits 14-12: offset[10-8]
489 // Bits 7-0: offset[7-0]
490 int32_t immediate_mask =
491 ((offset & (1 << 11)) << (26 - 11)) |
492 ((offset & (7 << 8)) << (12 - 8)) |
493 (offset & 0xFF);
494 return B31 | B30 | B29 | B28 | B25 | B19 | B18 | B17 | B16 | (rd << 8) | immediate_mask;
495}
496
Vladimir Markocf93a5c2015-06-16 11:33:24 +0000497void Thumb2Assembler::FinalizeCode() {
498 ArmAssembler::FinalizeCode();
Andreas Gampe7cffc3b2015-10-19 21:31:53 -0700499 uint32_t size_after_literals = BindLiterals();
500 BindJumpTables(size_after_literals);
Vladimir Markocf93a5c2015-06-16 11:33:24 +0000501 uint32_t adjusted_code_size = AdjustFixups();
502 EmitFixups(adjusted_code_size);
503 EmitLiterals();
Andreas Gampe7cffc3b2015-10-19 21:31:53 -0700504 FinalizeTrackedLabels();
505 EmitJumpTables();
Vladimir Marko10ef6942015-10-22 15:25:54 +0100506 PatchCFI();
Vladimir Markocf93a5c2015-06-16 11:33:24 +0000507}
508
Nicolas Geoffray5bd05a52015-10-13 09:48:30 +0100509bool Thumb2Assembler::ShifterOperandCanAlwaysHold(uint32_t immediate) {
510 return ArmAssembler::ModifiedImmediate(immediate) != kInvalidModifiedImmediate;
511}
512
Nicolas Geoffray3d1e7882015-02-03 13:59:52 +0000513bool Thumb2Assembler::ShifterOperandCanHold(Register rd ATTRIBUTE_UNUSED,
514 Register rn ATTRIBUTE_UNUSED,
Nicolas Geoffray3bcc8ea2014-11-28 15:00:02 +0000515 Opcode opcode,
516 uint32_t immediate,
Vladimir Markof5c09c32015-12-17 12:08:08 +0000517 SetCc set_cc,
Nicolas Geoffray3bcc8ea2014-11-28 15:00:02 +0000518 ShifterOperand* shifter_op) {
519 shifter_op->type_ = ShifterOperand::kImmediate;
520 shifter_op->immed_ = immediate;
521 shifter_op->is_shift_ = false;
522 shifter_op->is_rotate_ = false;
523 switch (opcode) {
524 case ADD:
525 case SUB:
Vladimir Markof5c09c32015-12-17 12:08:08 +0000526 // Less than (or equal to) 12 bits can be done if we don't need to set condition codes.
527 if (immediate < (1 << 12) && set_cc != kCcSet) {
Nicolas Geoffray3bcc8ea2014-11-28 15:00:02 +0000528 return true;
529 }
530 return ArmAssembler::ModifiedImmediate(immediate) != kInvalidModifiedImmediate;
531
532 case MOV:
533 // TODO: Support less than or equal to 12bits.
534 return ArmAssembler::ModifiedImmediate(immediate) != kInvalidModifiedImmediate;
Vladimir Markod2b4ca22015-09-14 15:13:26 +0100535
Nicolas Geoffray3bcc8ea2014-11-28 15:00:02 +0000536 case MVN:
537 default:
538 return ArmAssembler::ModifiedImmediate(immediate) != kInvalidModifiedImmediate;
539 }
540}
541
Dave Allison65fcc2c2014-04-28 13:45:27 -0700542void Thumb2Assembler::and_(Register rd, Register rn, const ShifterOperand& so,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +0100543 Condition cond, SetCc set_cc) {
544 EmitDataProcessing(cond, AND, set_cc, rn, rd, so);
Dave Allison65fcc2c2014-04-28 13:45:27 -0700545}
546
547
548void Thumb2Assembler::eor(Register rd, Register rn, const ShifterOperand& so,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +0100549 Condition cond, SetCc set_cc) {
550 EmitDataProcessing(cond, EOR, set_cc, rn, rd, so);
Dave Allison65fcc2c2014-04-28 13:45:27 -0700551}
552
553
554void Thumb2Assembler::sub(Register rd, Register rn, const ShifterOperand& so,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +0100555 Condition cond, SetCc set_cc) {
556 EmitDataProcessing(cond, SUB, set_cc, rn, rd, so);
Dave Allison65fcc2c2014-04-28 13:45:27 -0700557}
558
559
560void Thumb2Assembler::rsb(Register rd, Register rn, const ShifterOperand& so,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +0100561 Condition cond, SetCc set_cc) {
562 EmitDataProcessing(cond, RSB, set_cc, rn, rd, so);
Dave Allison65fcc2c2014-04-28 13:45:27 -0700563}
564
565
566void Thumb2Assembler::add(Register rd, Register rn, const ShifterOperand& so,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +0100567 Condition cond, SetCc set_cc) {
568 EmitDataProcessing(cond, ADD, set_cc, rn, rd, so);
Dave Allison65fcc2c2014-04-28 13:45:27 -0700569}
570
571
572void Thumb2Assembler::adc(Register rd, Register rn, const ShifterOperand& so,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +0100573 Condition cond, SetCc set_cc) {
574 EmitDataProcessing(cond, ADC, set_cc, rn, rd, so);
Dave Allison65fcc2c2014-04-28 13:45:27 -0700575}
576
577
578void Thumb2Assembler::sbc(Register rd, Register rn, const ShifterOperand& so,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +0100579 Condition cond, SetCc set_cc) {
580 EmitDataProcessing(cond, SBC, set_cc, rn, rd, so);
Dave Allison65fcc2c2014-04-28 13:45:27 -0700581}
582
583
584void Thumb2Assembler::rsc(Register rd, Register rn, const ShifterOperand& so,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +0100585 Condition cond, SetCc set_cc) {
586 EmitDataProcessing(cond, RSC, set_cc, rn, rd, so);
Dave Allison65fcc2c2014-04-28 13:45:27 -0700587}
588
589
590void Thumb2Assembler::tst(Register rn, const ShifterOperand& so, Condition cond) {
591 CHECK_NE(rn, PC); // Reserve tst pc instruction for exception handler marker.
Vladimir Marko73cf0fb2015-07-30 15:07:22 +0100592 EmitDataProcessing(cond, TST, kCcSet, rn, R0, so);
Dave Allison65fcc2c2014-04-28 13:45:27 -0700593}
594
595
596void Thumb2Assembler::teq(Register rn, const ShifterOperand& so, Condition cond) {
597 CHECK_NE(rn, PC); // Reserve teq pc instruction for exception handler marker.
Vladimir Marko73cf0fb2015-07-30 15:07:22 +0100598 EmitDataProcessing(cond, TEQ, kCcSet, rn, R0, so);
Dave Allison65fcc2c2014-04-28 13:45:27 -0700599}
600
601
602void Thumb2Assembler::cmp(Register rn, const ShifterOperand& so, Condition cond) {
Vladimir Marko73cf0fb2015-07-30 15:07:22 +0100603 EmitDataProcessing(cond, CMP, kCcSet, rn, R0, so);
Dave Allison65fcc2c2014-04-28 13:45:27 -0700604}
605
606
607void Thumb2Assembler::cmn(Register rn, const ShifterOperand& so, Condition cond) {
Vladimir Marko73cf0fb2015-07-30 15:07:22 +0100608 EmitDataProcessing(cond, CMN, kCcSet, rn, R0, so);
Dave Allison65fcc2c2014-04-28 13:45:27 -0700609}
610
611
Vladimir Marko73cf0fb2015-07-30 15:07:22 +0100612void Thumb2Assembler::orr(Register rd, Register rn, const ShifterOperand& so,
613 Condition cond, SetCc set_cc) {
614 EmitDataProcessing(cond, ORR, set_cc, rn, rd, so);
Dave Allison65fcc2c2014-04-28 13:45:27 -0700615}
616
617
Vladimir Markod2b4ca22015-09-14 15:13:26 +0100618void Thumb2Assembler::orn(Register rd, Register rn, const ShifterOperand& so,
619 Condition cond, SetCc set_cc) {
620 EmitDataProcessing(cond, ORN, set_cc, rn, rd, so);
621}
622
623
Vladimir Marko73cf0fb2015-07-30 15:07:22 +0100624void Thumb2Assembler::mov(Register rd, const ShifterOperand& so,
625 Condition cond, SetCc set_cc) {
626 EmitDataProcessing(cond, MOV, set_cc, R0, rd, so);
Dave Allison65fcc2c2014-04-28 13:45:27 -0700627}
628
629
630void Thumb2Assembler::bic(Register rd, Register rn, const ShifterOperand& so,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +0100631 Condition cond, SetCc set_cc) {
632 EmitDataProcessing(cond, BIC, set_cc, rn, rd, so);
Dave Allison65fcc2c2014-04-28 13:45:27 -0700633}
634
635
Vladimir Marko73cf0fb2015-07-30 15:07:22 +0100636void Thumb2Assembler::mvn(Register rd, const ShifterOperand& so,
637 Condition cond, SetCc set_cc) {
638 EmitDataProcessing(cond, MVN, set_cc, R0, rd, so);
Dave Allison65fcc2c2014-04-28 13:45:27 -0700639}
640
641
642void Thumb2Assembler::mul(Register rd, Register rn, Register rm, Condition cond) {
Ian Rogers6a3c1fc2014-10-31 00:33:20 -0700643 CheckCondition(cond);
644
Dave Allison65fcc2c2014-04-28 13:45:27 -0700645 if (rd == rm && !IsHighRegister(rd) && !IsHighRegister(rn) && !force_32bit_) {
646 // 16 bit.
647 int16_t encoding = B14 | B9 | B8 | B6 |
648 rn << 3 | rd;
649 Emit16(encoding);
650 } else {
651 // 32 bit.
Andreas Gampec8ccf682014-09-29 20:07:43 -0700652 uint32_t op1 = 0U /* 0b000 */;
653 uint32_t op2 = 0U /* 0b00 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -0700654 int32_t encoding = B31 | B30 | B29 | B28 | B27 | B25 | B24 |
655 op1 << 20 |
656 B15 | B14 | B13 | B12 |
657 op2 << 4 |
658 static_cast<uint32_t>(rd) << 8 |
659 static_cast<uint32_t>(rn) << 16 |
660 static_cast<uint32_t>(rm);
661
662 Emit32(encoding);
663 }
664}
665
666
667void Thumb2Assembler::mla(Register rd, Register rn, Register rm, Register ra,
668 Condition cond) {
Ian Rogers6a3c1fc2014-10-31 00:33:20 -0700669 CheckCondition(cond);
670
Andreas Gampec8ccf682014-09-29 20:07:43 -0700671 uint32_t op1 = 0U /* 0b000 */;
672 uint32_t op2 = 0U /* 0b00 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -0700673 int32_t encoding = B31 | B30 | B29 | B28 | B27 | B25 | B24 |
674 op1 << 20 |
675 op2 << 4 |
676 static_cast<uint32_t>(rd) << 8 |
677 static_cast<uint32_t>(ra) << 12 |
678 static_cast<uint32_t>(rn) << 16 |
679 static_cast<uint32_t>(rm);
680
681 Emit32(encoding);
682}
683
684
685void Thumb2Assembler::mls(Register rd, Register rn, Register rm, Register ra,
686 Condition cond) {
Ian Rogers6a3c1fc2014-10-31 00:33:20 -0700687 CheckCondition(cond);
688
Andreas Gampec8ccf682014-09-29 20:07:43 -0700689 uint32_t op1 = 0U /* 0b000 */;
690 uint32_t op2 = 01 /* 0b01 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -0700691 int32_t encoding = B31 | B30 | B29 | B28 | B27 | B25 | B24 |
692 op1 << 20 |
693 op2 << 4 |
694 static_cast<uint32_t>(rd) << 8 |
695 static_cast<uint32_t>(ra) << 12 |
696 static_cast<uint32_t>(rn) << 16 |
697 static_cast<uint32_t>(rm);
698
699 Emit32(encoding);
700}
701
702
Zheng Xuc6667102015-05-15 16:08:45 +0800703void Thumb2Assembler::smull(Register rd_lo, Register rd_hi, Register rn,
704 Register rm, Condition cond) {
705 CheckCondition(cond);
706
707 uint32_t op1 = 0U /* 0b000; */;
708 uint32_t op2 = 0U /* 0b0000 */;
709 int32_t encoding = B31 | B30 | B29 | B28 | B27 | B25 | B24 | B23 |
710 op1 << 20 |
711 op2 << 4 |
712 static_cast<uint32_t>(rd_lo) << 12 |
713 static_cast<uint32_t>(rd_hi) << 8 |
714 static_cast<uint32_t>(rn) << 16 |
715 static_cast<uint32_t>(rm);
716
717 Emit32(encoding);
718}
719
720
Dave Allison65fcc2c2014-04-28 13:45:27 -0700721void Thumb2Assembler::umull(Register rd_lo, Register rd_hi, Register rn,
722 Register rm, Condition cond) {
Ian Rogers6a3c1fc2014-10-31 00:33:20 -0700723 CheckCondition(cond);
724
Andreas Gampec8ccf682014-09-29 20:07:43 -0700725 uint32_t op1 = 2U /* 0b010; */;
726 uint32_t op2 = 0U /* 0b0000 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -0700727 int32_t encoding = B31 | B30 | B29 | B28 | B27 | B25 | B24 | B23 |
728 op1 << 20 |
729 op2 << 4 |
730 static_cast<uint32_t>(rd_lo) << 12 |
731 static_cast<uint32_t>(rd_hi) << 8 |
732 static_cast<uint32_t>(rn) << 16 |
733 static_cast<uint32_t>(rm);
734
735 Emit32(encoding);
736}
737
738
739void Thumb2Assembler::sdiv(Register rd, Register rn, Register rm, Condition cond) {
Ian Rogers6a3c1fc2014-10-31 00:33:20 -0700740 CheckCondition(cond);
741
Andreas Gampec8ccf682014-09-29 20:07:43 -0700742 uint32_t op1 = 1U /* 0b001 */;
743 uint32_t op2 = 15U /* 0b1111 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -0700744 int32_t encoding = B31 | B30 | B29 | B28 | B27 | B25 | B24 | B23 | B20 |
745 op1 << 20 |
746 op2 << 4 |
747 0xf << 12 |
748 static_cast<uint32_t>(rd) << 8 |
749 static_cast<uint32_t>(rn) << 16 |
750 static_cast<uint32_t>(rm);
751
752 Emit32(encoding);
753}
754
755
756void Thumb2Assembler::udiv(Register rd, Register rn, Register rm, Condition cond) {
Ian Rogers6a3c1fc2014-10-31 00:33:20 -0700757 CheckCondition(cond);
758
Andreas Gampec8ccf682014-09-29 20:07:43 -0700759 uint32_t op1 = 1U /* 0b001 */;
760 uint32_t op2 = 15U /* 0b1111 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -0700761 int32_t encoding = B31 | B30 | B29 | B28 | B27 | B25 | B24 | B23 | B21 | B20 |
762 op1 << 20 |
763 op2 << 4 |
764 0xf << 12 |
765 static_cast<uint32_t>(rd) << 8 |
766 static_cast<uint32_t>(rn) << 16 |
767 static_cast<uint32_t>(rm);
768
769 Emit32(encoding);
770}
771
772
Roland Levillain51d3fc42014-11-13 14:11:42 +0000773void Thumb2Assembler::sbfx(Register rd, Register rn, uint32_t lsb, uint32_t width, Condition cond) {
774 CheckCondition(cond);
775 CHECK_LE(lsb, 31U);
776 CHECK(1U <= width && width <= 32U) << width;
777 uint32_t widthminus1 = width - 1;
778 uint32_t imm2 = lsb & (B1 | B0); // Bits 0-1 of `lsb`.
779 uint32_t imm3 = (lsb & (B4 | B3 | B2)) >> 2; // Bits 2-4 of `lsb`.
780
781 uint32_t op = 20U /* 0b10100 */;
782 int32_t encoding = B31 | B30 | B29 | B28 | B25 |
783 op << 20 |
784 static_cast<uint32_t>(rn) << 16 |
785 imm3 << 12 |
786 static_cast<uint32_t>(rd) << 8 |
787 imm2 << 6 |
788 widthminus1;
789
790 Emit32(encoding);
791}
792
793
Roland Levillain981e4542014-11-14 11:47:14 +0000794void Thumb2Assembler::ubfx(Register rd, Register rn, uint32_t lsb, uint32_t width, Condition cond) {
795 CheckCondition(cond);
796 CHECK_LE(lsb, 31U);
797 CHECK(1U <= width && width <= 32U) << width;
798 uint32_t widthminus1 = width - 1;
799 uint32_t imm2 = lsb & (B1 | B0); // Bits 0-1 of `lsb`.
800 uint32_t imm3 = (lsb & (B4 | B3 | B2)) >> 2; // Bits 2-4 of `lsb`.
801
802 uint32_t op = 28U /* 0b11100 */;
803 int32_t encoding = B31 | B30 | B29 | B28 | B25 |
804 op << 20 |
805 static_cast<uint32_t>(rn) << 16 |
806 imm3 << 12 |
807 static_cast<uint32_t>(rd) << 8 |
808 imm2 << 6 |
809 widthminus1;
810
811 Emit32(encoding);
812}
813
814
Dave Allison65fcc2c2014-04-28 13:45:27 -0700815void Thumb2Assembler::ldr(Register rd, const Address& ad, Condition cond) {
816 EmitLoadStore(cond, true, false, false, false, rd, ad);
817}
818
819
820void Thumb2Assembler::str(Register rd, const Address& ad, Condition cond) {
821 EmitLoadStore(cond, false, false, false, false, rd, ad);
822}
823
824
825void Thumb2Assembler::ldrb(Register rd, const Address& ad, Condition cond) {
826 EmitLoadStore(cond, true, true, false, false, rd, ad);
827}
828
829
830void Thumb2Assembler::strb(Register rd, const Address& ad, Condition cond) {
831 EmitLoadStore(cond, false, true, false, false, rd, ad);
832}
833
834
835void Thumb2Assembler::ldrh(Register rd, const Address& ad, Condition cond) {
836 EmitLoadStore(cond, true, false, true, false, rd, ad);
837}
838
839
840void Thumb2Assembler::strh(Register rd, const Address& ad, Condition cond) {
841 EmitLoadStore(cond, false, false, true, false, rd, ad);
842}
843
844
845void Thumb2Assembler::ldrsb(Register rd, const Address& ad, Condition cond) {
846 EmitLoadStore(cond, true, true, false, true, rd, ad);
847}
848
849
850void Thumb2Assembler::ldrsh(Register rd, const Address& ad, Condition cond) {
851 EmitLoadStore(cond, true, false, true, true, rd, ad);
852}
853
854
855void Thumb2Assembler::ldrd(Register rd, const Address& ad, Condition cond) {
Roland Levillain4af147e2015-04-07 13:54:49 +0100856 ldrd(rd, Register(rd + 1), ad, cond);
857}
858
859
860void Thumb2Assembler::ldrd(Register rd, Register rd2, const Address& ad, Condition cond) {
Ian Rogers6a3c1fc2014-10-31 00:33:20 -0700861 CheckCondition(cond);
Roland Levillain4af147e2015-04-07 13:54:49 +0100862 // Encoding T1.
Dave Allison65fcc2c2014-04-28 13:45:27 -0700863 // This is different from other loads. The encoding is like ARM.
864 int32_t encoding = B31 | B30 | B29 | B27 | B22 | B20 |
865 static_cast<int32_t>(rd) << 12 |
Roland Levillain4af147e2015-04-07 13:54:49 +0100866 static_cast<int32_t>(rd2) << 8 |
Dave Allison65fcc2c2014-04-28 13:45:27 -0700867 ad.encodingThumbLdrdStrd();
868 Emit32(encoding);
869}
870
871
872void Thumb2Assembler::strd(Register rd, const Address& ad, Condition cond) {
Roland Levillain4af147e2015-04-07 13:54:49 +0100873 strd(rd, Register(rd + 1), ad, cond);
874}
875
876
877void Thumb2Assembler::strd(Register rd, Register rd2, const Address& ad, Condition cond) {
Ian Rogers6a3c1fc2014-10-31 00:33:20 -0700878 CheckCondition(cond);
Roland Levillain4af147e2015-04-07 13:54:49 +0100879 // Encoding T1.
Dave Allison65fcc2c2014-04-28 13:45:27 -0700880 // This is different from other loads. The encoding is like ARM.
881 int32_t encoding = B31 | B30 | B29 | B27 | B22 |
882 static_cast<int32_t>(rd) << 12 |
Roland Levillain4af147e2015-04-07 13:54:49 +0100883 static_cast<int32_t>(rd2) << 8 |
Dave Allison65fcc2c2014-04-28 13:45:27 -0700884 ad.encodingThumbLdrdStrd();
885 Emit32(encoding);
886}
887
888
889void Thumb2Assembler::ldm(BlockAddressMode am,
890 Register base,
891 RegList regs,
892 Condition cond) {
Vladimir Markoe8469c12014-11-26 18:09:30 +0000893 CHECK_NE(regs, 0u); // Do not use ldm if there's nothing to load.
894 if (IsPowerOfTwo(regs)) {
Dave Allison65fcc2c2014-04-28 13:45:27 -0700895 // Thumb doesn't support one reg in the list.
896 // Find the register number.
Vladimir Markoe8469c12014-11-26 18:09:30 +0000897 int reg = CTZ(static_cast<uint32_t>(regs));
Dave Allison65fcc2c2014-04-28 13:45:27 -0700898 CHECK_LT(reg, 16);
Dave Allison45fdb932014-06-25 12:37:10 -0700899 CHECK(am == DB_W); // Only writeback is supported.
Dave Allison65fcc2c2014-04-28 13:45:27 -0700900 ldr(static_cast<Register>(reg), Address(base, kRegisterSize, Address::PostIndex), cond);
901 } else {
902 EmitMultiMemOp(cond, am, true, base, regs);
903 }
904}
905
906
907void Thumb2Assembler::stm(BlockAddressMode am,
908 Register base,
909 RegList regs,
910 Condition cond) {
Vladimir Markoe8469c12014-11-26 18:09:30 +0000911 CHECK_NE(regs, 0u); // Do not use stm if there's nothing to store.
912 if (IsPowerOfTwo(regs)) {
Dave Allison65fcc2c2014-04-28 13:45:27 -0700913 // Thumb doesn't support one reg in the list.
914 // Find the register number.
Vladimir Markoe8469c12014-11-26 18:09:30 +0000915 int reg = CTZ(static_cast<uint32_t>(regs));
Dave Allison65fcc2c2014-04-28 13:45:27 -0700916 CHECK_LT(reg, 16);
Dave Allison45fdb932014-06-25 12:37:10 -0700917 CHECK(am == IA || am == IA_W);
918 Address::Mode strmode = am == IA ? Address::PreIndex : Address::Offset;
Dave Allison65fcc2c2014-04-28 13:45:27 -0700919 str(static_cast<Register>(reg), Address(base, -kRegisterSize, strmode), cond);
920 } else {
921 EmitMultiMemOp(cond, am, false, base, regs);
922 }
923}
924
925
926bool Thumb2Assembler::vmovs(SRegister sd, float s_imm, Condition cond) {
927 uint32_t imm32 = bit_cast<uint32_t, float>(s_imm);
928 if (((imm32 & ((1 << 19) - 1)) == 0) &&
929 ((((imm32 >> 25) & ((1 << 6) - 1)) == (1 << 5)) ||
930 (((imm32 >> 25) & ((1 << 6) - 1)) == ((1 << 5) -1)))) {
931 uint8_t imm8 = ((imm32 >> 31) << 7) | (((imm32 >> 29) & 1) << 6) |
932 ((imm32 >> 19) & ((1 << 6) -1));
933 EmitVFPsss(cond, B23 | B21 | B20 | ((imm8 >> 4)*B16) | (imm8 & 0xf),
934 sd, S0, S0);
935 return true;
936 }
937 return false;
938}
939
940
941bool Thumb2Assembler::vmovd(DRegister dd, double d_imm, Condition cond) {
942 uint64_t imm64 = bit_cast<uint64_t, double>(d_imm);
943 if (((imm64 & ((1LL << 48) - 1)) == 0) &&
944 ((((imm64 >> 54) & ((1 << 9) - 1)) == (1 << 8)) ||
945 (((imm64 >> 54) & ((1 << 9) - 1)) == ((1 << 8) -1)))) {
946 uint8_t imm8 = ((imm64 >> 63) << 7) | (((imm64 >> 61) & 1) << 6) |
947 ((imm64 >> 48) & ((1 << 6) -1));
948 EmitVFPddd(cond, B23 | B21 | B20 | ((imm8 >> 4)*B16) | B8 | (imm8 & 0xf),
949 dd, D0, D0);
950 return true;
951 }
952 return false;
953}
954
955
956void Thumb2Assembler::vmovs(SRegister sd, SRegister sm, Condition cond) {
957 EmitVFPsss(cond, B23 | B21 | B20 | B6, sd, S0, sm);
958}
959
960
961void Thumb2Assembler::vmovd(DRegister dd, DRegister dm, Condition cond) {
962 EmitVFPddd(cond, B23 | B21 | B20 | B6, dd, D0, dm);
963}
964
965
966void Thumb2Assembler::vadds(SRegister sd, SRegister sn, SRegister sm,
967 Condition cond) {
968 EmitVFPsss(cond, B21 | B20, sd, sn, sm);
969}
970
971
972void Thumb2Assembler::vaddd(DRegister dd, DRegister dn, DRegister dm,
973 Condition cond) {
974 EmitVFPddd(cond, B21 | B20, dd, dn, dm);
975}
976
977
978void Thumb2Assembler::vsubs(SRegister sd, SRegister sn, SRegister sm,
979 Condition cond) {
980 EmitVFPsss(cond, B21 | B20 | B6, sd, sn, sm);
981}
982
983
984void Thumb2Assembler::vsubd(DRegister dd, DRegister dn, DRegister dm,
985 Condition cond) {
986 EmitVFPddd(cond, B21 | B20 | B6, dd, dn, dm);
987}
988
989
990void Thumb2Assembler::vmuls(SRegister sd, SRegister sn, SRegister sm,
991 Condition cond) {
992 EmitVFPsss(cond, B21, sd, sn, sm);
993}
994
995
996void Thumb2Assembler::vmuld(DRegister dd, DRegister dn, DRegister dm,
997 Condition cond) {
998 EmitVFPddd(cond, B21, dd, dn, dm);
999}
1000
1001
1002void Thumb2Assembler::vmlas(SRegister sd, SRegister sn, SRegister sm,
1003 Condition cond) {
1004 EmitVFPsss(cond, 0, sd, sn, sm);
1005}
1006
1007
1008void Thumb2Assembler::vmlad(DRegister dd, DRegister dn, DRegister dm,
1009 Condition cond) {
1010 EmitVFPddd(cond, 0, dd, dn, dm);
1011}
1012
1013
1014void Thumb2Assembler::vmlss(SRegister sd, SRegister sn, SRegister sm,
1015 Condition cond) {
1016 EmitVFPsss(cond, B6, sd, sn, sm);
1017}
1018
1019
1020void Thumb2Assembler::vmlsd(DRegister dd, DRegister dn, DRegister dm,
1021 Condition cond) {
1022 EmitVFPddd(cond, B6, dd, dn, dm);
1023}
1024
1025
1026void Thumb2Assembler::vdivs(SRegister sd, SRegister sn, SRegister sm,
1027 Condition cond) {
1028 EmitVFPsss(cond, B23, sd, sn, sm);
1029}
1030
1031
1032void Thumb2Assembler::vdivd(DRegister dd, DRegister dn, DRegister dm,
1033 Condition cond) {
1034 EmitVFPddd(cond, B23, dd, dn, dm);
1035}
1036
1037
1038void Thumb2Assembler::vabss(SRegister sd, SRegister sm, Condition cond) {
1039 EmitVFPsss(cond, B23 | B21 | B20 | B7 | B6, sd, S0, sm);
1040}
1041
1042
1043void Thumb2Assembler::vabsd(DRegister dd, DRegister dm, Condition cond) {
1044 EmitVFPddd(cond, B23 | B21 | B20 | B7 | B6, dd, D0, dm);
1045}
1046
1047
1048void Thumb2Assembler::vnegs(SRegister sd, SRegister sm, Condition cond) {
1049 EmitVFPsss(cond, B23 | B21 | B20 | B16 | B6, sd, S0, sm);
1050}
1051
1052
1053void Thumb2Assembler::vnegd(DRegister dd, DRegister dm, Condition cond) {
1054 EmitVFPddd(cond, B23 | B21 | B20 | B16 | B6, dd, D0, dm);
1055}
1056
1057
1058void Thumb2Assembler::vsqrts(SRegister sd, SRegister sm, Condition cond) {
1059 EmitVFPsss(cond, B23 | B21 | B20 | B16 | B7 | B6, sd, S0, sm);
1060}
1061
1062void Thumb2Assembler::vsqrtd(DRegister dd, DRegister dm, Condition cond) {
1063 EmitVFPddd(cond, B23 | B21 | B20 | B16 | B7 | B6, dd, D0, dm);
1064}
1065
1066
1067void Thumb2Assembler::vcvtsd(SRegister sd, DRegister dm, Condition cond) {
1068 EmitVFPsd(cond, B23 | B21 | B20 | B18 | B17 | B16 | B8 | B7 | B6, sd, dm);
1069}
1070
1071
1072void Thumb2Assembler::vcvtds(DRegister dd, SRegister sm, Condition cond) {
1073 EmitVFPds(cond, B23 | B21 | B20 | B18 | B17 | B16 | B7 | B6, dd, sm);
1074}
1075
1076
1077void Thumb2Assembler::vcvtis(SRegister sd, SRegister sm, Condition cond) {
1078 EmitVFPsss(cond, B23 | B21 | B20 | B19 | B18 | B16 | B7 | B6, sd, S0, sm);
1079}
1080
1081
1082void Thumb2Assembler::vcvtid(SRegister sd, DRegister dm, Condition cond) {
1083 EmitVFPsd(cond, B23 | B21 | B20 | B19 | B18 | B16 | B8 | B7 | B6, sd, dm);
1084}
1085
1086
1087void Thumb2Assembler::vcvtsi(SRegister sd, SRegister sm, Condition cond) {
1088 EmitVFPsss(cond, B23 | B21 | B20 | B19 | B7 | B6, sd, S0, sm);
1089}
1090
1091
1092void Thumb2Assembler::vcvtdi(DRegister dd, SRegister sm, Condition cond) {
1093 EmitVFPds(cond, B23 | B21 | B20 | B19 | B8 | B7 | B6, dd, sm);
1094}
1095
1096
1097void Thumb2Assembler::vcvtus(SRegister sd, SRegister sm, Condition cond) {
1098 EmitVFPsss(cond, B23 | B21 | B20 | B19 | B18 | B7 | B6, sd, S0, sm);
1099}
1100
1101
1102void Thumb2Assembler::vcvtud(SRegister sd, DRegister dm, Condition cond) {
1103 EmitVFPsd(cond, B23 | B21 | B20 | B19 | B18 | B8 | B7 | B6, sd, dm);
1104}
1105
1106
1107void Thumb2Assembler::vcvtsu(SRegister sd, SRegister sm, Condition cond) {
1108 EmitVFPsss(cond, B23 | B21 | B20 | B19 | B6, sd, S0, sm);
1109}
1110
1111
1112void Thumb2Assembler::vcvtdu(DRegister dd, SRegister sm, Condition cond) {
1113 EmitVFPds(cond, B23 | B21 | B20 | B19 | B8 | B6, dd, sm);
1114}
1115
1116
1117void Thumb2Assembler::vcmps(SRegister sd, SRegister sm, Condition cond) {
1118 EmitVFPsss(cond, B23 | B21 | B20 | B18 | B6, sd, S0, sm);
1119}
1120
1121
1122void Thumb2Assembler::vcmpd(DRegister dd, DRegister dm, Condition cond) {
1123 EmitVFPddd(cond, B23 | B21 | B20 | B18 | B6, dd, D0, dm);
1124}
1125
1126
1127void Thumb2Assembler::vcmpsz(SRegister sd, Condition cond) {
1128 EmitVFPsss(cond, B23 | B21 | B20 | B18 | B16 | B6, sd, S0, S0);
1129}
1130
1131
1132void Thumb2Assembler::vcmpdz(DRegister dd, Condition cond) {
1133 EmitVFPddd(cond, B23 | B21 | B20 | B18 | B16 | B6, dd, D0, D0);
1134}
1135
1136void Thumb2Assembler::b(Label* label, Condition cond) {
agicsakie2142d252015-06-30 17:10:03 -07001137 DCHECK_EQ(next_condition_, AL);
Dave Allison65fcc2c2014-04-28 13:45:27 -07001138 EmitBranch(cond, label, false, false);
1139}
1140
1141
1142void Thumb2Assembler::bl(Label* label, Condition cond) {
1143 CheckCondition(cond);
1144 EmitBranch(cond, label, true, false);
1145}
1146
1147
1148void Thumb2Assembler::blx(Label* label) {
1149 EmitBranch(AL, label, true, true);
1150}
1151
1152
1153void Thumb2Assembler::MarkExceptionHandler(Label* label) {
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001154 EmitDataProcessing(AL, TST, kCcSet, PC, R0, ShifterOperand(0));
Dave Allison65fcc2c2014-04-28 13:45:27 -07001155 Label l;
1156 b(&l);
1157 EmitBranch(AL, label, false, false);
1158 Bind(&l);
1159}
1160
1161
1162void Thumb2Assembler::Emit32(int32_t value) {
1163 AssemblerBuffer::EnsureCapacity ensured(&buffer_);
1164 buffer_.Emit<int16_t>(value >> 16);
1165 buffer_.Emit<int16_t>(value & 0xffff);
1166}
1167
1168
1169void Thumb2Assembler::Emit16(int16_t value) {
1170 AssemblerBuffer::EnsureCapacity ensured(&buffer_);
1171 buffer_.Emit<int16_t>(value);
1172}
1173
1174
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001175bool Thumb2Assembler::Is32BitDataProcessing(Condition cond,
Dave Allison65fcc2c2014-04-28 13:45:27 -07001176 Opcode opcode,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001177 SetCc set_cc,
Dave Allison65fcc2c2014-04-28 13:45:27 -07001178 Register rn,
1179 Register rd,
1180 const ShifterOperand& so) {
1181 if (force_32bit_) {
1182 return true;
1183 }
1184
Vladimir Marko5bc561c2014-12-16 17:41:59 +00001185 // Check special case for SP relative ADD and SUB immediate.
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001186 if ((opcode == ADD || opcode == SUB) && rn == SP && so.IsImmediate() && set_cc != kCcSet) {
Vladimir Marko5bc561c2014-12-16 17:41:59 +00001187 // If the immediate is in range, use 16 bit.
1188 if (rd == SP) {
1189 if (so.GetImmediate() < (1 << 9)) { // 9 bit immediate.
1190 return false;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001191 }
Vladimir Marko5bc561c2014-12-16 17:41:59 +00001192 } else if (!IsHighRegister(rd) && opcode == ADD) {
1193 if (so.GetImmediate() < (1 << 10)) { // 10 bit immediate.
1194 return false;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001195 }
1196 }
Vladimir Marko5bc561c2014-12-16 17:41:59 +00001197 }
Dave Allison65fcc2c2014-04-28 13:45:27 -07001198
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001199 bool can_contain_high_register =
1200 (opcode == CMP) ||
1201 (opcode == MOV && set_cc != kCcSet) ||
1202 ((opcode == ADD) && (rn == rd) && set_cc != kCcSet);
Vladimir Marko5bc561c2014-12-16 17:41:59 +00001203
1204 if (IsHighRegister(rd) || IsHighRegister(rn)) {
1205 if (!can_contain_high_register) {
Dave Allison65fcc2c2014-04-28 13:45:27 -07001206 return true;
1207 }
Nicolas Geoffray3c7bb982014-07-23 16:04:16 +01001208
Vladimir Marko5bc561c2014-12-16 17:41:59 +00001209 // There are high register instructions available for this opcode.
1210 // However, there is no actual shift available, neither for ADD nor for MOV (ASR/LSR/LSL/ROR).
1211 if (so.IsShift() && (so.GetShift() == RRX || so.GetImmediate() != 0u)) {
1212 return true;
1213 }
1214
1215 // The ADD and MOV instructions that work with high registers don't have 16-bit
1216 // immediate variants.
1217 if (so.IsImmediate()) {
Nicolas Geoffray3c7bb982014-07-23 16:04:16 +01001218 return true;
1219 }
Dave Allison65fcc2c2014-04-28 13:45:27 -07001220 }
1221
1222 if (so.IsRegister() && IsHighRegister(so.GetRegister()) && !can_contain_high_register) {
1223 return true;
1224 }
1225
Dave Allison65fcc2c2014-04-28 13:45:27 -07001226 bool rn_is_valid = true;
1227
1228 // Check for single operand instructions and ADD/SUB.
1229 switch (opcode) {
1230 case CMP:
1231 case MOV:
1232 case TST:
1233 case MVN:
1234 rn_is_valid = false; // There is no Rn for these instructions.
1235 break;
1236 case TEQ:
Vladimir Markod2b4ca22015-09-14 15:13:26 +01001237 case ORN:
Dave Allison65fcc2c2014-04-28 13:45:27 -07001238 return true;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001239 case ADD:
1240 case SUB:
1241 break;
1242 default:
1243 if (so.IsRegister() && rd != rn) {
1244 return true;
1245 }
1246 }
1247
1248 if (so.IsImmediate()) {
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001249 if (opcode == RSB) {
1250 DCHECK(rn_is_valid);
1251 if (so.GetImmediate() != 0u) {
Dave Allison65fcc2c2014-04-28 13:45:27 -07001252 return true;
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001253 }
1254 } else if (rn_is_valid && rn != rd) {
1255 // The only thumb1 instructions with a register and an immediate are ADD and SUB
1256 // with a 3-bit immediate, and RSB with zero immediate.
1257 if (opcode == ADD || opcode == SUB) {
Vladimir Markof5c09c32015-12-17 12:08:08 +00001258 if ((cond == AL) ? set_cc == kCcKeep : set_cc == kCcSet) {
1259 return true; // Cannot match "setflags".
1260 }
1261 if (!IsUint<3>(so.GetImmediate()) && !IsUint<3>(-so.GetImmediate())) {
Dave Allison65fcc2c2014-04-28 13:45:27 -07001262 return true;
1263 }
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001264 } else {
1265 return true;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001266 }
1267 } else {
1268 // ADD, SUB, CMP and MOV may be thumb1 only if the immediate is 8 bits.
1269 if (!(opcode == ADD || opcode == SUB || opcode == MOV || opcode == CMP)) {
1270 return true;
Vladimir Markof5c09c32015-12-17 12:08:08 +00001271 } else if (opcode != CMP && ((cond == AL) ? set_cc == kCcKeep : set_cc == kCcSet)) {
1272 return true; // Cannot match "setflags" for ADD, SUB or MOV.
Dave Allison65fcc2c2014-04-28 13:45:27 -07001273 } else {
Vladimir Markof5c09c32015-12-17 12:08:08 +00001274 // For ADD and SUB allow also negative 8-bit immediate as we will emit the oposite opcode.
1275 if (!IsUint<8>(so.GetImmediate()) &&
1276 (opcode == MOV || opcode == CMP || !IsUint<8>(-so.GetImmediate()))) {
Dave Allison65fcc2c2014-04-28 13:45:27 -07001277 return true;
1278 }
1279 }
1280 }
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001281 } else {
1282 DCHECK(so.IsRegister());
1283 if (so.IsShift()) {
1284 // Shift operand - check if it is a MOV convertible to a 16-bit shift instruction.
1285 if (opcode != MOV) {
Zheng Xuc6667102015-05-15 16:08:45 +08001286 return true;
1287 }
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001288 // Check for MOV with an ROR/RRX. There is no 16-bit ROR immediate and no 16-bit RRX.
1289 if (so.GetShift() == ROR || so.GetShift() == RRX) {
1290 return true;
1291 }
1292 // 16-bit shifts set condition codes if and only if outside IT block,
1293 // i.e. if and only if cond == AL.
1294 if ((cond == AL) ? set_cc == kCcKeep : set_cc == kCcSet) {
1295 return true;
1296 }
1297 } else {
1298 // Register operand without shift.
1299 switch (opcode) {
1300 case ADD:
1301 // The 16-bit ADD that cannot contain high registers can set condition codes
1302 // if and only if outside IT block, i.e. if and only if cond == AL.
1303 if (!can_contain_high_register &&
1304 ((cond == AL) ? set_cc == kCcKeep : set_cc == kCcSet)) {
1305 return true;
1306 }
1307 break;
1308 case AND:
1309 case BIC:
1310 case EOR:
1311 case ORR:
1312 case MVN:
1313 case ADC:
1314 case SUB:
1315 case SBC:
1316 // These 16-bit opcodes set condition codes if and only if outside IT block,
1317 // i.e. if and only if cond == AL.
1318 if ((cond == AL) ? set_cc == kCcKeep : set_cc == kCcSet) {
1319 return true;
1320 }
1321 break;
1322 case RSB:
1323 case RSC:
1324 // No 16-bit RSB/RSC Rd, Rm, Rn. It would be equivalent to SUB/SBC Rd, Rn, Rm.
1325 return true;
1326 case CMP:
1327 default:
1328 break;
1329 }
Zheng Xuc6667102015-05-15 16:08:45 +08001330 }
1331 }
1332
Dave Allison65fcc2c2014-04-28 13:45:27 -07001333 // The instruction can be encoded in 16 bits.
1334 return false;
1335}
1336
1337
Ian Rogers6a3c1fc2014-10-31 00:33:20 -07001338void Thumb2Assembler::Emit32BitDataProcessing(Condition cond ATTRIBUTE_UNUSED,
Dave Allison65fcc2c2014-04-28 13:45:27 -07001339 Opcode opcode,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001340 SetCc set_cc,
Dave Allison65fcc2c2014-04-28 13:45:27 -07001341 Register rn,
1342 Register rd,
1343 const ShifterOperand& so) {
Andreas Gampec8ccf682014-09-29 20:07:43 -07001344 uint8_t thumb_opcode = 255U /* 0b11111111 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001345 switch (opcode) {
Andreas Gampec8ccf682014-09-29 20:07:43 -07001346 case AND: thumb_opcode = 0U /* 0b0000 */; break;
1347 case EOR: thumb_opcode = 4U /* 0b0100 */; break;
1348 case SUB: thumb_opcode = 13U /* 0b1101 */; break;
1349 case RSB: thumb_opcode = 14U /* 0b1110 */; break;
1350 case ADD: thumb_opcode = 8U /* 0b1000 */; break;
Andreas Gampe35c68e32014-09-30 08:39:37 -07001351 case ADC: thumb_opcode = 10U /* 0b1010 */; break;
Andreas Gampec8ccf682014-09-29 20:07:43 -07001352 case SBC: thumb_opcode = 11U /* 0b1011 */; break;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001353 case RSC: break;
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001354 case TST: thumb_opcode = 0U /* 0b0000 */; DCHECK(set_cc == kCcSet); rd = PC; break;
1355 case TEQ: thumb_opcode = 4U /* 0b0100 */; DCHECK(set_cc == kCcSet); rd = PC; break;
1356 case CMP: thumb_opcode = 13U /* 0b1101 */; DCHECK(set_cc == kCcSet); rd = PC; break;
1357 case CMN: thumb_opcode = 8U /* 0b1000 */; DCHECK(set_cc == kCcSet); rd = PC; break;
Andreas Gampec8ccf682014-09-29 20:07:43 -07001358 case ORR: thumb_opcode = 2U /* 0b0010 */; break;
1359 case MOV: thumb_opcode = 2U /* 0b0010 */; rn = PC; break;
1360 case BIC: thumb_opcode = 1U /* 0b0001 */; break;
1361 case MVN: thumb_opcode = 3U /* 0b0011 */; rn = PC; break;
Vladimir Markod2b4ca22015-09-14 15:13:26 +01001362 case ORN: thumb_opcode = 3U /* 0b0011 */; break;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001363 default:
1364 break;
1365 }
1366
Andreas Gampec8ccf682014-09-29 20:07:43 -07001367 if (thumb_opcode == 255U /* 0b11111111 */) {
Dave Allison65fcc2c2014-04-28 13:45:27 -07001368 LOG(FATAL) << "Invalid thumb2 opcode " << opcode;
Vladimir Markoe8469c12014-11-26 18:09:30 +00001369 UNREACHABLE();
Dave Allison65fcc2c2014-04-28 13:45:27 -07001370 }
1371
1372 int32_t encoding = 0;
1373 if (so.IsImmediate()) {
1374 // Check special cases.
Vladimir Marko6fd0ffe2015-11-19 21:13:52 +00001375 if ((opcode == SUB || opcode == ADD) && (so.GetImmediate() < (1u << 12)) &&
1376 /* Prefer T3 encoding to T4. */ !ShifterOperandCanAlwaysHold(so.GetImmediate())) {
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001377 if (set_cc != kCcSet) {
Guillaume "Vermeille" Sanchezdc62c482015-03-11 14:30:31 +00001378 if (opcode == SUB) {
1379 thumb_opcode = 5U;
1380 } else if (opcode == ADD) {
1381 thumb_opcode = 0U;
1382 }
Dave Allison65fcc2c2014-04-28 13:45:27 -07001383 }
1384 uint32_t imm = so.GetImmediate();
Dave Allison65fcc2c2014-04-28 13:45:27 -07001385
1386 uint32_t i = (imm >> 11) & 1;
Andreas Gampec8ccf682014-09-29 20:07:43 -07001387 uint32_t imm3 = (imm >> 8) & 7U /* 0b111 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001388 uint32_t imm8 = imm & 0xff;
1389
Guillaume "Vermeille" Sanchezdc62c482015-03-11 14:30:31 +00001390 encoding = B31 | B30 | B29 | B28 |
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001391 (set_cc == kCcSet ? B20 : B25) |
Guillaume "Vermeille" Sanchezdc62c482015-03-11 14:30:31 +00001392 thumb_opcode << 21 |
1393 rn << 16 |
1394 rd << 8 |
1395 i << 26 |
1396 imm3 << 12 |
1397 imm8;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001398 } else {
1399 // Modified immediate.
Dave Allison45fdb932014-06-25 12:37:10 -07001400 uint32_t imm = ModifiedImmediate(so.encodingThumb());
Dave Allison65fcc2c2014-04-28 13:45:27 -07001401 if (imm == kInvalidModifiedImmediate) {
1402 LOG(FATAL) << "Immediate value cannot fit in thumb2 modified immediate";
Vladimir Markoe8469c12014-11-26 18:09:30 +00001403 UNREACHABLE();
Dave Allison65fcc2c2014-04-28 13:45:27 -07001404 }
1405 encoding = B31 | B30 | B29 | B28 |
1406 thumb_opcode << 21 |
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001407 (set_cc == kCcSet ? B20 : 0) |
Dave Allison65fcc2c2014-04-28 13:45:27 -07001408 rn << 16 |
1409 rd << 8 |
1410 imm;
1411 }
1412 } else if (so.IsRegister()) {
Guillaume "Vermeille" Sanchezdc62c482015-03-11 14:30:31 +00001413 // Register (possibly shifted)
1414 encoding = B31 | B30 | B29 | B27 | B25 |
1415 thumb_opcode << 21 |
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001416 (set_cc == kCcSet ? B20 : 0) |
Guillaume "Vermeille" Sanchezdc62c482015-03-11 14:30:31 +00001417 rn << 16 |
1418 rd << 8 |
1419 so.encodingThumb();
Dave Allison65fcc2c2014-04-28 13:45:27 -07001420 }
1421 Emit32(encoding);
1422}
1423
1424
1425void Thumb2Assembler::Emit16BitDataProcessing(Condition cond,
1426 Opcode opcode,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001427 SetCc set_cc,
Dave Allison65fcc2c2014-04-28 13:45:27 -07001428 Register rn,
1429 Register rd,
1430 const ShifterOperand& so) {
1431 if (opcode == ADD || opcode == SUB) {
1432 Emit16BitAddSub(cond, opcode, set_cc, rn, rd, so);
1433 return;
1434 }
Andreas Gampec8ccf682014-09-29 20:07:43 -07001435 uint8_t thumb_opcode = 255U /* 0b11111111 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001436 // Thumb1.
Andreas Gampec8ccf682014-09-29 20:07:43 -07001437 uint8_t dp_opcode = 1U /* 0b01 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001438 uint8_t opcode_shift = 6;
1439 uint8_t rd_shift = 0;
1440 uint8_t rn_shift = 3;
1441 uint8_t immediate_shift = 0;
1442 bool use_immediate = false;
1443 uint8_t immediate = 0;
1444
1445 if (opcode == MOV && so.IsRegister() && so.IsShift()) {
1446 // Convert shifted mov operand2 into 16 bit opcodes.
1447 dp_opcode = 0;
1448 opcode_shift = 11;
1449
1450 use_immediate = true;
1451 immediate = so.GetImmediate();
1452 immediate_shift = 6;
1453
1454 rn = so.GetRegister();
1455
1456 switch (so.GetShift()) {
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001457 case LSL:
1458 DCHECK_LE(immediate, 31u);
1459 thumb_opcode = 0U /* 0b00 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001460 break;
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001461 case LSR:
1462 DCHECK(1 <= immediate && immediate <= 32);
1463 immediate &= 31; // 32 is encoded as 0.
1464 thumb_opcode = 1U /* 0b01 */;
1465 break;
1466 case ASR:
1467 DCHECK(1 <= immediate && immediate <= 32);
1468 immediate &= 31; // 32 is encoded as 0.
1469 thumb_opcode = 2U /* 0b10 */;
1470 break;
1471 case ROR: // No 16-bit ROR immediate.
1472 case RRX: // No 16-bit RRX.
Dave Allison65fcc2c2014-04-28 13:45:27 -07001473 default:
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001474 LOG(FATAL) << "Unexpected shift: " << so.GetShift();
1475 UNREACHABLE();
Dave Allison65fcc2c2014-04-28 13:45:27 -07001476 }
1477 } else {
1478 if (so.IsImmediate()) {
1479 use_immediate = true;
1480 immediate = so.GetImmediate();
Andreas Gampe513ea0c2015-02-02 13:17:52 -08001481 } else {
Guillaume "Vermeille" Sanchezab4a2f52015-03-11 14:00:30 +00001482 CHECK(!(so.IsRegister() && so.IsShift() && so.GetSecondRegister() != kNoRegister))
1483 << "No register-shifted register instruction available in thumb";
Andreas Gampe513ea0c2015-02-02 13:17:52 -08001484 // Adjust rn and rd: only two registers will be emitted.
1485 switch (opcode) {
1486 case AND:
1487 case ORR:
1488 case EOR:
1489 case RSB:
1490 case ADC:
1491 case SBC:
1492 case BIC: {
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001493 // Sets condition codes if and only if outside IT block,
1494 // check that it complies with set_cc.
1495 DCHECK((cond == AL) ? set_cc != kCcKeep : set_cc != kCcSet);
Andreas Gampe513ea0c2015-02-02 13:17:52 -08001496 if (rn == rd) {
1497 rn = so.GetRegister();
1498 } else {
1499 CHECK_EQ(rd, so.GetRegister());
1500 }
1501 break;
1502 }
1503 case CMP:
1504 case CMN: {
1505 CHECK_EQ(rd, 0);
1506 rd = rn;
1507 rn = so.GetRegister();
1508 break;
1509 }
1510 case MVN: {
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001511 // Sets condition codes if and only if outside IT block,
1512 // check that it complies with set_cc.
1513 DCHECK((cond == AL) ? set_cc != kCcKeep : set_cc != kCcSet);
1514 CHECK_EQ(rn, 0);
1515 rn = so.GetRegister();
1516 break;
1517 }
1518 case TST:
1519 case TEQ: {
1520 DCHECK(set_cc == kCcSet);
Andreas Gampe513ea0c2015-02-02 13:17:52 -08001521 CHECK_EQ(rn, 0);
1522 rn = so.GetRegister();
1523 break;
1524 }
1525 default:
1526 break;
1527 }
Dave Allison65fcc2c2014-04-28 13:45:27 -07001528 }
1529
1530 switch (opcode) {
Andreas Gampec8ccf682014-09-29 20:07:43 -07001531 case AND: thumb_opcode = 0U /* 0b0000 */; break;
Andreas Gampe513ea0c2015-02-02 13:17:52 -08001532 case ORR: thumb_opcode = 12U /* 0b1100 */; break;
Andreas Gampec8ccf682014-09-29 20:07:43 -07001533 case EOR: thumb_opcode = 1U /* 0b0001 */; break;
Andreas Gampec8ccf682014-09-29 20:07:43 -07001534 case RSB: thumb_opcode = 9U /* 0b1001 */; break;
Andreas Gampec8ccf682014-09-29 20:07:43 -07001535 case ADC: thumb_opcode = 5U /* 0b0101 */; break;
1536 case SBC: thumb_opcode = 6U /* 0b0110 */; break;
Andreas Gampe513ea0c2015-02-02 13:17:52 -08001537 case BIC: thumb_opcode = 14U /* 0b1110 */; break;
1538 case TST: thumb_opcode = 8U /* 0b1000 */; CHECK(!use_immediate); break;
1539 case MVN: thumb_opcode = 15U /* 0b1111 */; CHECK(!use_immediate); break;
1540 case CMP: {
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001541 DCHECK(set_cc == kCcSet);
Dave Allison65fcc2c2014-04-28 13:45:27 -07001542 if (use_immediate) {
1543 // T2 encoding.
Andreas Gampe513ea0c2015-02-02 13:17:52 -08001544 dp_opcode = 0;
1545 opcode_shift = 11;
1546 thumb_opcode = 5U /* 0b101 */;
1547 rd_shift = 8;
1548 rn_shift = 8;
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001549 } else if (IsHighRegister(rd) || IsHighRegister(rn)) {
1550 // Special cmp for high registers.
1551 dp_opcode = 1U /* 0b01 */;
1552 opcode_shift = 7;
1553 // Put the top bit of rd into the bottom bit of the opcode.
1554 thumb_opcode = 10U /* 0b0001010 */ | static_cast<uint32_t>(rd) >> 3;
1555 rd = static_cast<Register>(static_cast<uint32_t>(rd) & 7U /* 0b111 */);
Dave Allison65fcc2c2014-04-28 13:45:27 -07001556 } else {
Andreas Gampec8ccf682014-09-29 20:07:43 -07001557 thumb_opcode = 10U /* 0b1010 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001558 }
1559
1560 break;
Andreas Gampe513ea0c2015-02-02 13:17:52 -08001561 }
Nicolas Geoffray96f89a22014-07-11 10:57:49 +01001562 case CMN: {
Andreas Gampe513ea0c2015-02-02 13:17:52 -08001563 CHECK(!use_immediate);
Andreas Gampec8ccf682014-09-29 20:07:43 -07001564 thumb_opcode = 11U /* 0b1011 */;
Nicolas Geoffray96f89a22014-07-11 10:57:49 +01001565 break;
1566 }
Dave Allison65fcc2c2014-04-28 13:45:27 -07001567 case MOV:
1568 dp_opcode = 0;
1569 if (use_immediate) {
1570 // T2 encoding.
1571 opcode_shift = 11;
Andreas Gampec8ccf682014-09-29 20:07:43 -07001572 thumb_opcode = 4U /* 0b100 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001573 rd_shift = 8;
1574 rn_shift = 8;
1575 } else {
1576 rn = so.GetRegister();
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001577 if (set_cc != kCcSet) {
Dave Allison65fcc2c2014-04-28 13:45:27 -07001578 // Special mov for high registers.
Andreas Gampec8ccf682014-09-29 20:07:43 -07001579 dp_opcode = 1U /* 0b01 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001580 opcode_shift = 7;
1581 // Put the top bit of rd into the bottom bit of the opcode.
Andreas Gampec8ccf682014-09-29 20:07:43 -07001582 thumb_opcode = 12U /* 0b0001100 */ | static_cast<uint32_t>(rd) >> 3;
1583 rd = static_cast<Register>(static_cast<uint32_t>(rd) & 7U /* 0b111 */);
Dave Allison65fcc2c2014-04-28 13:45:27 -07001584 } else {
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001585 DCHECK(!IsHighRegister(rn));
1586 DCHECK(!IsHighRegister(rd));
Dave Allison65fcc2c2014-04-28 13:45:27 -07001587 thumb_opcode = 0;
1588 }
1589 }
1590 break;
Andreas Gampe513ea0c2015-02-02 13:17:52 -08001591
1592 case TEQ:
1593 case RSC:
Dave Allison65fcc2c2014-04-28 13:45:27 -07001594 default:
Andreas Gampe513ea0c2015-02-02 13:17:52 -08001595 LOG(FATAL) << "Invalid thumb1 opcode " << opcode;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001596 break;
1597 }
1598 }
1599
Andreas Gampec8ccf682014-09-29 20:07:43 -07001600 if (thumb_opcode == 255U /* 0b11111111 */) {
Dave Allison65fcc2c2014-04-28 13:45:27 -07001601 LOG(FATAL) << "Invalid thumb1 opcode " << opcode;
Vladimir Markoe8469c12014-11-26 18:09:30 +00001602 UNREACHABLE();
Dave Allison65fcc2c2014-04-28 13:45:27 -07001603 }
1604
1605 int16_t encoding = dp_opcode << 14 |
1606 (thumb_opcode << opcode_shift) |
1607 rd << rd_shift |
1608 rn << rn_shift |
1609 (use_immediate ? (immediate << immediate_shift) : 0);
1610
1611 Emit16(encoding);
1612}
1613
1614
1615// ADD and SUB are complex enough to warrant their own emitter.
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001616void Thumb2Assembler::Emit16BitAddSub(Condition cond,
Dave Allison65fcc2c2014-04-28 13:45:27 -07001617 Opcode opcode,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001618 SetCc set_cc,
Dave Allison65fcc2c2014-04-28 13:45:27 -07001619 Register rn,
1620 Register rd,
1621 const ShifterOperand& so) {
1622 uint8_t dp_opcode = 0;
1623 uint8_t opcode_shift = 6;
1624 uint8_t rd_shift = 0;
1625 uint8_t rn_shift = 3;
1626 uint8_t immediate_shift = 0;
1627 bool use_immediate = false;
Vladimir Markof5c09c32015-12-17 12:08:08 +00001628 uint32_t immediate = 0; // Should be at most 10 bits but keep the full immediate for CHECKs.
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001629 uint8_t thumb_opcode;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001630
1631 if (so.IsImmediate()) {
1632 use_immediate = true;
1633 immediate = so.GetImmediate();
Vladimir Markof5c09c32015-12-17 12:08:08 +00001634 if (!IsUint<10>(immediate)) {
1635 // Flip ADD/SUB.
1636 opcode = (opcode == ADD) ? SUB : ADD;
1637 immediate = -immediate;
1638 DCHECK(IsUint<10>(immediate)); // More stringent checks below.
1639 }
Dave Allison65fcc2c2014-04-28 13:45:27 -07001640 }
1641
1642 switch (opcode) {
1643 case ADD:
1644 if (so.IsRegister()) {
1645 Register rm = so.GetRegister();
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001646 if (rn == rd && set_cc != kCcSet) {
Dave Allison65fcc2c2014-04-28 13:45:27 -07001647 // Can use T2 encoding (allows 4 bit registers)
Andreas Gampec8ccf682014-09-29 20:07:43 -07001648 dp_opcode = 1U /* 0b01 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001649 opcode_shift = 10;
Andreas Gampec8ccf682014-09-29 20:07:43 -07001650 thumb_opcode = 1U /* 0b0001 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001651 // Make Rn also contain the top bit of rd.
1652 rn = static_cast<Register>(static_cast<uint32_t>(rm) |
Andreas Gampec8ccf682014-09-29 20:07:43 -07001653 (static_cast<uint32_t>(rd) & 8U /* 0b1000 */) << 1);
1654 rd = static_cast<Register>(static_cast<uint32_t>(rd) & 7U /* 0b111 */);
Dave Allison65fcc2c2014-04-28 13:45:27 -07001655 } else {
1656 // T1.
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001657 DCHECK(!IsHighRegister(rd));
1658 DCHECK(!IsHighRegister(rn));
1659 DCHECK(!IsHighRegister(rm));
1660 // Sets condition codes if and only if outside IT block,
1661 // check that it complies with set_cc.
1662 DCHECK((cond == AL) ? set_cc != kCcKeep : set_cc != kCcSet);
Dave Allison65fcc2c2014-04-28 13:45:27 -07001663 opcode_shift = 9;
Andreas Gampec8ccf682014-09-29 20:07:43 -07001664 thumb_opcode = 12U /* 0b01100 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001665 immediate = static_cast<uint32_t>(so.GetRegister());
1666 use_immediate = true;
1667 immediate_shift = 6;
1668 }
1669 } else {
1670 // Immediate.
1671 if (rd == SP && rn == SP) {
1672 // ADD sp, sp, #imm
Andreas Gampec8ccf682014-09-29 20:07:43 -07001673 dp_opcode = 2U /* 0b10 */;
1674 thumb_opcode = 3U /* 0b11 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001675 opcode_shift = 12;
Vladimir Markof5c09c32015-12-17 12:08:08 +00001676 CHECK(IsUint<9>(immediate));
Roland Levillain14d90572015-07-16 10:52:26 +01001677 CHECK_ALIGNED(immediate, 4);
Dave Allison65fcc2c2014-04-28 13:45:27 -07001678
1679 // Remove rd and rn from instruction by orring it with immed and clearing bits.
1680 rn = R0;
1681 rd = R0;
1682 rd_shift = 0;
1683 rn_shift = 0;
1684 immediate >>= 2;
1685 } else if (rd != SP && rn == SP) {
1686 // ADD rd, SP, #imm
Andreas Gampec8ccf682014-09-29 20:07:43 -07001687 dp_opcode = 2U /* 0b10 */;
1688 thumb_opcode = 5U /* 0b101 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001689 opcode_shift = 11;
Vladimir Markof5c09c32015-12-17 12:08:08 +00001690 CHECK(IsUint<10>(immediate));
Roland Levillain14d90572015-07-16 10:52:26 +01001691 CHECK_ALIGNED(immediate, 4);
Dave Allison65fcc2c2014-04-28 13:45:27 -07001692
1693 // Remove rn from instruction.
1694 rn = R0;
1695 rn_shift = 0;
1696 rd_shift = 8;
1697 immediate >>= 2;
1698 } else if (rn != rd) {
1699 // Must use T1.
Vladimir Markof5c09c32015-12-17 12:08:08 +00001700 CHECK(IsUint<3>(immediate));
Dave Allison65fcc2c2014-04-28 13:45:27 -07001701 opcode_shift = 9;
Andreas Gampec8ccf682014-09-29 20:07:43 -07001702 thumb_opcode = 14U /* 0b01110 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001703 immediate_shift = 6;
1704 } else {
1705 // T2 encoding.
Vladimir Markof5c09c32015-12-17 12:08:08 +00001706 CHECK(IsUint<8>(immediate));
Dave Allison65fcc2c2014-04-28 13:45:27 -07001707 opcode_shift = 11;
Andreas Gampec8ccf682014-09-29 20:07:43 -07001708 thumb_opcode = 6U /* 0b110 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001709 rd_shift = 8;
1710 rn_shift = 8;
1711 }
1712 }
1713 break;
1714
1715 case SUB:
1716 if (so.IsRegister()) {
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001717 // T1.
1718 Register rm = so.GetRegister();
1719 DCHECK(!IsHighRegister(rd));
1720 DCHECK(!IsHighRegister(rn));
1721 DCHECK(!IsHighRegister(rm));
1722 // Sets condition codes if and only if outside IT block,
1723 // check that it complies with set_cc.
1724 DCHECK((cond == AL) ? set_cc != kCcKeep : set_cc != kCcSet);
1725 opcode_shift = 9;
1726 thumb_opcode = 13U /* 0b01101 */;
1727 immediate = static_cast<uint32_t>(rm);
1728 use_immediate = true;
1729 immediate_shift = 6;
1730 } else {
1731 if (rd == SP && rn == SP) {
1732 // SUB sp, sp, #imm
1733 dp_opcode = 2U /* 0b10 */;
1734 thumb_opcode = 0x61 /* 0b1100001 */;
1735 opcode_shift = 7;
Vladimir Markof5c09c32015-12-17 12:08:08 +00001736 CHECK(IsUint<9>(immediate));
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001737 CHECK_ALIGNED(immediate, 4);
Dave Allison65fcc2c2014-04-28 13:45:27 -07001738
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001739 // Remove rd and rn from instruction by orring it with immed and clearing bits.
1740 rn = R0;
1741 rd = R0;
1742 rd_shift = 0;
1743 rn_shift = 0;
1744 immediate >>= 2;
1745 } else if (rn != rd) {
1746 // Must use T1.
Vladimir Markof5c09c32015-12-17 12:08:08 +00001747 CHECK(IsUint<3>(immediate));
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001748 opcode_shift = 9;
1749 thumb_opcode = 15U /* 0b01111 */;
1750 immediate_shift = 6;
1751 } else {
1752 // T2 encoding.
Vladimir Markof5c09c32015-12-17 12:08:08 +00001753 CHECK(IsUint<8>(immediate));
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001754 opcode_shift = 11;
1755 thumb_opcode = 7U /* 0b111 */;
1756 rd_shift = 8;
1757 rn_shift = 8;
1758 }
1759 }
Dave Allison65fcc2c2014-04-28 13:45:27 -07001760 break;
1761 default:
1762 LOG(FATAL) << "This opcode is not an ADD or SUB: " << opcode;
Vladimir Markoe8469c12014-11-26 18:09:30 +00001763 UNREACHABLE();
Dave Allison65fcc2c2014-04-28 13:45:27 -07001764 }
1765
1766 int16_t encoding = dp_opcode << 14 |
1767 (thumb_opcode << opcode_shift) |
1768 rd << rd_shift |
1769 rn << rn_shift |
1770 (use_immediate ? (immediate << immediate_shift) : 0);
1771
1772 Emit16(encoding);
1773}
1774
1775
1776void Thumb2Assembler::EmitDataProcessing(Condition cond,
1777 Opcode opcode,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001778 SetCc set_cc,
Dave Allison65fcc2c2014-04-28 13:45:27 -07001779 Register rn,
1780 Register rd,
1781 const ShifterOperand& so) {
1782 CHECK_NE(rd, kNoRegister);
1783 CheckCondition(cond);
1784
1785 if (Is32BitDataProcessing(cond, opcode, set_cc, rn, rd, so)) {
1786 Emit32BitDataProcessing(cond, opcode, set_cc, rn, rd, so);
1787 } else {
1788 Emit16BitDataProcessing(cond, opcode, set_cc, rn, rd, so);
1789 }
1790}
1791
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001792void Thumb2Assembler::EmitShift(Register rd,
1793 Register rm,
1794 Shift shift,
1795 uint8_t amount,
1796 Condition cond,
1797 SetCc set_cc) {
Dave Allison45fdb932014-06-25 12:37:10 -07001798 CHECK_LT(amount, (1 << 5));
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001799 if ((IsHighRegister(rd) || IsHighRegister(rm) || shift == ROR || shift == RRX) ||
1800 ((cond == AL) ? set_cc == kCcKeep : set_cc == kCcSet)) {
Dave Allison45fdb932014-06-25 12:37:10 -07001801 uint16_t opcode = 0;
1802 switch (shift) {
Andreas Gampec8ccf682014-09-29 20:07:43 -07001803 case LSL: opcode = 0U /* 0b00 */; break;
1804 case LSR: opcode = 1U /* 0b01 */; break;
1805 case ASR: opcode = 2U /* 0b10 */; break;
1806 case ROR: opcode = 3U /* 0b11 */; break;
1807 case RRX: opcode = 3U /* 0b11 */; amount = 0; break;
Dave Allison45fdb932014-06-25 12:37:10 -07001808 default:
1809 LOG(FATAL) << "Unsupported thumb2 shift opcode";
Vladimir Markoe8469c12014-11-26 18:09:30 +00001810 UNREACHABLE();
Dave Allison45fdb932014-06-25 12:37:10 -07001811 }
1812 // 32 bit.
1813 int32_t encoding = B31 | B30 | B29 | B27 | B25 | B22 |
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001814 0xf << 16 | (set_cc == kCcSet ? B20 : 0);
Dave Allison45fdb932014-06-25 12:37:10 -07001815 uint32_t imm3 = amount >> 2;
Andreas Gampec8ccf682014-09-29 20:07:43 -07001816 uint32_t imm2 = amount & 3U /* 0b11 */;
Dave Allison45fdb932014-06-25 12:37:10 -07001817 encoding |= imm3 << 12 | imm2 << 6 | static_cast<int16_t>(rm) |
1818 static_cast<int16_t>(rd) << 8 | opcode << 4;
1819 Emit32(encoding);
1820 } else {
1821 // 16 bit shift
1822 uint16_t opcode = 0;
1823 switch (shift) {
Andreas Gampec8ccf682014-09-29 20:07:43 -07001824 case LSL: opcode = 0U /* 0b00 */; break;
1825 case LSR: opcode = 1U /* 0b01 */; break;
1826 case ASR: opcode = 2U /* 0b10 */; break;
Dave Allison45fdb932014-06-25 12:37:10 -07001827 default:
Vladimir Markoe8469c12014-11-26 18:09:30 +00001828 LOG(FATAL) << "Unsupported thumb2 shift opcode";
1829 UNREACHABLE();
Dave Allison45fdb932014-06-25 12:37:10 -07001830 }
1831 int16_t encoding = opcode << 11 | amount << 6 | static_cast<int16_t>(rm) << 3 |
1832 static_cast<int16_t>(rd);
1833 Emit16(encoding);
1834 }
1835}
1836
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001837void Thumb2Assembler::EmitShift(Register rd,
1838 Register rn,
1839 Shift shift,
1840 Register rm,
1841 Condition cond,
1842 SetCc set_cc) {
Dave Allison45fdb932014-06-25 12:37:10 -07001843 CHECK_NE(shift, RRX);
1844 bool must_be_32bit = false;
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001845 if (IsHighRegister(rd) || IsHighRegister(rm) || IsHighRegister(rn) || rd != rn ||
1846 ((cond == AL) ? set_cc == kCcKeep : set_cc == kCcSet)) {
Dave Allison45fdb932014-06-25 12:37:10 -07001847 must_be_32bit = true;
1848 }
1849
1850 if (must_be_32bit) {
1851 uint16_t opcode = 0;
1852 switch (shift) {
Andreas Gampec8ccf682014-09-29 20:07:43 -07001853 case LSL: opcode = 0U /* 0b00 */; break;
1854 case LSR: opcode = 1U /* 0b01 */; break;
1855 case ASR: opcode = 2U /* 0b10 */; break;
1856 case ROR: opcode = 3U /* 0b11 */; break;
Dave Allison45fdb932014-06-25 12:37:10 -07001857 default:
1858 LOG(FATAL) << "Unsupported thumb2 shift opcode";
Vladimir Markoe8469c12014-11-26 18:09:30 +00001859 UNREACHABLE();
Dave Allison45fdb932014-06-25 12:37:10 -07001860 }
1861 // 32 bit.
1862 int32_t encoding = B31 | B30 | B29 | B28 | B27 | B25 |
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001863 0xf << 12 | (set_cc == kCcSet ? B20 : 0);
Dave Allison45fdb932014-06-25 12:37:10 -07001864 encoding |= static_cast<int16_t>(rn) << 16 | static_cast<int16_t>(rm) |
1865 static_cast<int16_t>(rd) << 8 | opcode << 21;
1866 Emit32(encoding);
1867 } else {
1868 uint16_t opcode = 0;
1869 switch (shift) {
Andreas Gampec8ccf682014-09-29 20:07:43 -07001870 case LSL: opcode = 2U /* 0b0010 */; break;
1871 case LSR: opcode = 3U /* 0b0011 */; break;
1872 case ASR: opcode = 4U /* 0b0100 */; break;
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01001873 case ROR: opcode = 7U /* 0b0111 */; break;
Dave Allison45fdb932014-06-25 12:37:10 -07001874 default:
Vladimir Markoe8469c12014-11-26 18:09:30 +00001875 LOG(FATAL) << "Unsupported thumb2 shift opcode";
1876 UNREACHABLE();
Dave Allison45fdb932014-06-25 12:37:10 -07001877 }
1878 int16_t encoding = B14 | opcode << 6 | static_cast<int16_t>(rm) << 3 |
1879 static_cast<int16_t>(rd);
1880 Emit16(encoding);
1881 }
1882}
1883
Vladimir Markocf93a5c2015-06-16 11:33:24 +00001884inline size_t Thumb2Assembler::Fixup::SizeInBytes(Size size) {
1885 switch (size) {
1886 case kBranch16Bit:
1887 return 2u;
1888 case kBranch32Bit:
1889 return 4u;
Dave Allison45fdb932014-06-25 12:37:10 -07001890
Vladimir Markocf93a5c2015-06-16 11:33:24 +00001891 case kCbxz16Bit:
1892 return 2u;
1893 case kCbxz32Bit:
1894 return 4u;
1895 case kCbxz48Bit:
1896 return 6u;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001897
Vladimir Markocf93a5c2015-06-16 11:33:24 +00001898 case kLiteral1KiB:
1899 return 2u;
1900 case kLiteral4KiB:
1901 return 4u;
1902 case kLiteral64KiB:
1903 return 8u;
1904 case kLiteral1MiB:
1905 return 10u;
1906 case kLiteralFar:
1907 return 14u;
Dave Allison65fcc2c2014-04-28 13:45:27 -07001908
Andreas Gampe7cffc3b2015-10-19 21:31:53 -07001909 case kLiteralAddr1KiB:
1910 return 2u;
1911 case kLiteralAddr4KiB:
1912 return 4u;
1913 case kLiteralAddr64KiB:
1914 return 6u;
1915 case kLiteralAddrFar:
1916 return 10u;
1917
Vladimir Markocf93a5c2015-06-16 11:33:24 +00001918 case kLongOrFPLiteral1KiB:
1919 return 4u;
Vladimir Markoebdbf4b2016-07-07 15:37:02 +01001920 case kLongOrFPLiteral64KiB:
Vladimir Markocf93a5c2015-06-16 11:33:24 +00001921 return 10u;
1922 case kLongOrFPLiteralFar:
1923 return 14u;
1924 }
1925 LOG(FATAL) << "Unexpected size: " << static_cast<int>(size);
1926 UNREACHABLE();
1927}
1928
1929inline uint32_t Thumb2Assembler::Fixup::GetOriginalSizeInBytes() const {
1930 return SizeInBytes(original_size_);
1931}
1932
1933inline uint32_t Thumb2Assembler::Fixup::GetSizeInBytes() const {
1934 return SizeInBytes(size_);
1935}
1936
1937inline size_t Thumb2Assembler::Fixup::LiteralPoolPaddingSize(uint32_t current_code_size) {
1938 // The code size must be a multiple of 2.
Roland Levillain14d90572015-07-16 10:52:26 +01001939 DCHECK_ALIGNED(current_code_size, 2);
Vladimir Markocf93a5c2015-06-16 11:33:24 +00001940 // If it isn't a multiple of 4, we need to add a 2-byte padding before the literal pool.
1941 return current_code_size & 2;
1942}
1943
1944inline int32_t Thumb2Assembler::Fixup::GetOffset(uint32_t current_code_size) const {
1945 static constexpr int32_t int32_min = std::numeric_limits<int32_t>::min();
1946 static constexpr int32_t int32_max = std::numeric_limits<int32_t>::max();
1947 DCHECK_LE(target_, static_cast<uint32_t>(int32_max));
1948 DCHECK_LE(location_, static_cast<uint32_t>(int32_max));
1949 DCHECK_LE(adjustment_, static_cast<uint32_t>(int32_max));
1950 int32_t diff = static_cast<int32_t>(target_) - static_cast<int32_t>(location_);
1951 if (target_ > location_) {
1952 DCHECK_LE(adjustment_, static_cast<uint32_t>(int32_max - diff));
1953 diff += static_cast<int32_t>(adjustment_);
Dave Allison65fcc2c2014-04-28 13:45:27 -07001954 } else {
Vladimir Markocf93a5c2015-06-16 11:33:24 +00001955 DCHECK_LE(int32_min + static_cast<int32_t>(adjustment_), diff);
1956 diff -= static_cast<int32_t>(adjustment_);
1957 }
1958 // The default PC adjustment for Thumb2 is 4 bytes.
1959 DCHECK_GE(diff, int32_min + 4);
1960 diff -= 4;
1961 // Add additional adjustment for instructions preceding the PC usage, padding
1962 // before the literal pool and rounding down the PC for literal loads.
1963 switch (GetSize()) {
1964 case kBranch16Bit:
1965 case kBranch32Bit:
1966 break;
1967
1968 case kCbxz16Bit:
1969 break;
1970 case kCbxz32Bit:
1971 case kCbxz48Bit:
1972 DCHECK_GE(diff, int32_min + 2);
1973 diff -= 2; // Extra CMP Rn, #0, 16-bit.
1974 break;
1975
1976 case kLiteral1KiB:
1977 case kLiteral4KiB:
1978 case kLongOrFPLiteral1KiB:
Andreas Gampe7cffc3b2015-10-19 21:31:53 -07001979 case kLiteralAddr1KiB:
1980 case kLiteralAddr4KiB:
Vladimir Markocf93a5c2015-06-16 11:33:24 +00001981 DCHECK(diff >= 0 || (GetSize() == kLiteral1KiB && diff == -2));
1982 diff += LiteralPoolPaddingSize(current_code_size);
1983 // Load literal instructions round down the PC+4 to a multiple of 4, so if the PC
1984 // isn't a multiple of 2, we need to adjust. Since we already adjusted for the target
1985 // being aligned, current PC alignment can be inferred from diff.
Roland Levillain14d90572015-07-16 10:52:26 +01001986 DCHECK_ALIGNED(diff, 2);
Vladimir Markocf93a5c2015-06-16 11:33:24 +00001987 diff = diff + (diff & 2);
1988 DCHECK_GE(diff, 0);
1989 break;
1990 case kLiteral1MiB:
1991 case kLiteral64KiB:
Vladimir Markoebdbf4b2016-07-07 15:37:02 +01001992 case kLongOrFPLiteral64KiB:
Andreas Gampe7cffc3b2015-10-19 21:31:53 -07001993 case kLiteralAddr64KiB:
Vladimir Markocf93a5c2015-06-16 11:33:24 +00001994 DCHECK_GE(diff, 4); // The target must be at least 4 bytes after the ADD rX, PC.
1995 diff -= 4; // One extra 32-bit MOV.
1996 diff += LiteralPoolPaddingSize(current_code_size);
1997 break;
1998 case kLiteralFar:
1999 case kLongOrFPLiteralFar:
Andreas Gampe7cffc3b2015-10-19 21:31:53 -07002000 case kLiteralAddrFar:
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002001 DCHECK_GE(diff, 8); // The target must be at least 4 bytes after the ADD rX, PC.
2002 diff -= 8; // Extra MOVW+MOVT; both 32-bit.
2003 diff += LiteralPoolPaddingSize(current_code_size);
2004 break;
2005 }
2006 return diff;
2007}
2008
2009inline size_t Thumb2Assembler::Fixup::IncreaseSize(Size new_size) {
2010 DCHECK_NE(target_, kUnresolved);
2011 Size old_size = size_;
2012 size_ = new_size;
2013 DCHECK_GT(SizeInBytes(new_size), SizeInBytes(old_size));
2014 size_t adjustment = SizeInBytes(new_size) - SizeInBytes(old_size);
2015 if (target_ > location_) {
2016 adjustment_ += adjustment;
2017 }
2018 return adjustment;
2019}
2020
2021uint32_t Thumb2Assembler::Fixup::AdjustSizeIfNeeded(uint32_t current_code_size) {
2022 uint32_t old_code_size = current_code_size;
2023 switch (GetSize()) {
2024 case kBranch16Bit:
2025 if (IsInt(cond_ != AL ? 9 : 12, GetOffset(current_code_size))) {
2026 break;
Vladimir Markof38caa62015-05-29 15:50:18 +01002027 }
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002028 current_code_size += IncreaseSize(kBranch32Bit);
2029 FALLTHROUGH_INTENDED;
2030 case kBranch32Bit:
2031 // We don't support conditional branches beyond +-1MiB
2032 // or unconditional branches beyond +-16MiB.
2033 break;
2034
2035 case kCbxz16Bit:
2036 if (IsUint<7>(GetOffset(current_code_size))) {
2037 break;
2038 }
2039 current_code_size += IncreaseSize(kCbxz32Bit);
2040 FALLTHROUGH_INTENDED;
2041 case kCbxz32Bit:
2042 if (IsInt<9>(GetOffset(current_code_size))) {
2043 break;
2044 }
2045 current_code_size += IncreaseSize(kCbxz48Bit);
2046 FALLTHROUGH_INTENDED;
2047 case kCbxz48Bit:
2048 // We don't support conditional branches beyond +-1MiB.
2049 break;
2050
2051 case kLiteral1KiB:
2052 DCHECK(!IsHighRegister(rn_));
2053 if (IsUint<10>(GetOffset(current_code_size))) {
2054 break;
2055 }
2056 current_code_size += IncreaseSize(kLiteral4KiB);
2057 FALLTHROUGH_INTENDED;
2058 case kLiteral4KiB:
2059 if (IsUint<12>(GetOffset(current_code_size))) {
2060 break;
2061 }
2062 current_code_size += IncreaseSize(kLiteral64KiB);
2063 FALLTHROUGH_INTENDED;
2064 case kLiteral64KiB:
2065 // Can't handle high register which we can encounter by fall-through from kLiteral4KiB.
2066 if (!IsHighRegister(rn_) && IsUint<16>(GetOffset(current_code_size))) {
2067 break;
2068 }
2069 current_code_size += IncreaseSize(kLiteral1MiB);
2070 FALLTHROUGH_INTENDED;
2071 case kLiteral1MiB:
2072 if (IsUint<20>(GetOffset(current_code_size))) {
2073 break;
2074 }
2075 current_code_size += IncreaseSize(kLiteralFar);
2076 FALLTHROUGH_INTENDED;
2077 case kLiteralFar:
2078 // This encoding can reach any target.
2079 break;
2080
Andreas Gampe7cffc3b2015-10-19 21:31:53 -07002081 case kLiteralAddr1KiB:
2082 DCHECK(!IsHighRegister(rn_));
2083 if (IsUint<10>(GetOffset(current_code_size))) {
2084 break;
2085 }
2086 current_code_size += IncreaseSize(kLiteralAddr4KiB);
2087 FALLTHROUGH_INTENDED;
2088 case kLiteralAddr4KiB:
2089 if (IsUint<12>(GetOffset(current_code_size))) {
2090 break;
2091 }
2092 current_code_size += IncreaseSize(kLiteralAddr64KiB);
2093 FALLTHROUGH_INTENDED;
2094 case kLiteralAddr64KiB:
2095 if (IsUint<16>(GetOffset(current_code_size))) {
2096 break;
2097 }
2098 current_code_size += IncreaseSize(kLiteralAddrFar);
2099 FALLTHROUGH_INTENDED;
2100 case kLiteralAddrFar:
2101 // This encoding can reach any target.
2102 break;
2103
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002104 case kLongOrFPLiteral1KiB:
2105 if (IsUint<10>(GetOffset(current_code_size))) {
2106 break;
2107 }
Vladimir Markoebdbf4b2016-07-07 15:37:02 +01002108 current_code_size += IncreaseSize(kLongOrFPLiteral64KiB);
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002109 FALLTHROUGH_INTENDED;
Vladimir Markoebdbf4b2016-07-07 15:37:02 +01002110 case kLongOrFPLiteral64KiB:
2111 if (IsUint<16>(GetOffset(current_code_size))) {
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002112 break;
2113 }
2114 current_code_size += IncreaseSize(kLongOrFPLiteralFar);
2115 FALLTHROUGH_INTENDED;
2116 case kLongOrFPLiteralFar:
2117 // This encoding can reach any target.
2118 break;
2119 }
2120 return current_code_size - old_code_size;
2121}
2122
2123void Thumb2Assembler::Fixup::Emit(AssemblerBuffer* buffer, uint32_t code_size) const {
2124 switch (GetSize()) {
2125 case kBranch16Bit: {
2126 DCHECK(type_ == kUnconditional || type_ == kConditional);
2127 DCHECK_EQ(type_ == kConditional, cond_ != AL);
2128 int16_t encoding = BEncoding16(GetOffset(code_size), cond_);
Vladimir Markof38caa62015-05-29 15:50:18 +01002129 buffer->Store<int16_t>(location_, encoding);
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002130 break;
2131 }
2132 case kBranch32Bit: {
2133 DCHECK(type_ == kConditional || type_ == kUnconditional ||
2134 type_ == kUnconditionalLink || type_ == kUnconditionalLinkX);
2135 DCHECK_EQ(type_ == kConditional, cond_ != AL);
2136 int32_t encoding = BEncoding32(GetOffset(code_size), cond_);
2137 if (type_ == kUnconditionalLink) {
2138 DCHECK_NE(encoding & B12, 0);
2139 encoding |= B14;
2140 } else if (type_ == kUnconditionalLinkX) {
2141 DCHECK_NE(encoding & B12, 0);
2142 encoding ^= B14 | B12;
2143 }
2144 buffer->Store<int16_t>(location_, encoding >> 16);
2145 buffer->Store<int16_t>(location_ + 2u, static_cast<int16_t>(encoding & 0xffff));
2146 break;
2147 }
2148
2149 case kCbxz16Bit: {
2150 DCHECK(type_ == kCompareAndBranchXZero);
2151 int16_t encoding = CbxzEncoding16(rn_, GetOffset(code_size), cond_);
2152 buffer->Store<int16_t>(location_, encoding);
2153 break;
2154 }
2155 case kCbxz32Bit: {
2156 DCHECK(type_ == kCompareAndBranchXZero);
2157 DCHECK(cond_ == EQ || cond_ == NE);
2158 int16_t cmp_encoding = CmpRnImm8Encoding16(rn_, 0);
2159 int16_t b_encoding = BEncoding16(GetOffset(code_size), cond_);
2160 buffer->Store<int16_t>(location_, cmp_encoding);
2161 buffer->Store<int16_t>(location_ + 2, b_encoding);
2162 break;
2163 }
2164 case kCbxz48Bit: {
2165 DCHECK(type_ == kCompareAndBranchXZero);
2166 DCHECK(cond_ == EQ || cond_ == NE);
2167 int16_t cmp_encoding = CmpRnImm8Encoding16(rn_, 0);
2168 int32_t b_encoding = BEncoding32(GetOffset(code_size), cond_);
2169 buffer->Store<int16_t>(location_, cmp_encoding);
2170 buffer->Store<int16_t>(location_ + 2u, b_encoding >> 16);
2171 buffer->Store<int16_t>(location_ + 4u, static_cast<int16_t>(b_encoding & 0xffff));
2172 break;
2173 }
2174
2175 case kLiteral1KiB: {
2176 DCHECK(type_ == kLoadLiteralNarrow);
2177 int16_t encoding = LdrLitEncoding16(rn_, GetOffset(code_size));
2178 buffer->Store<int16_t>(location_, encoding);
2179 break;
2180 }
2181 case kLiteral4KiB: {
2182 DCHECK(type_ == kLoadLiteralNarrow);
2183 // GetOffset() uses PC+4 but load literal uses AlignDown(PC+4, 4). Adjust offset accordingly.
2184 int32_t encoding = LdrLitEncoding32(rn_, GetOffset(code_size));
2185 buffer->Store<int16_t>(location_, encoding >> 16);
2186 buffer->Store<int16_t>(location_ + 2u, static_cast<int16_t>(encoding & 0xffff));
2187 break;
2188 }
2189 case kLiteral64KiB: {
2190 DCHECK(type_ == kLoadLiteralNarrow);
2191 int32_t mov_encoding = MovwEncoding32(rn_, GetOffset(code_size));
2192 int16_t add_pc_encoding = AddRdnRmEncoding16(rn_, PC);
2193 int16_t ldr_encoding = LdrRtRnImm5Encoding16(rn_, rn_, 0);
2194 buffer->Store<int16_t>(location_, mov_encoding >> 16);
2195 buffer->Store<int16_t>(location_ + 2u, static_cast<int16_t>(mov_encoding & 0xffff));
2196 buffer->Store<int16_t>(location_ + 4u, add_pc_encoding);
2197 buffer->Store<int16_t>(location_ + 6u, ldr_encoding);
2198 break;
2199 }
2200 case kLiteral1MiB: {
2201 DCHECK(type_ == kLoadLiteralNarrow);
2202 int32_t offset = GetOffset(code_size);
2203 int32_t mov_encoding = MovModImmEncoding32(rn_, offset & ~0xfff);
2204 int16_t add_pc_encoding = AddRdnRmEncoding16(rn_, PC);
2205 int32_t ldr_encoding = LdrRtRnImm12Encoding(rn_, rn_, offset & 0xfff);
2206 buffer->Store<int16_t>(location_, mov_encoding >> 16);
2207 buffer->Store<int16_t>(location_ + 2u, static_cast<int16_t>(mov_encoding & 0xffff));
2208 buffer->Store<int16_t>(location_ + 4u, add_pc_encoding);
2209 buffer->Store<int16_t>(location_ + 6u, ldr_encoding >> 16);
2210 buffer->Store<int16_t>(location_ + 8u, static_cast<int16_t>(ldr_encoding & 0xffff));
2211 break;
2212 }
2213 case kLiteralFar: {
2214 DCHECK(type_ == kLoadLiteralNarrow);
2215 int32_t offset = GetOffset(code_size);
2216 int32_t movw_encoding = MovwEncoding32(rn_, offset & 0xffff);
2217 int32_t movt_encoding = MovtEncoding32(rn_, offset & ~0xffff);
2218 int16_t add_pc_encoding = AddRdnRmEncoding16(rn_, PC);
2219 int32_t ldr_encoding = LdrRtRnImm12Encoding(rn_, rn_, 0);
2220 buffer->Store<int16_t>(location_, movw_encoding >> 16);
2221 buffer->Store<int16_t>(location_ + 2u, static_cast<int16_t>(movw_encoding & 0xffff));
2222 buffer->Store<int16_t>(location_ + 4u, movt_encoding >> 16);
2223 buffer->Store<int16_t>(location_ + 6u, static_cast<int16_t>(movt_encoding & 0xffff));
2224 buffer->Store<int16_t>(location_ + 8u, add_pc_encoding);
2225 buffer->Store<int16_t>(location_ + 10u, ldr_encoding >> 16);
2226 buffer->Store<int16_t>(location_ + 12u, static_cast<int16_t>(ldr_encoding & 0xffff));
2227 break;
2228 }
2229
Andreas Gampe7cffc3b2015-10-19 21:31:53 -07002230 case kLiteralAddr1KiB: {
2231 DCHECK(type_ == kLoadLiteralAddr);
2232 int16_t encoding = AdrEncoding16(rn_, GetOffset(code_size));
2233 buffer->Store<int16_t>(location_, encoding);
2234 break;
2235 }
2236 case kLiteralAddr4KiB: {
2237 DCHECK(type_ == kLoadLiteralAddr);
2238 int32_t encoding = AdrEncoding32(rn_, GetOffset(code_size));
2239 buffer->Store<int16_t>(location_, encoding >> 16);
2240 buffer->Store<int16_t>(location_ + 2u, static_cast<int16_t>(encoding & 0xffff));
2241 break;
2242 }
2243 case kLiteralAddr64KiB: {
2244 DCHECK(type_ == kLoadLiteralAddr);
2245 int32_t mov_encoding = MovwEncoding32(rn_, GetOffset(code_size));
2246 int16_t add_pc_encoding = AddRdnRmEncoding16(rn_, PC);
2247 buffer->Store<int16_t>(location_, mov_encoding >> 16);
2248 buffer->Store<int16_t>(location_ + 2u, static_cast<int16_t>(mov_encoding & 0xffff));
2249 buffer->Store<int16_t>(location_ + 4u, add_pc_encoding);
2250 break;
2251 }
2252 case kLiteralAddrFar: {
2253 DCHECK(type_ == kLoadLiteralAddr);
2254 int32_t offset = GetOffset(code_size);
2255 int32_t movw_encoding = MovwEncoding32(rn_, offset & 0xffff);
2256 int32_t movt_encoding = MovtEncoding32(rn_, offset & ~0xffff);
2257 int16_t add_pc_encoding = AddRdnRmEncoding16(rn_, PC);
2258 buffer->Store<int16_t>(location_, movw_encoding >> 16);
2259 buffer->Store<int16_t>(location_ + 2u, static_cast<int16_t>(movw_encoding & 0xffff));
2260 buffer->Store<int16_t>(location_ + 4u, movt_encoding >> 16);
2261 buffer->Store<int16_t>(location_ + 6u, static_cast<int16_t>(movt_encoding & 0xffff));
2262 buffer->Store<int16_t>(location_ + 8u, add_pc_encoding);
2263 break;
2264 }
2265
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002266 case kLongOrFPLiteral1KiB: {
2267 int32_t encoding = LoadWideOrFpEncoding(PC, GetOffset(code_size)); // DCHECKs type_.
2268 buffer->Store<int16_t>(location_, encoding >> 16);
2269 buffer->Store<int16_t>(location_ + 2u, static_cast<int16_t>(encoding & 0xffff));
2270 break;
2271 }
Vladimir Markoebdbf4b2016-07-07 15:37:02 +01002272 case kLongOrFPLiteral64KiB: {
2273 int32_t mov_encoding = MovwEncoding32(IP, GetOffset(code_size));
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002274 int16_t add_pc_encoding = AddRdnRmEncoding16(IP, PC);
Vladimir Markoebdbf4b2016-07-07 15:37:02 +01002275 int32_t ldr_encoding = LoadWideOrFpEncoding(IP, 0u); // DCHECKs type_.
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002276 buffer->Store<int16_t>(location_, mov_encoding >> 16);
2277 buffer->Store<int16_t>(location_ + 2u, static_cast<int16_t>(mov_encoding & 0xffff));
2278 buffer->Store<int16_t>(location_ + 4u, add_pc_encoding);
2279 buffer->Store<int16_t>(location_ + 6u, ldr_encoding >> 16);
2280 buffer->Store<int16_t>(location_ + 8u, static_cast<int16_t>(ldr_encoding & 0xffff));
2281 break;
2282 }
2283 case kLongOrFPLiteralFar: {
2284 int32_t offset = GetOffset(code_size);
2285 int32_t movw_encoding = MovwEncoding32(IP, offset & 0xffff);
2286 int32_t movt_encoding = MovtEncoding32(IP, offset & ~0xffff);
2287 int16_t add_pc_encoding = AddRdnRmEncoding16(IP, PC);
2288 int32_t ldr_encoding = LoadWideOrFpEncoding(IP, 0); // DCHECKs type_.
2289 buffer->Store<int16_t>(location_, movw_encoding >> 16);
2290 buffer->Store<int16_t>(location_ + 2u, static_cast<int16_t>(movw_encoding & 0xffff));
2291 buffer->Store<int16_t>(location_ + 4u, movt_encoding >> 16);
2292 buffer->Store<int16_t>(location_ + 6u, static_cast<int16_t>(movt_encoding & 0xffff));
2293 buffer->Store<int16_t>(location_ + 8u, add_pc_encoding);
2294 buffer->Store<int16_t>(location_ + 10u, ldr_encoding >> 16);
2295 buffer->Store<int16_t>(location_ + 12u, static_cast<int16_t>(ldr_encoding & 0xffff));
2296 break;
Dave Allison65fcc2c2014-04-28 13:45:27 -07002297 }
2298 }
2299}
2300
Dave Allison65fcc2c2014-04-28 13:45:27 -07002301uint16_t Thumb2Assembler::EmitCompareAndBranch(Register rn, uint16_t prev, bool n) {
Nicolas Geoffrayd56376c2015-05-21 12:32:34 +00002302 CHECK(IsLowRegister(rn));
Dave Allison65fcc2c2014-04-28 13:45:27 -07002303 uint32_t location = buffer_.Size();
2304
2305 // This is always unresolved as it must be a forward branch.
2306 Emit16(prev); // Previous link.
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002307 return AddFixup(Fixup::CompareAndBranch(location, rn, n ? NE : EQ));
Dave Allison65fcc2c2014-04-28 13:45:27 -07002308}
2309
2310
2311// NOTE: this only support immediate offsets, not [rx,ry].
2312// TODO: support [rx,ry] instructions.
2313void Thumb2Assembler::EmitLoadStore(Condition cond,
2314 bool load,
2315 bool byte,
2316 bool half,
2317 bool is_signed,
2318 Register rd,
2319 const Address& ad) {
2320 CHECK_NE(rd, kNoRegister);
2321 CheckCondition(cond);
2322 bool must_be_32bit = force_32bit_;
2323 if (IsHighRegister(rd)) {
2324 must_be_32bit = true;
2325 }
2326
2327 Register rn = ad.GetRegister();
Dave Allison45fdb932014-06-25 12:37:10 -07002328 if (IsHighRegister(rn) && rn != SP && rn != PC) {
Dave Allison65fcc2c2014-04-28 13:45:27 -07002329 must_be_32bit = true;
2330 }
2331
2332 if (is_signed || ad.GetOffset() < 0 || ad.GetMode() != Address::Offset) {
2333 must_be_32bit = true;
2334 }
2335
Dave Allison45fdb932014-06-25 12:37:10 -07002336 if (ad.IsImmediate()) {
2337 // Immediate offset
2338 int32_t offset = ad.GetOffset();
Dave Allison65fcc2c2014-04-28 13:45:27 -07002339
Dave Allison45fdb932014-06-25 12:37:10 -07002340 // The 16 bit SP relative instruction can only have a 10 bit offset.
Dave Allison0bb9ade2014-06-26 17:57:36 -07002341 if (rn == SP && offset >= (1 << 10)) {
Dave Allison65fcc2c2014-04-28 13:45:27 -07002342 must_be_32bit = true;
2343 }
Dave Allison65fcc2c2014-04-28 13:45:27 -07002344
2345 if (byte) {
Dave Allison45fdb932014-06-25 12:37:10 -07002346 // 5 bit offset, no shift.
Dave Allison0bb9ade2014-06-26 17:57:36 -07002347 if (offset >= (1 << 5)) {
Dave Allison45fdb932014-06-25 12:37:10 -07002348 must_be_32bit = true;
2349 }
Dave Allison65fcc2c2014-04-28 13:45:27 -07002350 } else if (half) {
Dave Allison45fdb932014-06-25 12:37:10 -07002351 // 6 bit offset, shifted by 1.
Dave Allison0bb9ade2014-06-26 17:57:36 -07002352 if (offset >= (1 << 6)) {
Dave Allison45fdb932014-06-25 12:37:10 -07002353 must_be_32bit = true;
2354 }
Dave Allison65fcc2c2014-04-28 13:45:27 -07002355 } else {
Dave Allison45fdb932014-06-25 12:37:10 -07002356 // 7 bit offset, shifted by 2.
Dave Allison0bb9ade2014-06-26 17:57:36 -07002357 if (offset >= (1 << 7)) {
Dave Allison45fdb932014-06-25 12:37:10 -07002358 must_be_32bit = true;
Dave Allison65fcc2c2014-04-28 13:45:27 -07002359 }
2360 }
Dave Allison65fcc2c2014-04-28 13:45:27 -07002361
Dave Allison45fdb932014-06-25 12:37:10 -07002362 if (must_be_32bit) {
2363 int32_t encoding = B31 | B30 | B29 | B28 | B27 |
2364 (load ? B20 : 0) |
2365 (is_signed ? B24 : 0) |
2366 static_cast<uint32_t>(rd) << 12 |
2367 ad.encodingThumb(true) |
2368 (byte ? 0 : half ? B21 : B22);
2369 Emit32(encoding);
Dave Allison65fcc2c2014-04-28 13:45:27 -07002370 } else {
Dave Allison45fdb932014-06-25 12:37:10 -07002371 // 16 bit thumb1.
2372 uint8_t opA = 0;
2373 bool sp_relative = false;
Dave Allison65fcc2c2014-04-28 13:45:27 -07002374
2375 if (byte) {
Andreas Gampec8ccf682014-09-29 20:07:43 -07002376 opA = 7U /* 0b0111 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07002377 } else if (half) {
Andreas Gampec8ccf682014-09-29 20:07:43 -07002378 opA = 8U /* 0b1000 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07002379 } else {
Dave Allison45fdb932014-06-25 12:37:10 -07002380 if (rn == SP) {
Andreas Gampec8ccf682014-09-29 20:07:43 -07002381 opA = 9U /* 0b1001 */;
Dave Allison45fdb932014-06-25 12:37:10 -07002382 sp_relative = true;
2383 } else {
Andreas Gampec8ccf682014-09-29 20:07:43 -07002384 opA = 6U /* 0b0110 */;
Dave Allison45fdb932014-06-25 12:37:10 -07002385 }
Dave Allison65fcc2c2014-04-28 13:45:27 -07002386 }
Dave Allison45fdb932014-06-25 12:37:10 -07002387 int16_t encoding = opA << 12 |
2388 (load ? B11 : 0);
Dave Allison65fcc2c2014-04-28 13:45:27 -07002389
Dave Allison45fdb932014-06-25 12:37:10 -07002390 CHECK_GE(offset, 0);
2391 if (sp_relative) {
2392 // SP relative, 10 bit offset.
Dave Allison0bb9ade2014-06-26 17:57:36 -07002393 CHECK_LT(offset, (1 << 10));
Roland Levillain14d90572015-07-16 10:52:26 +01002394 CHECK_ALIGNED(offset, 4);
Dave Allison45fdb932014-06-25 12:37:10 -07002395 encoding |= rd << 8 | offset >> 2;
2396 } else {
2397 // No SP relative. The offset is shifted right depending on
2398 // the size of the load/store.
2399 encoding |= static_cast<uint32_t>(rd);
2400
2401 if (byte) {
2402 // 5 bit offset, no shift.
Dave Allison0bb9ade2014-06-26 17:57:36 -07002403 CHECK_LT(offset, (1 << 5));
Dave Allison45fdb932014-06-25 12:37:10 -07002404 } else if (half) {
2405 // 6 bit offset, shifted by 1.
Dave Allison0bb9ade2014-06-26 17:57:36 -07002406 CHECK_LT(offset, (1 << 6));
Roland Levillain14d90572015-07-16 10:52:26 +01002407 CHECK_ALIGNED(offset, 2);
Dave Allison45fdb932014-06-25 12:37:10 -07002408 offset >>= 1;
2409 } else {
2410 // 7 bit offset, shifted by 2.
Dave Allison0bb9ade2014-06-26 17:57:36 -07002411 CHECK_LT(offset, (1 << 7));
Roland Levillain14d90572015-07-16 10:52:26 +01002412 CHECK_ALIGNED(offset, 4);
Dave Allison45fdb932014-06-25 12:37:10 -07002413 offset >>= 2;
2414 }
2415 encoding |= rn << 3 | offset << 6;
2416 }
2417
2418 Emit16(encoding);
2419 }
2420 } else {
2421 // Register shift.
2422 if (ad.GetRegister() == PC) {
2423 // PC relative literal encoding.
2424 int32_t offset = ad.GetOffset();
Dave Allison0bb9ade2014-06-26 17:57:36 -07002425 if (must_be_32bit || offset < 0 || offset >= (1 << 10) || !load) {
Dave Allison45fdb932014-06-25 12:37:10 -07002426 int32_t up = B23;
2427 if (offset < 0) {
2428 offset = -offset;
2429 up = 0;
2430 }
2431 CHECK_LT(offset, (1 << 12));
2432 int32_t encoding = 0x1f << 27 | 0xf << 16 | B22 | (load ? B20 : 0) |
2433 offset | up |
2434 static_cast<uint32_t>(rd) << 12;
2435 Emit32(encoding);
2436 } else {
2437 // 16 bit literal load.
2438 CHECK_GE(offset, 0);
2439 CHECK_LT(offset, (1 << 10));
2440 int32_t encoding = B14 | (load ? B11 : 0) | static_cast<uint32_t>(rd) << 8 | offset >> 2;
2441 Emit16(encoding);
2442 }
2443 } else {
2444 if (ad.GetShiftCount() != 0) {
2445 // If there is a shift count this must be 32 bit.
2446 must_be_32bit = true;
2447 } else if (IsHighRegister(ad.GetRegisterOffset())) {
2448 must_be_32bit = true;
2449 }
2450
2451 if (must_be_32bit) {
Nicolas Geoffray1a43dd72014-07-17 15:15:34 +01002452 int32_t encoding = 0x1f << 27 | (load ? B20 : 0) | static_cast<uint32_t>(rd) << 12 |
Dave Allison45fdb932014-06-25 12:37:10 -07002453 ad.encodingThumb(true);
Nicolas Geoffray1a43dd72014-07-17 15:15:34 +01002454 if (half) {
2455 encoding |= B21;
2456 } else if (!byte) {
2457 encoding |= B22;
2458 }
Dave Allison45fdb932014-06-25 12:37:10 -07002459 Emit32(encoding);
2460 } else {
2461 // 16 bit register offset.
2462 int32_t encoding = B14 | B12 | (load ? B11 : 0) | static_cast<uint32_t>(rd) |
2463 ad.encodingThumb(false);
Nicolas Geoffray1a43dd72014-07-17 15:15:34 +01002464 if (byte) {
2465 encoding |= B10;
2466 } else if (half) {
2467 encoding |= B9;
2468 }
Dave Allison45fdb932014-06-25 12:37:10 -07002469 Emit16(encoding);
2470 }
2471 }
Dave Allison65fcc2c2014-04-28 13:45:27 -07002472 }
2473}
2474
2475
2476void Thumb2Assembler::EmitMultiMemOp(Condition cond,
Ian Rogers6a3c1fc2014-10-31 00:33:20 -07002477 BlockAddressMode bam,
Dave Allison65fcc2c2014-04-28 13:45:27 -07002478 bool load,
2479 Register base,
2480 RegList regs) {
2481 CHECK_NE(base, kNoRegister);
2482 CheckCondition(cond);
2483 bool must_be_32bit = force_32bit_;
2484
Vladimir Markoe8469c12014-11-26 18:09:30 +00002485 if (!must_be_32bit && base == SP && bam == (load ? IA_W : DB_W) &&
2486 (regs & 0xff00 & ~(1 << (load ? PC : LR))) == 0) {
2487 // Use 16-bit PUSH/POP.
2488 int16_t encoding = B15 | B13 | B12 | (load ? B11 : 0) | B10 |
2489 ((regs & (1 << (load ? PC : LR))) != 0 ? B8 : 0) | (regs & 0x00ff);
2490 Emit16(encoding);
2491 return;
2492 }
2493
Dave Allison65fcc2c2014-04-28 13:45:27 -07002494 if ((regs & 0xff00) != 0) {
2495 must_be_32bit = true;
2496 }
2497
Ian Rogers6a3c1fc2014-10-31 00:33:20 -07002498 bool w_bit = bam == IA_W || bam == DB_W || bam == DA_W || bam == IB_W;
Dave Allison65fcc2c2014-04-28 13:45:27 -07002499 // 16 bit always uses writeback.
2500 if (!w_bit) {
2501 must_be_32bit = true;
2502 }
2503
2504 if (must_be_32bit) {
2505 uint32_t op = 0;
Ian Rogers6a3c1fc2014-10-31 00:33:20 -07002506 switch (bam) {
Dave Allison65fcc2c2014-04-28 13:45:27 -07002507 case IA:
2508 case IA_W:
Andreas Gampec8ccf682014-09-29 20:07:43 -07002509 op = 1U /* 0b01 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07002510 break;
2511 case DB:
2512 case DB_W:
Andreas Gampec8ccf682014-09-29 20:07:43 -07002513 op = 2U /* 0b10 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07002514 break;
2515 case DA:
2516 case IB:
2517 case DA_W:
2518 case IB_W:
Ian Rogers6a3c1fc2014-10-31 00:33:20 -07002519 LOG(FATAL) << "LDM/STM mode not supported on thumb: " << bam;
Vladimir Markoe8469c12014-11-26 18:09:30 +00002520 UNREACHABLE();
Dave Allison65fcc2c2014-04-28 13:45:27 -07002521 }
2522 if (load) {
2523 // Cannot have SP in the list.
2524 CHECK_EQ((regs & (1 << SP)), 0);
2525 } else {
2526 // Cannot have PC or SP in the list.
2527 CHECK_EQ((regs & (1 << PC | 1 << SP)), 0);
2528 }
2529 int32_t encoding = B31 | B30 | B29 | B27 |
2530 (op << 23) |
2531 (load ? B20 : 0) |
2532 base << 16 |
2533 regs |
2534 (w_bit << 21);
2535 Emit32(encoding);
2536 } else {
2537 int16_t encoding = B15 | B14 |
2538 (load ? B11 : 0) |
2539 base << 8 |
2540 regs;
2541 Emit16(encoding);
2542 }
2543}
2544
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002545void Thumb2Assembler::EmitBranch(Condition cond, Label* label, bool link, bool x) {
2546 bool use32bit = IsForced32Bit() || !CanRelocateBranches();
Dave Allison65fcc2c2014-04-28 13:45:27 -07002547 uint32_t pc = buffer_.Size();
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002548 Fixup::Type branch_type;
Dave Allison65fcc2c2014-04-28 13:45:27 -07002549 if (cond == AL) {
2550 if (link) {
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002551 use32bit = true;
Dave Allison65fcc2c2014-04-28 13:45:27 -07002552 if (x) {
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002553 branch_type = Fixup::kUnconditionalLinkX; // BLX.
Dave Allison65fcc2c2014-04-28 13:45:27 -07002554 } else {
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002555 branch_type = Fixup::kUnconditionalLink; // BX.
Dave Allison65fcc2c2014-04-28 13:45:27 -07002556 }
2557 } else {
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002558 branch_type = Fixup::kUnconditional; // B.
Vladimir Markoa64f2492016-04-25 12:43:50 +00002559 // The T2 encoding offset is `SignExtend(imm11:'0', 32)` and there is a PC adjustment of 4.
2560 static constexpr size_t kMaxT2BackwardDistance = (1u << 11) - 4u;
2561 if (!use32bit && label->IsBound() && pc - label->Position() > kMaxT2BackwardDistance) {
2562 use32bit = true;
2563 }
Dave Allison65fcc2c2014-04-28 13:45:27 -07002564 }
2565 } else {
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002566 branch_type = Fixup::kConditional; // B<cond>.
Vladimir Markoa64f2492016-04-25 12:43:50 +00002567 // The T1 encoding offset is `SignExtend(imm8:'0', 32)` and there is a PC adjustment of 4.
2568 static constexpr size_t kMaxT1BackwardDistance = (1u << 8) - 4u;
2569 if (!use32bit && label->IsBound() && pc - label->Position() > kMaxT1BackwardDistance) {
2570 use32bit = true;
2571 }
Dave Allison65fcc2c2014-04-28 13:45:27 -07002572 }
2573
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002574 Fixup::Size size = use32bit ? Fixup::kBranch32Bit : Fixup::kBranch16Bit;
2575 FixupId branch_id = AddFixup(Fixup::Branch(pc, branch_type, size, cond));
2576
Dave Allison65fcc2c2014-04-28 13:45:27 -07002577 if (label->IsBound()) {
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002578 // The branch is to a bound label which means that it's a backwards branch.
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002579 GetFixup(branch_id)->Resolve(label->Position());
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002580 Emit16(0);
Vladimir Markofbeb4ae2015-06-16 11:32:01 +00002581 } else {
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002582 // Branch target is an unbound label. Add it to a singly-linked list maintained within
2583 // the code with the label serving as the head.
2584 Emit16(static_cast<uint16_t>(label->position_));
2585 label->LinkTo(branch_id);
Vladimir Markof38caa62015-05-29 15:50:18 +01002586 }
Vladimir Markocf93a5c2015-06-16 11:33:24 +00002587
2588 if (use32bit) {
2589 Emit16(0);
2590 }
2591 DCHECK_EQ(buffer_.Size() - pc, GetFixup(branch_id)->GetSizeInBytes());
Dave Allison65fcc2c2014-04-28 13:45:27 -07002592}
2593
2594
Artem Serovc257da72016-02-02 13:49:43 +00002595void Thumb2Assembler::Emit32Miscellaneous(uint8_t op1,
2596 uint8_t op2,
2597 uint32_t rest_encoding) {
2598 int32_t encoding = B31 | B30 | B29 | B28 | B27 | B25 | B23 |
2599 op1 << 20 |
2600 0xf << 12 |
2601 B7 |
2602 op2 << 4 |
2603 rest_encoding;
2604 Emit32(encoding);
2605}
2606
2607
2608void Thumb2Assembler::Emit16Miscellaneous(uint32_t rest_encoding) {
2609 int16_t encoding = B15 | B13 | B12 |
2610 rest_encoding;
2611 Emit16(encoding);
2612}
2613
Dave Allison65fcc2c2014-04-28 13:45:27 -07002614void Thumb2Assembler::clz(Register rd, Register rm, Condition cond) {
2615 CHECK_NE(rd, kNoRegister);
2616 CHECK_NE(rm, kNoRegister);
2617 CheckCondition(cond);
2618 CHECK_NE(rd, PC);
2619 CHECK_NE(rm, PC);
Artem Serovc257da72016-02-02 13:49:43 +00002620 int32_t encoding =
Dave Allison65fcc2c2014-04-28 13:45:27 -07002621 static_cast<uint32_t>(rm) << 16 |
Dave Allison65fcc2c2014-04-28 13:45:27 -07002622 static_cast<uint32_t>(rd) << 8 |
Dave Allison65fcc2c2014-04-28 13:45:27 -07002623 static_cast<uint32_t>(rm);
Artem Serovc257da72016-02-02 13:49:43 +00002624 Emit32Miscellaneous(0b11, 0b00, encoding);
Dave Allison65fcc2c2014-04-28 13:45:27 -07002625}
2626
2627
2628void Thumb2Assembler::movw(Register rd, uint16_t imm16, Condition cond) {
2629 CheckCondition(cond);
Vladimir Markob4536b72015-11-24 13:45:23 +00002630 // Always 32 bits, encoding T3. (Other encondings are called MOV, not MOVW.)
2631 uint32_t imm4 = (imm16 >> 12) & 15U /* 0b1111 */;
2632 uint32_t i = (imm16 >> 11) & 1U /* 0b1 */;
2633 uint32_t imm3 = (imm16 >> 8) & 7U /* 0b111 */;
2634 uint32_t imm8 = imm16 & 0xff;
2635 int32_t encoding = B31 | B30 | B29 | B28 |
2636 B25 | B22 |
2637 static_cast<uint32_t>(rd) << 8 |
2638 i << 26 |
2639 imm4 << 16 |
2640 imm3 << 12 |
2641 imm8;
2642 Emit32(encoding);
Dave Allison65fcc2c2014-04-28 13:45:27 -07002643}
2644
2645
2646void Thumb2Assembler::movt(Register rd, uint16_t imm16, Condition cond) {
2647 CheckCondition(cond);
2648 // Always 32 bits.
Andreas Gampec8ccf682014-09-29 20:07:43 -07002649 uint32_t imm4 = (imm16 >> 12) & 15U /* 0b1111 */;
2650 uint32_t i = (imm16 >> 11) & 1U /* 0b1 */;
2651 uint32_t imm3 = (imm16 >> 8) & 7U /* 0b111 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07002652 uint32_t imm8 = imm16 & 0xff;
2653 int32_t encoding = B31 | B30 | B29 | B28 |
2654 B25 | B23 | B22 |
2655 static_cast<uint32_t>(rd) << 8 |
2656 i << 26 |
2657 imm4 << 16 |
2658 imm3 << 12 |
2659 imm8;
2660 Emit32(encoding);
2661}
2662
2663
Scott Wakeling9ee23f42015-07-23 10:44:35 +01002664void Thumb2Assembler::rbit(Register rd, Register rm, Condition cond) {
2665 CHECK_NE(rd, kNoRegister);
2666 CHECK_NE(rm, kNoRegister);
2667 CheckCondition(cond);
2668 CHECK_NE(rd, PC);
2669 CHECK_NE(rm, PC);
2670 CHECK_NE(rd, SP);
2671 CHECK_NE(rm, SP);
Artem Serovc257da72016-02-02 13:49:43 +00002672 int32_t encoding =
Scott Wakeling9ee23f42015-07-23 10:44:35 +01002673 static_cast<uint32_t>(rm) << 16 |
Scott Wakeling9ee23f42015-07-23 10:44:35 +01002674 static_cast<uint32_t>(rd) << 8 |
Scott Wakeling9ee23f42015-07-23 10:44:35 +01002675 static_cast<uint32_t>(rm);
Artem Serovc257da72016-02-02 13:49:43 +00002676
2677 Emit32Miscellaneous(0b01, 0b10, encoding);
2678}
2679
2680
2681void Thumb2Assembler::EmitReverseBytes(Register rd, Register rm,
2682 uint32_t op) {
2683 CHECK_NE(rd, kNoRegister);
2684 CHECK_NE(rm, kNoRegister);
2685 CHECK_NE(rd, PC);
2686 CHECK_NE(rm, PC);
2687 CHECK_NE(rd, SP);
2688 CHECK_NE(rm, SP);
2689
2690 if (!IsHighRegister(rd) && !IsHighRegister(rm) && !force_32bit_) {
2691 uint16_t t1_op = B11 | B9 | (op << 6);
2692 int16_t encoding = t1_op |
2693 static_cast<uint16_t>(rm) << 3 |
2694 static_cast<uint16_t>(rd);
2695 Emit16Miscellaneous(encoding);
2696 } else {
2697 int32_t encoding =
2698 static_cast<uint32_t>(rm) << 16 |
2699 static_cast<uint32_t>(rd) << 8 |
2700 static_cast<uint32_t>(rm);
2701 Emit32Miscellaneous(0b01, op, encoding);
2702 }
2703}
2704
2705
2706void Thumb2Assembler::rev(Register rd, Register rm, Condition cond) {
2707 CheckCondition(cond);
2708 EmitReverseBytes(rd, rm, 0b00);
2709}
2710
2711
2712void Thumb2Assembler::rev16(Register rd, Register rm, Condition cond) {
2713 CheckCondition(cond);
2714 EmitReverseBytes(rd, rm, 0b01);
2715}
2716
2717
2718void Thumb2Assembler::revsh(Register rd, Register rm, Condition cond) {
2719 CheckCondition(cond);
2720 EmitReverseBytes(rd, rm, 0b11);
Scott Wakeling9ee23f42015-07-23 10:44:35 +01002721}
2722
2723
Dave Allison65fcc2c2014-04-28 13:45:27 -07002724void Thumb2Assembler::ldrex(Register rt, Register rn, uint16_t imm, Condition cond) {
2725 CHECK_NE(rn, kNoRegister);
2726 CHECK_NE(rt, kNoRegister);
2727 CheckCondition(cond);
Dave Allison65fcc2c2014-04-28 13:45:27 -07002728 CHECK_LT(imm, (1u << 10));
2729
2730 int32_t encoding = B31 | B30 | B29 | B27 | B22 | B20 |
2731 static_cast<uint32_t>(rn) << 16 |
2732 static_cast<uint32_t>(rt) << 12 |
2733 0xf << 8 |
2734 imm >> 2;
2735 Emit32(encoding);
2736}
2737
2738
2739void Thumb2Assembler::ldrex(Register rt, Register rn, Condition cond) {
2740 ldrex(rt, rn, 0, cond);
2741}
2742
2743
2744void Thumb2Assembler::strex(Register rd,
2745 Register rt,
2746 Register rn,
2747 uint16_t imm,
2748 Condition cond) {
2749 CHECK_NE(rn, kNoRegister);
2750 CHECK_NE(rd, kNoRegister);
2751 CHECK_NE(rt, kNoRegister);
2752 CheckCondition(cond);
2753 CHECK_LT(imm, (1u << 10));
2754
2755 int32_t encoding = B31 | B30 | B29 | B27 | B22 |
2756 static_cast<uint32_t>(rn) << 16 |
2757 static_cast<uint32_t>(rt) << 12 |
2758 static_cast<uint32_t>(rd) << 8 |
2759 imm >> 2;
2760 Emit32(encoding);
2761}
2762
2763
Calin Juravle52c48962014-12-16 17:02:57 +00002764void Thumb2Assembler::ldrexd(Register rt, Register rt2, Register rn, Condition cond) {
2765 CHECK_NE(rn, kNoRegister);
2766 CHECK_NE(rt, kNoRegister);
2767 CHECK_NE(rt2, kNoRegister);
2768 CHECK_NE(rt, rt2);
2769 CheckCondition(cond);
2770
2771 int32_t encoding = B31 | B30 | B29 | B27 | B23 | B22 | B20 |
2772 static_cast<uint32_t>(rn) << 16 |
2773 static_cast<uint32_t>(rt) << 12 |
2774 static_cast<uint32_t>(rt2) << 8 |
2775 B6 | B5 | B4 | B3 | B2 | B1 | B0;
2776 Emit32(encoding);
2777}
2778
2779
Dave Allison65fcc2c2014-04-28 13:45:27 -07002780void Thumb2Assembler::strex(Register rd,
2781 Register rt,
2782 Register rn,
2783 Condition cond) {
2784 strex(rd, rt, rn, 0, cond);
2785}
2786
2787
Calin Juravle52c48962014-12-16 17:02:57 +00002788void Thumb2Assembler::strexd(Register rd, Register rt, Register rt2, Register rn, Condition cond) {
2789 CHECK_NE(rd, kNoRegister);
2790 CHECK_NE(rn, kNoRegister);
2791 CHECK_NE(rt, kNoRegister);
2792 CHECK_NE(rt2, kNoRegister);
2793 CHECK_NE(rt, rt2);
2794 CHECK_NE(rd, rt);
2795 CHECK_NE(rd, rt2);
2796 CheckCondition(cond);
2797
2798 int32_t encoding = B31 | B30 | B29 | B27 | B23 | B22 |
2799 static_cast<uint32_t>(rn) << 16 |
2800 static_cast<uint32_t>(rt) << 12 |
2801 static_cast<uint32_t>(rt2) << 8 |
2802 B6 | B5 | B4 |
2803 static_cast<uint32_t>(rd);
2804 Emit32(encoding);
2805}
2806
2807
Dave Allison65fcc2c2014-04-28 13:45:27 -07002808void Thumb2Assembler::clrex(Condition cond) {
2809 CheckCondition(cond);
2810 int32_t encoding = B31 | B30 | B29 | B27 | B28 | B25 | B24 | B23 |
2811 B21 | B20 |
2812 0xf << 16 |
2813 B15 |
2814 0xf << 8 |
2815 B5 |
2816 0xf;
2817 Emit32(encoding);
2818}
2819
2820
2821void Thumb2Assembler::nop(Condition cond) {
2822 CheckCondition(cond);
Andreas Gampec8ccf682014-09-29 20:07:43 -07002823 uint16_t encoding = B15 | B13 | B12 |
Dave Allison65fcc2c2014-04-28 13:45:27 -07002824 B11 | B10 | B9 | B8;
Andreas Gampec8ccf682014-09-29 20:07:43 -07002825 Emit16(static_cast<int16_t>(encoding));
Dave Allison65fcc2c2014-04-28 13:45:27 -07002826}
2827
2828
2829void Thumb2Assembler::vmovsr(SRegister sn, Register rt, Condition cond) {
2830 CHECK_NE(sn, kNoSRegister);
2831 CHECK_NE(rt, kNoRegister);
2832 CHECK_NE(rt, SP);
2833 CHECK_NE(rt, PC);
2834 CheckCondition(cond);
2835 int32_t encoding = (static_cast<int32_t>(cond) << kConditionShift) |
2836 B27 | B26 | B25 |
2837 ((static_cast<int32_t>(sn) >> 1)*B16) |
2838 (static_cast<int32_t>(rt)*B12) | B11 | B9 |
2839 ((static_cast<int32_t>(sn) & 1)*B7) | B4;
2840 Emit32(encoding);
2841}
2842
2843
2844void Thumb2Assembler::vmovrs(Register rt, SRegister sn, Condition cond) {
2845 CHECK_NE(sn, kNoSRegister);
2846 CHECK_NE(rt, kNoRegister);
2847 CHECK_NE(rt, SP);
2848 CHECK_NE(rt, PC);
2849 CheckCondition(cond);
2850 int32_t encoding = (static_cast<int32_t>(cond) << kConditionShift) |
2851 B27 | B26 | B25 | B20 |
2852 ((static_cast<int32_t>(sn) >> 1)*B16) |
2853 (static_cast<int32_t>(rt)*B12) | B11 | B9 |
2854 ((static_cast<int32_t>(sn) & 1)*B7) | B4;
2855 Emit32(encoding);
2856}
2857
2858
2859void Thumb2Assembler::vmovsrr(SRegister sm, Register rt, Register rt2,
2860 Condition cond) {
2861 CHECK_NE(sm, kNoSRegister);
2862 CHECK_NE(sm, S31);
2863 CHECK_NE(rt, kNoRegister);
2864 CHECK_NE(rt, SP);
2865 CHECK_NE(rt, PC);
2866 CHECK_NE(rt2, kNoRegister);
2867 CHECK_NE(rt2, SP);
2868 CHECK_NE(rt2, PC);
2869 CheckCondition(cond);
2870 int32_t encoding = (static_cast<int32_t>(cond) << kConditionShift) |
2871 B27 | B26 | B22 |
2872 (static_cast<int32_t>(rt2)*B16) |
2873 (static_cast<int32_t>(rt)*B12) | B11 | B9 |
2874 ((static_cast<int32_t>(sm) & 1)*B5) | B4 |
2875 (static_cast<int32_t>(sm) >> 1);
2876 Emit32(encoding);
2877}
2878
2879
2880void Thumb2Assembler::vmovrrs(Register rt, Register rt2, SRegister sm,
2881 Condition cond) {
2882 CHECK_NE(sm, kNoSRegister);
2883 CHECK_NE(sm, S31);
2884 CHECK_NE(rt, kNoRegister);
2885 CHECK_NE(rt, SP);
2886 CHECK_NE(rt, PC);
2887 CHECK_NE(rt2, kNoRegister);
2888 CHECK_NE(rt2, SP);
2889 CHECK_NE(rt2, PC);
2890 CHECK_NE(rt, rt2);
2891 CheckCondition(cond);
2892 int32_t encoding = (static_cast<int32_t>(cond) << kConditionShift) |
2893 B27 | B26 | B22 | B20 |
2894 (static_cast<int32_t>(rt2)*B16) |
2895 (static_cast<int32_t>(rt)*B12) | B11 | B9 |
2896 ((static_cast<int32_t>(sm) & 1)*B5) | B4 |
2897 (static_cast<int32_t>(sm) >> 1);
2898 Emit32(encoding);
2899}
2900
2901
2902void Thumb2Assembler::vmovdrr(DRegister dm, Register rt, Register rt2,
2903 Condition cond) {
2904 CHECK_NE(dm, kNoDRegister);
2905 CHECK_NE(rt, kNoRegister);
2906 CHECK_NE(rt, SP);
2907 CHECK_NE(rt, PC);
2908 CHECK_NE(rt2, kNoRegister);
2909 CHECK_NE(rt2, SP);
2910 CHECK_NE(rt2, PC);
2911 CheckCondition(cond);
2912 int32_t encoding = (static_cast<int32_t>(cond) << kConditionShift) |
2913 B27 | B26 | B22 |
2914 (static_cast<int32_t>(rt2)*B16) |
2915 (static_cast<int32_t>(rt)*B12) | B11 | B9 | B8 |
2916 ((static_cast<int32_t>(dm) >> 4)*B5) | B4 |
2917 (static_cast<int32_t>(dm) & 0xf);
2918 Emit32(encoding);
2919}
2920
2921
2922void Thumb2Assembler::vmovrrd(Register rt, Register rt2, DRegister dm,
2923 Condition cond) {
2924 CHECK_NE(dm, kNoDRegister);
2925 CHECK_NE(rt, kNoRegister);
2926 CHECK_NE(rt, SP);
2927 CHECK_NE(rt, PC);
2928 CHECK_NE(rt2, kNoRegister);
2929 CHECK_NE(rt2, SP);
2930 CHECK_NE(rt2, PC);
2931 CHECK_NE(rt, rt2);
2932 CheckCondition(cond);
2933 int32_t encoding = (static_cast<int32_t>(cond) << kConditionShift) |
2934 B27 | B26 | B22 | B20 |
2935 (static_cast<int32_t>(rt2)*B16) |
2936 (static_cast<int32_t>(rt)*B12) | B11 | B9 | B8 |
2937 ((static_cast<int32_t>(dm) >> 4)*B5) | B4 |
2938 (static_cast<int32_t>(dm) & 0xf);
2939 Emit32(encoding);
2940}
2941
2942
2943void Thumb2Assembler::vldrs(SRegister sd, const Address& ad, Condition cond) {
2944 const Address& addr = static_cast<const Address&>(ad);
2945 CHECK_NE(sd, kNoSRegister);
2946 CheckCondition(cond);
2947 int32_t encoding = (static_cast<int32_t>(cond) << kConditionShift) |
2948 B27 | B26 | B24 | B20 |
2949 ((static_cast<int32_t>(sd) & 1)*B22) |
2950 ((static_cast<int32_t>(sd) >> 1)*B12) |
2951 B11 | B9 | addr.vencoding();
2952 Emit32(encoding);
2953}
2954
2955
2956void Thumb2Assembler::vstrs(SRegister sd, const Address& ad, Condition cond) {
2957 const Address& addr = static_cast<const Address&>(ad);
2958 CHECK_NE(static_cast<Register>(addr.encodingArm() & (0xf << kRnShift)), PC);
2959 CHECK_NE(sd, kNoSRegister);
2960 CheckCondition(cond);
2961 int32_t encoding = (static_cast<int32_t>(cond) << kConditionShift) |
2962 B27 | B26 | B24 |
2963 ((static_cast<int32_t>(sd) & 1)*B22) |
2964 ((static_cast<int32_t>(sd) >> 1)*B12) |
2965 B11 | B9 | addr.vencoding();
2966 Emit32(encoding);
2967}
2968
2969
2970void Thumb2Assembler::vldrd(DRegister dd, const Address& ad, Condition cond) {
2971 const Address& addr = static_cast<const Address&>(ad);
2972 CHECK_NE(dd, kNoDRegister);
2973 CheckCondition(cond);
2974 int32_t encoding = (static_cast<int32_t>(cond) << kConditionShift) |
2975 B27 | B26 | B24 | B20 |
2976 ((static_cast<int32_t>(dd) >> 4)*B22) |
2977 ((static_cast<int32_t>(dd) & 0xf)*B12) |
2978 B11 | B9 | B8 | addr.vencoding();
2979 Emit32(encoding);
2980}
2981
2982
2983void Thumb2Assembler::vstrd(DRegister dd, const Address& ad, Condition cond) {
2984 const Address& addr = static_cast<const Address&>(ad);
2985 CHECK_NE(static_cast<Register>(addr.encodingArm() & (0xf << kRnShift)), PC);
2986 CHECK_NE(dd, kNoDRegister);
2987 CheckCondition(cond);
2988 int32_t encoding = (static_cast<int32_t>(cond) << kConditionShift) |
2989 B27 | B26 | B24 |
2990 ((static_cast<int32_t>(dd) >> 4)*B22) |
2991 ((static_cast<int32_t>(dd) & 0xf)*B12) |
2992 B11 | B9 | B8 | addr.vencoding();
2993 Emit32(encoding);
2994}
2995
2996
2997void Thumb2Assembler::vpushs(SRegister reg, int nregs, Condition cond) {
2998 EmitVPushPop(static_cast<uint32_t>(reg), nregs, true, false, cond);
2999}
3000
3001
3002void Thumb2Assembler::vpushd(DRegister reg, int nregs, Condition cond) {
3003 EmitVPushPop(static_cast<uint32_t>(reg), nregs, true, true, cond);
3004}
3005
3006
3007void Thumb2Assembler::vpops(SRegister reg, int nregs, Condition cond) {
3008 EmitVPushPop(static_cast<uint32_t>(reg), nregs, false, false, cond);
3009}
3010
3011
3012void Thumb2Assembler::vpopd(DRegister reg, int nregs, Condition cond) {
3013 EmitVPushPop(static_cast<uint32_t>(reg), nregs, false, true, cond);
3014}
3015
3016
3017void Thumb2Assembler::EmitVPushPop(uint32_t reg, int nregs, bool push, bool dbl, Condition cond) {
3018 CheckCondition(cond);
3019
3020 uint32_t D;
3021 uint32_t Vd;
3022 if (dbl) {
3023 // Encoded as D:Vd.
3024 D = (reg >> 4) & 1;
Andreas Gampec8ccf682014-09-29 20:07:43 -07003025 Vd = reg & 15U /* 0b1111 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07003026 } else {
3027 // Encoded as Vd:D.
3028 D = reg & 1;
Andreas Gampec8ccf682014-09-29 20:07:43 -07003029 Vd = (reg >> 1) & 15U /* 0b1111 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07003030 }
3031 int32_t encoding = B27 | B26 | B21 | B19 | B18 | B16 |
3032 B11 | B9 |
3033 (dbl ? B8 : 0) |
3034 (push ? B24 : (B23 | B20)) |
Andreas Gampec8ccf682014-09-29 20:07:43 -07003035 14U /* 0b1110 */ << 28 |
Dave Allison65fcc2c2014-04-28 13:45:27 -07003036 nregs << (dbl ? 1 : 0) |
3037 D << 22 |
3038 Vd << 12;
3039 Emit32(encoding);
3040}
3041
3042
3043void Thumb2Assembler::EmitVFPsss(Condition cond, int32_t opcode,
3044 SRegister sd, SRegister sn, SRegister sm) {
3045 CHECK_NE(sd, kNoSRegister);
3046 CHECK_NE(sn, kNoSRegister);
3047 CHECK_NE(sm, kNoSRegister);
3048 CheckCondition(cond);
3049 int32_t encoding = (static_cast<int32_t>(cond) << kConditionShift) |
3050 B27 | B26 | B25 | B11 | B9 | opcode |
3051 ((static_cast<int32_t>(sd) & 1)*B22) |
3052 ((static_cast<int32_t>(sn) >> 1)*B16) |
3053 ((static_cast<int32_t>(sd) >> 1)*B12) |
3054 ((static_cast<int32_t>(sn) & 1)*B7) |
3055 ((static_cast<int32_t>(sm) & 1)*B5) |
3056 (static_cast<int32_t>(sm) >> 1);
3057 Emit32(encoding);
3058}
3059
3060
3061void Thumb2Assembler::EmitVFPddd(Condition cond, int32_t opcode,
3062 DRegister dd, DRegister dn, DRegister dm) {
3063 CHECK_NE(dd, kNoDRegister);
3064 CHECK_NE(dn, kNoDRegister);
3065 CHECK_NE(dm, kNoDRegister);
3066 CheckCondition(cond);
3067 int32_t encoding = (static_cast<int32_t>(cond) << kConditionShift) |
3068 B27 | B26 | B25 | B11 | B9 | B8 | opcode |
3069 ((static_cast<int32_t>(dd) >> 4)*B22) |
3070 ((static_cast<int32_t>(dn) & 0xf)*B16) |
3071 ((static_cast<int32_t>(dd) & 0xf)*B12) |
3072 ((static_cast<int32_t>(dn) >> 4)*B7) |
3073 ((static_cast<int32_t>(dm) >> 4)*B5) |
3074 (static_cast<int32_t>(dm) & 0xf);
3075 Emit32(encoding);
3076}
3077
3078
3079void Thumb2Assembler::EmitVFPsd(Condition cond, int32_t opcode,
3080 SRegister sd, DRegister dm) {
3081 CHECK_NE(sd, kNoSRegister);
3082 CHECK_NE(dm, kNoDRegister);
3083 CheckCondition(cond);
3084 int32_t encoding = (static_cast<int32_t>(cond) << kConditionShift) |
3085 B27 | B26 | B25 | B11 | B9 | opcode |
3086 ((static_cast<int32_t>(sd) & 1)*B22) |
3087 ((static_cast<int32_t>(sd) >> 1)*B12) |
3088 ((static_cast<int32_t>(dm) >> 4)*B5) |
3089 (static_cast<int32_t>(dm) & 0xf);
3090 Emit32(encoding);
3091}
3092
3093
3094void Thumb2Assembler::EmitVFPds(Condition cond, int32_t opcode,
3095 DRegister dd, SRegister sm) {
3096 CHECK_NE(dd, kNoDRegister);
3097 CHECK_NE(sm, kNoSRegister);
3098 CheckCondition(cond);
3099 int32_t encoding = (static_cast<int32_t>(cond) << kConditionShift) |
3100 B27 | B26 | B25 | B11 | B9 | opcode |
3101 ((static_cast<int32_t>(dd) >> 4)*B22) |
3102 ((static_cast<int32_t>(dd) & 0xf)*B12) |
3103 ((static_cast<int32_t>(sm) & 1)*B5) |
3104 (static_cast<int32_t>(sm) >> 1);
3105 Emit32(encoding);
3106}
3107
3108
3109void Thumb2Assembler::vmstat(Condition cond) { // VMRS APSR_nzcv, FPSCR.
Calin Juravleddb7df22014-11-25 20:56:51 +00003110 CHECK_NE(cond, kNoCondition);
Dave Allison65fcc2c2014-04-28 13:45:27 -07003111 CheckCondition(cond);
Calin Juravleddb7df22014-11-25 20:56:51 +00003112 int32_t encoding = (static_cast<int32_t>(cond) << kConditionShift) |
3113 B27 | B26 | B25 | B23 | B22 | B21 | B20 | B16 |
3114 (static_cast<int32_t>(PC)*B12) |
3115 B11 | B9 | B4;
3116 Emit32(encoding);
Dave Allison65fcc2c2014-04-28 13:45:27 -07003117}
3118
xueliang.zhonge652c122016-06-13 14:42:27 +01003119void Thumb2Assembler::vcntd(DRegister dd, DRegister dm) {
3120 uint32_t encoding = (B31 | B30 | B29 | B28 | B27 | B26 | B25 | B24 | B23 | B21 | B20) |
3121 ((static_cast<int32_t>(dd) >> 4) * B22) |
3122 ((static_cast<uint32_t>(dd) & 0xf) * B12) |
3123 (B10 | B8) |
3124 ((static_cast<int32_t>(dm) >> 4) * B5) |
3125 (static_cast<uint32_t>(dm) & 0xf);
3126
3127 Emit32(encoding);
3128}
3129
3130void Thumb2Assembler::vpaddld(DRegister dd, DRegister dm, int32_t size, bool is_unsigned) {
3131 CHECK(size == 8 || size == 16 || size == 32) << size;
3132 uint32_t encoding = (B31 | B30 | B29 | B28 | B27 | B26 | B25 | B24 | B23 | B21 | B20) |
3133 ((static_cast<uint32_t>(size >> 4) & 0x3) * B18) |
3134 ((static_cast<int32_t>(dd) >> 4) * B22) |
3135 ((static_cast<uint32_t>(dd) & 0xf) * B12) |
3136 (B9) |
3137 (is_unsigned ? B7 : 0) |
3138 ((static_cast<int32_t>(dm) >> 4) * B5) |
3139 (static_cast<uint32_t>(dm) & 0xf);
3140
3141 Emit32(encoding);
3142}
Dave Allison65fcc2c2014-04-28 13:45:27 -07003143
3144void Thumb2Assembler::svc(uint32_t imm8) {
Andreas Gampeab1eb0d2015-02-13 19:23:55 -08003145 CHECK(IsUint<8>(imm8)) << imm8;
Dave Allison65fcc2c2014-04-28 13:45:27 -07003146 int16_t encoding = B15 | B14 | B12 |
3147 B11 | B10 | B9 | B8 |
3148 imm8;
3149 Emit16(encoding);
3150}
3151
3152
3153void Thumb2Assembler::bkpt(uint16_t imm8) {
Andreas Gampeab1eb0d2015-02-13 19:23:55 -08003154 CHECK(IsUint<8>(imm8)) << imm8;
Dave Allison65fcc2c2014-04-28 13:45:27 -07003155 int16_t encoding = B15 | B13 | B12 |
3156 B11 | B10 | B9 |
3157 imm8;
3158 Emit16(encoding);
3159}
3160
3161// Convert the given IT state to a mask bit given bit 0 of the first
3162// condition and a shift position.
3163static uint8_t ToItMask(ItState s, uint8_t firstcond0, uint8_t shift) {
3164 switch (s) {
3165 case kItOmitted: return 1 << shift;
3166 case kItThen: return firstcond0 << shift;
3167 case kItElse: return !firstcond0 << shift;
3168 }
3169 return 0;
3170}
3171
3172
3173// Set the IT condition in the given position for the given state. This is used
3174// to check that conditional instructions match the preceding IT statement.
3175void Thumb2Assembler::SetItCondition(ItState s, Condition cond, uint8_t index) {
3176 switch (s) {
3177 case kItOmitted: it_conditions_[index] = AL; break;
3178 case kItThen: it_conditions_[index] = cond; break;
3179 case kItElse:
3180 it_conditions_[index] = static_cast<Condition>(static_cast<uint8_t>(cond) ^ 1);
3181 break;
3182 }
3183}
3184
3185
3186void Thumb2Assembler::it(Condition firstcond, ItState i1, ItState i2, ItState i3) {
3187 CheckCondition(AL); // Not allowed in IT block.
3188 uint8_t firstcond0 = static_cast<uint8_t>(firstcond) & 1;
3189
3190 // All conditions to AL.
3191 for (uint8_t i = 0; i < 4; ++i) {
3192 it_conditions_[i] = AL;
3193 }
3194
3195 SetItCondition(kItThen, firstcond, 0);
3196 uint8_t mask = ToItMask(i1, firstcond0, 3);
3197 SetItCondition(i1, firstcond, 1);
3198
3199 if (i1 != kItOmitted) {
3200 mask |= ToItMask(i2, firstcond0, 2);
3201 SetItCondition(i2, firstcond, 2);
3202 if (i2 != kItOmitted) {
3203 mask |= ToItMask(i3, firstcond0, 1);
3204 SetItCondition(i3, firstcond, 3);
3205 if (i3 != kItOmitted) {
Andreas Gampec8ccf682014-09-29 20:07:43 -07003206 mask |= 1U /* 0b0001 */;
Dave Allison65fcc2c2014-04-28 13:45:27 -07003207 }
3208 }
3209 }
3210
3211 // Start at first condition.
3212 it_cond_index_ = 0;
3213 next_condition_ = it_conditions_[0];
3214 uint16_t encoding = B15 | B13 | B12 |
3215 B11 | B10 | B9 | B8 |
3216 firstcond << 4 |
3217 mask;
3218 Emit16(encoding);
3219}
3220
3221
3222void Thumb2Assembler::cbz(Register rn, Label* label) {
3223 CheckCondition(AL);
3224 if (label->IsBound()) {
3225 LOG(FATAL) << "cbz can only be used to branch forwards";
Vladimir Markoe8469c12014-11-26 18:09:30 +00003226 UNREACHABLE();
Nicolas Geoffrayd56376c2015-05-21 12:32:34 +00003227 } else if (IsHighRegister(rn)) {
3228 LOG(FATAL) << "cbz can only be used with low registers";
3229 UNREACHABLE();
Dave Allison65fcc2c2014-04-28 13:45:27 -07003230 } else {
3231 uint16_t branchid = EmitCompareAndBranch(rn, static_cast<uint16_t>(label->position_), false);
3232 label->LinkTo(branchid);
3233 }
3234}
3235
3236
3237void Thumb2Assembler::cbnz(Register rn, Label* label) {
3238 CheckCondition(AL);
3239 if (label->IsBound()) {
3240 LOG(FATAL) << "cbnz can only be used to branch forwards";
Vladimir Markoe8469c12014-11-26 18:09:30 +00003241 UNREACHABLE();
Nicolas Geoffrayd56376c2015-05-21 12:32:34 +00003242 } else if (IsHighRegister(rn)) {
3243 LOG(FATAL) << "cbnz can only be used with low registers";
3244 UNREACHABLE();
Dave Allison65fcc2c2014-04-28 13:45:27 -07003245 } else {
3246 uint16_t branchid = EmitCompareAndBranch(rn, static_cast<uint16_t>(label->position_), true);
3247 label->LinkTo(branchid);
3248 }
3249}
3250
3251
3252void Thumb2Assembler::blx(Register rm, Condition cond) {
3253 CHECK_NE(rm, kNoRegister);
3254 CheckCondition(cond);
3255 int16_t encoding = B14 | B10 | B9 | B8 | B7 | static_cast<int16_t>(rm) << 3;
3256 Emit16(encoding);
3257}
3258
3259
3260void Thumb2Assembler::bx(Register rm, Condition cond) {
3261 CHECK_NE(rm, kNoRegister);
3262 CheckCondition(cond);
3263 int16_t encoding = B14 | B10 | B9 | B8 | static_cast<int16_t>(rm) << 3;
3264 Emit16(encoding);
3265}
3266
3267
3268void Thumb2Assembler::Push(Register rd, Condition cond) {
3269 str(rd, Address(SP, -kRegisterSize, Address::PreIndex), cond);
3270}
3271
3272
3273void Thumb2Assembler::Pop(Register rd, Condition cond) {
3274 ldr(rd, Address(SP, kRegisterSize, Address::PostIndex), cond);
3275}
3276
3277
3278void Thumb2Assembler::PushList(RegList regs, Condition cond) {
3279 stm(DB_W, SP, regs, cond);
3280}
3281
3282
3283void Thumb2Assembler::PopList(RegList regs, Condition cond) {
3284 ldm(IA_W, SP, regs, cond);
3285}
3286
3287
3288void Thumb2Assembler::Mov(Register rd, Register rm, Condition cond) {
3289 if (cond != AL || rd != rm) {
3290 mov(rd, ShifterOperand(rm), cond);
3291 }
3292}
3293
3294
Dave Allison65fcc2c2014-04-28 13:45:27 -07003295void Thumb2Assembler::Bind(Label* label) {
Vladimir Markocf93a5c2015-06-16 11:33:24 +00003296 BindLabel(label, buffer_.Size());
Dave Allison65fcc2c2014-04-28 13:45:27 -07003297}
3298
3299
3300void Thumb2Assembler::Lsl(Register rd, Register rm, uint32_t shift_imm,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01003301 Condition cond, SetCc set_cc) {
Calin Juravle9aec02f2014-11-18 23:06:35 +00003302 CHECK_LE(shift_imm, 31u);
Dave Allison45fdb932014-06-25 12:37:10 -07003303 CheckCondition(cond);
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01003304 EmitShift(rd, rm, LSL, shift_imm, cond, set_cc);
Dave Allison65fcc2c2014-04-28 13:45:27 -07003305}
3306
3307
3308void Thumb2Assembler::Lsr(Register rd, Register rm, uint32_t shift_imm,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01003309 Condition cond, SetCc set_cc) {
Calin Juravle9aec02f2014-11-18 23:06:35 +00003310 CHECK(1u <= shift_imm && shift_imm <= 32u);
Dave Allison65fcc2c2014-04-28 13:45:27 -07003311 if (shift_imm == 32) shift_imm = 0; // Comply to UAL syntax.
Dave Allison45fdb932014-06-25 12:37:10 -07003312 CheckCondition(cond);
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01003313 EmitShift(rd, rm, LSR, shift_imm, cond, set_cc);
Dave Allison65fcc2c2014-04-28 13:45:27 -07003314}
3315
3316
3317void Thumb2Assembler::Asr(Register rd, Register rm, uint32_t shift_imm,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01003318 Condition cond, SetCc set_cc) {
Calin Juravle9aec02f2014-11-18 23:06:35 +00003319 CHECK(1u <= shift_imm && shift_imm <= 32u);
Dave Allison65fcc2c2014-04-28 13:45:27 -07003320 if (shift_imm == 32) shift_imm = 0; // Comply to UAL syntax.
Dave Allison45fdb932014-06-25 12:37:10 -07003321 CheckCondition(cond);
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01003322 EmitShift(rd, rm, ASR, shift_imm, cond, set_cc);
Dave Allison65fcc2c2014-04-28 13:45:27 -07003323}
3324
3325
3326void Thumb2Assembler::Ror(Register rd, Register rm, uint32_t shift_imm,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01003327 Condition cond, SetCc set_cc) {
Calin Juravle9aec02f2014-11-18 23:06:35 +00003328 CHECK(1u <= shift_imm && shift_imm <= 31u);
Dave Allison45fdb932014-06-25 12:37:10 -07003329 CheckCondition(cond);
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01003330 EmitShift(rd, rm, ROR, shift_imm, cond, set_cc);
Dave Allison65fcc2c2014-04-28 13:45:27 -07003331}
3332
3333
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01003334void Thumb2Assembler::Rrx(Register rd, Register rm, Condition cond, SetCc set_cc) {
Dave Allison45fdb932014-06-25 12:37:10 -07003335 CheckCondition(cond);
Vladimir Markof9d741e2015-11-20 15:08:11 +00003336 EmitShift(rd, rm, RRX, 0, cond, set_cc);
Dave Allison45fdb932014-06-25 12:37:10 -07003337}
3338
3339
3340void Thumb2Assembler::Lsl(Register rd, Register rm, Register rn,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01003341 Condition cond, SetCc set_cc) {
Dave Allison45fdb932014-06-25 12:37:10 -07003342 CheckCondition(cond);
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01003343 EmitShift(rd, rm, LSL, rn, cond, set_cc);
Dave Allison45fdb932014-06-25 12:37:10 -07003344}
3345
3346
3347void Thumb2Assembler::Lsr(Register rd, Register rm, Register rn,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01003348 Condition cond, SetCc set_cc) {
Dave Allison45fdb932014-06-25 12:37:10 -07003349 CheckCondition(cond);
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01003350 EmitShift(rd, rm, LSR, rn, cond, set_cc);
Dave Allison45fdb932014-06-25 12:37:10 -07003351}
3352
3353
3354void Thumb2Assembler::Asr(Register rd, Register rm, Register rn,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01003355 Condition cond, SetCc set_cc) {
Dave Allison45fdb932014-06-25 12:37:10 -07003356 CheckCondition(cond);
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01003357 EmitShift(rd, rm, ASR, rn, cond, set_cc);
Dave Allison45fdb932014-06-25 12:37:10 -07003358}
3359
3360
3361void Thumb2Assembler::Ror(Register rd, Register rm, Register rn,
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01003362 Condition cond, SetCc set_cc) {
Dave Allison45fdb932014-06-25 12:37:10 -07003363 CheckCondition(cond);
Vladimir Marko73cf0fb2015-07-30 15:07:22 +01003364 EmitShift(rd, rm, ROR, rn, cond, set_cc);
Dave Allison65fcc2c2014-04-28 13:45:27 -07003365}
3366
3367
3368int32_t Thumb2Assembler::EncodeBranchOffset(int32_t offset, int32_t inst) {
3369 // The offset is off by 4 due to the way the ARM CPUs read PC.
3370 offset -= 4;
3371 offset >>= 1;
3372
3373 uint32_t value = 0;
3374 // There are two different encodings depending on the value of bit 12. In one case
3375 // intermediate values are calculated using the sign bit.
3376 if ((inst & B12) == B12) {
3377 // 25 bits of offset.
3378 uint32_t signbit = (offset >> 31) & 0x1;
3379 uint32_t i1 = (offset >> 22) & 0x1;
3380 uint32_t i2 = (offset >> 21) & 0x1;
3381 uint32_t imm10 = (offset >> 11) & 0x03ff;
3382 uint32_t imm11 = offset & 0x07ff;
3383 uint32_t j1 = (i1 ^ signbit) ? 0 : 1;
3384 uint32_t j2 = (i2 ^ signbit) ? 0 : 1;
3385 value = (signbit << 26) | (j1 << 13) | (j2 << 11) | (imm10 << 16) |
3386 imm11;
3387 // Remove the offset from the current encoding.
3388 inst &= ~(0x3ff << 16 | 0x7ff);
3389 } else {
3390 uint32_t signbit = (offset >> 31) & 0x1;
3391 uint32_t imm6 = (offset >> 11) & 0x03f;
3392 uint32_t imm11 = offset & 0x07ff;
3393 uint32_t j1 = (offset >> 19) & 1;
3394 uint32_t j2 = (offset >> 17) & 1;
3395 value = (signbit << 26) | (j1 << 13) | (j2 << 11) | (imm6 << 16) |
3396 imm11;
3397 // Remove the offset from the current encoding.
3398 inst &= ~(0x3f << 16 | 0x7ff);
3399 }
3400 // Mask out offset bits in current instruction.
3401 inst &= ~(B26 | B13 | B11);
3402 inst |= value;
3403 return inst;
3404}
3405
3406
3407int Thumb2Assembler::DecodeBranchOffset(int32_t instr) {
3408 int32_t imm32;
3409 if ((instr & B12) == B12) {
3410 uint32_t S = (instr >> 26) & 1;
3411 uint32_t J2 = (instr >> 11) & 1;
3412 uint32_t J1 = (instr >> 13) & 1;
3413 uint32_t imm10 = (instr >> 16) & 0x3FF;
3414 uint32_t imm11 = instr & 0x7FF;
3415
3416 uint32_t I1 = ~(J1 ^ S) & 1;
3417 uint32_t I2 = ~(J2 ^ S) & 1;
3418 imm32 = (S << 24) | (I1 << 23) | (I2 << 22) | (imm10 << 12) | (imm11 << 1);
3419 imm32 = (imm32 << 8) >> 8; // sign extend 24 bit immediate.
3420 } else {
3421 uint32_t S = (instr >> 26) & 1;
3422 uint32_t J2 = (instr >> 11) & 1;
3423 uint32_t J1 = (instr >> 13) & 1;
3424 uint32_t imm6 = (instr >> 16) & 0x3F;
3425 uint32_t imm11 = instr & 0x7FF;
3426
3427 imm32 = (S << 20) | (J2 << 19) | (J1 << 18) | (imm6 << 12) | (imm11 << 1);
3428 imm32 = (imm32 << 11) >> 11; // sign extend 21 bit immediate.
3429 }
3430 imm32 += 4;
3431 return imm32;
3432}
3433
Vladimir Markocf93a5c2015-06-16 11:33:24 +00003434uint32_t Thumb2Assembler::GetAdjustedPosition(uint32_t old_position) {
3435 // We can reconstruct the adjustment by going through all the fixups from the beginning
3436 // up to the old_position. Since we expect AdjustedPosition() to be called in a loop
3437 // with increasing old_position, we can use the data from last AdjustedPosition() to
3438 // continue where we left off and the whole loop should be O(m+n) where m is the number
3439 // of positions to adjust and n is the number of fixups.
3440 if (old_position < last_old_position_) {
3441 last_position_adjustment_ = 0u;
3442 last_old_position_ = 0u;
3443 last_fixup_id_ = 0u;
3444 }
3445 while (last_fixup_id_ != fixups_.size()) {
3446 Fixup* fixup = GetFixup(last_fixup_id_);
3447 if (fixup->GetLocation() >= old_position + last_position_adjustment_) {
3448 break;
3449 }
3450 if (fixup->GetSize() != fixup->GetOriginalSize()) {
3451 last_position_adjustment_ += fixup->GetSizeInBytes() - fixup->GetOriginalSizeInBytes();
3452 }
3453 ++last_fixup_id_;
3454 }
3455 last_old_position_ = old_position;
3456 return old_position + last_position_adjustment_;
3457}
3458
3459Literal* Thumb2Assembler::NewLiteral(size_t size, const uint8_t* data) {
3460 DCHECK(size == 4u || size == 8u) << size;
3461 literals_.emplace_back(size, data);
3462 return &literals_.back();
3463}
3464
3465void Thumb2Assembler::LoadLiteral(Register rt, Literal* literal) {
3466 DCHECK_EQ(literal->GetSize(), 4u);
3467 DCHECK(!literal->GetLabel()->IsBound());
3468 bool use32bit = IsForced32Bit() || IsHighRegister(rt);
3469 uint32_t location = buffer_.Size();
3470 Fixup::Size size = use32bit ? Fixup::kLiteral4KiB : Fixup::kLiteral1KiB;
3471 FixupId fixup_id = AddFixup(Fixup::LoadNarrowLiteral(location, rt, size));
3472 Emit16(static_cast<uint16_t>(literal->GetLabel()->position_));
3473 literal->GetLabel()->LinkTo(fixup_id);
3474 if (use32bit) {
3475 Emit16(0);
3476 }
3477 DCHECK_EQ(location + GetFixup(fixup_id)->GetSizeInBytes(), buffer_.Size());
3478}
3479
3480void Thumb2Assembler::LoadLiteral(Register rt, Register rt2, Literal* literal) {
3481 DCHECK_EQ(literal->GetSize(), 8u);
3482 DCHECK(!literal->GetLabel()->IsBound());
3483 uint32_t location = buffer_.Size();
3484 FixupId fixup_id =
3485 AddFixup(Fixup::LoadWideLiteral(location, rt, rt2, Fixup::kLongOrFPLiteral1KiB));
3486 Emit16(static_cast<uint16_t>(literal->GetLabel()->position_));
3487 literal->GetLabel()->LinkTo(fixup_id);
3488 Emit16(0);
3489 DCHECK_EQ(location + GetFixup(fixup_id)->GetSizeInBytes(), buffer_.Size());
3490}
3491
3492void Thumb2Assembler::LoadLiteral(SRegister sd, Literal* literal) {
3493 DCHECK_EQ(literal->GetSize(), 4u);
3494 DCHECK(!literal->GetLabel()->IsBound());
3495 uint32_t location = buffer_.Size();
3496 FixupId fixup_id = AddFixup(Fixup::LoadSingleLiteral(location, sd, Fixup::kLongOrFPLiteral1KiB));
3497 Emit16(static_cast<uint16_t>(literal->GetLabel()->position_));
3498 literal->GetLabel()->LinkTo(fixup_id);
3499 Emit16(0);
3500 DCHECK_EQ(location + GetFixup(fixup_id)->GetSizeInBytes(), buffer_.Size());
3501}
3502
3503void Thumb2Assembler::LoadLiteral(DRegister dd, Literal* literal) {
3504 DCHECK_EQ(literal->GetSize(), 8u);
3505 DCHECK(!literal->GetLabel()->IsBound());
3506 uint32_t location = buffer_.Size();
3507 FixupId fixup_id = AddFixup(Fixup::LoadDoubleLiteral(location, dd, Fixup::kLongOrFPLiteral1KiB));
3508 Emit16(static_cast<uint16_t>(literal->GetLabel()->position_));
3509 literal->GetLabel()->LinkTo(fixup_id);
3510 Emit16(0);
3511 DCHECK_EQ(location + GetFixup(fixup_id)->GetSizeInBytes(), buffer_.Size());
3512}
Dave Allison65fcc2c2014-04-28 13:45:27 -07003513
Dave Allison65fcc2c2014-04-28 13:45:27 -07003514
3515void Thumb2Assembler::AddConstant(Register rd, Register rn, int32_t value,
Vladimir Marko449b1092015-09-08 12:16:45 +01003516 Condition cond, SetCc set_cc) {
3517 if (value == 0 && set_cc != kCcSet) {
Dave Allison65fcc2c2014-04-28 13:45:27 -07003518 if (rd != rn) {
3519 mov(rd, ShifterOperand(rn), cond);
3520 }
3521 return;
3522 }
3523 // We prefer to select the shorter code sequence rather than selecting add for
3524 // positive values and sub for negatives ones, which would slightly improve
3525 // the readability of generated code for some constants.
3526 ShifterOperand shifter_op;
Vladimir Markof5c09c32015-12-17 12:08:08 +00003527 if (ShifterOperandCanHold(rd, rn, ADD, value, set_cc, &shifter_op)) {
Vladimir Marko449b1092015-09-08 12:16:45 +01003528 add(rd, rn, shifter_op, cond, set_cc);
Vladimir Markof5c09c32015-12-17 12:08:08 +00003529 } else if (ShifterOperandCanHold(rd, rn, SUB, -value, set_cc, &shifter_op)) {
Vladimir Marko449b1092015-09-08 12:16:45 +01003530 sub(rd, rn, shifter_op, cond, set_cc);
Dave Allison65fcc2c2014-04-28 13:45:27 -07003531 } else {
3532 CHECK(rn != IP);
Vladimir Markof5c09c32015-12-17 12:08:08 +00003533 // If rd != rn, use rd as temp. This alows 16-bit ADD/SUB in more situations than using IP.
3534 Register temp = (rd != rn) ? rd : IP;
Vladimir Markoac6ac102015-12-17 12:14:00 +00003535 if (ShifterOperandCanHold(temp, kNoRegister, MVN, ~value, kCcKeep, &shifter_op)) {
Vladimir Markof5c09c32015-12-17 12:08:08 +00003536 mvn(temp, shifter_op, cond, kCcKeep);
3537 add(rd, rn, ShifterOperand(temp), cond, set_cc);
Vladimir Markoac6ac102015-12-17 12:14:00 +00003538 } else if (ShifterOperandCanHold(temp, kNoRegister, MVN, ~(-value), kCcKeep, &shifter_op)) {
Vladimir Markof5c09c32015-12-17 12:08:08 +00003539 mvn(temp, shifter_op, cond, kCcKeep);
3540 sub(rd, rn, ShifterOperand(temp), cond, set_cc);
3541 } else if (High16Bits(-value) == 0) {
3542 movw(temp, Low16Bits(-value), cond);
3543 sub(rd, rn, ShifterOperand(temp), cond, set_cc);
Dave Allison65fcc2c2014-04-28 13:45:27 -07003544 } else {
Vladimir Markof5c09c32015-12-17 12:08:08 +00003545 movw(temp, Low16Bits(value), cond);
Dave Allison65fcc2c2014-04-28 13:45:27 -07003546 uint16_t value_high = High16Bits(value);
3547 if (value_high != 0) {
Vladimir Markof5c09c32015-12-17 12:08:08 +00003548 movt(temp, value_high, cond);
Dave Allison65fcc2c2014-04-28 13:45:27 -07003549 }
Vladimir Markof5c09c32015-12-17 12:08:08 +00003550 add(rd, rn, ShifterOperand(temp), cond, set_cc);
Dave Allison65fcc2c2014-04-28 13:45:27 -07003551 }
3552 }
3553}
3554
Andreas Gampe7cffc3b2015-10-19 21:31:53 -07003555void Thumb2Assembler::CmpConstant(Register rn, int32_t value, Condition cond) {
Vladimir Markoac6ac102015-12-17 12:14:00 +00003556 // We prefer to select the shorter code sequence rather than using plain cmp and cmn
3557 // which would slightly improve the readability of generated code for some constants.
Andreas Gampe7cffc3b2015-10-19 21:31:53 -07003558 ShifterOperand shifter_op;
Vladimir Markof5c09c32015-12-17 12:08:08 +00003559 if (ShifterOperandCanHold(kNoRegister, rn, CMP, value, kCcSet, &shifter_op)) {
Andreas Gampe7cffc3b2015-10-19 21:31:53 -07003560 cmp(rn, shifter_op, cond);
Vladimir Markoac6ac102015-12-17 12:14:00 +00003561 } else if (ShifterOperandCanHold(kNoRegister, rn, CMN, -value, kCcSet, &shifter_op)) {
Andreas Gampe7cffc3b2015-10-19 21:31:53 -07003562 cmn(rn, shifter_op, cond);
3563 } else {
3564 CHECK(rn != IP);
Vladimir Markoac6ac102015-12-17 12:14:00 +00003565 if (ShifterOperandCanHold(IP, kNoRegister, MVN, ~value, kCcKeep, &shifter_op)) {
3566 mvn(IP, shifter_op, cond, kCcKeep);
3567 cmp(rn, ShifterOperand(IP), cond);
3568 } else if (ShifterOperandCanHold(IP, kNoRegister, MVN, ~(-value), kCcKeep, &shifter_op)) {
3569 mvn(IP, shifter_op, cond, kCcKeep);
3570 cmn(rn, ShifterOperand(IP), cond);
3571 } else if (High16Bits(-value) == 0) {
3572 movw(IP, Low16Bits(-value), cond);
3573 cmn(rn, ShifterOperand(IP), cond);
3574 } else {
3575 movw(IP, Low16Bits(value), cond);
3576 uint16_t value_high = High16Bits(value);
3577 if (value_high != 0) {
3578 movt(IP, value_high, cond);
3579 }
3580 cmp(rn, ShifterOperand(IP), cond);
Andreas Gampe7cffc3b2015-10-19 21:31:53 -07003581 }
Andreas Gampe7cffc3b2015-10-19 21:31:53 -07003582 }
3583}
Nicolas Geoffray3bcc8ea2014-11-28 15:00:02 +00003584
Dave Allison65fcc2c2014-04-28 13:45:27 -07003585void Thumb2Assembler::LoadImmediate(Register rd, int32_t value, Condition cond) {
3586 ShifterOperand shifter_op;
Nicolas Geoffray3bcc8ea2014-11-28 15:00:02 +00003587 if (ShifterOperandCanHold(rd, R0, MOV, value, &shifter_op)) {
Dave Allison65fcc2c2014-04-28 13:45:27 -07003588 mov(rd, shifter_op, cond);
Nicolas Geoffray3bcc8ea2014-11-28 15:00:02 +00003589 } else if (ShifterOperandCanHold(rd, R0, MVN, ~value, &shifter_op)) {
Dave Allison65fcc2c2014-04-28 13:45:27 -07003590 mvn(rd, shifter_op, cond);
3591 } else {
3592 movw(rd, Low16Bits(value), cond);
3593 uint16_t value_high = High16Bits(value);
3594 if (value_high != 0) {
3595 movt(rd, value_high, cond);
3596 }
3597 }
3598}
3599
Vladimir Markoebdbf4b2016-07-07 15:37:02 +01003600void Thumb2Assembler::LoadDImmediate(DRegister dd, double value, Condition cond) {
3601 if (!vmovd(dd, value, cond)) {
3602 uint64_t int_value = bit_cast<uint64_t, double>(value);
3603 if (int_value == bit_cast<uint64_t, double>(0.0)) {
3604 // 0.0 is quite common, so we special case it by loading
3605 // 2.0 in `dd` and then subtracting it.
3606 bool success = vmovd(dd, 2.0, cond);
3607 CHECK(success);
3608 vsubd(dd, dd, dd, cond);
3609 } else {
3610 Literal* literal = literal64_dedupe_map_.GetOrCreate(
3611 int_value,
3612 [this, int_value]() { return NewLiteral<uint64_t>(int_value); });
3613 LoadLiteral(dd, literal);
3614 }
3615 }
3616}
3617
Vladimir Marko6fd0ffe2015-11-19 21:13:52 +00003618int32_t Thumb2Assembler::GetAllowedLoadOffsetBits(LoadOperandType type) {
3619 switch (type) {
3620 case kLoadSignedByte:
3621 case kLoadSignedHalfword:
3622 case kLoadUnsignedHalfword:
3623 case kLoadUnsignedByte:
3624 case kLoadWord:
3625 // We can encode imm12 offset.
3626 return 0xfffu;
3627 case kLoadSWord:
3628 case kLoadDWord:
3629 case kLoadWordPair:
3630 // We can encode imm8:'00' offset.
3631 return 0xff << 2;
3632 default:
3633 LOG(FATAL) << "UNREACHABLE";
3634 UNREACHABLE();
3635 }
3636}
3637
3638int32_t Thumb2Assembler::GetAllowedStoreOffsetBits(StoreOperandType type) {
3639 switch (type) {
3640 case kStoreHalfword:
3641 case kStoreByte:
3642 case kStoreWord:
3643 // We can encode imm12 offset.
3644 return 0xfff;
3645 case kStoreSWord:
3646 case kStoreDWord:
3647 case kStoreWordPair:
3648 // We can encode imm8:'00' offset.
3649 return 0xff << 2;
3650 default:
3651 LOG(FATAL) << "UNREACHABLE";
3652 UNREACHABLE();
3653 }
3654}
3655
3656bool Thumb2Assembler::CanSplitLoadStoreOffset(int32_t allowed_offset_bits,
3657 int32_t offset,
3658 /*out*/ int32_t* add_to_base,
3659 /*out*/ int32_t* offset_for_load_store) {
3660 int32_t other_bits = offset & ~allowed_offset_bits;
3661 if (ShifterOperandCanAlwaysHold(other_bits) || ShifterOperandCanAlwaysHold(-other_bits)) {
3662 *add_to_base = offset & ~allowed_offset_bits;
3663 *offset_for_load_store = offset & allowed_offset_bits;
3664 return true;
3665 }
3666 return false;
3667}
3668
3669int32_t Thumb2Assembler::AdjustLoadStoreOffset(int32_t allowed_offset_bits,
3670 Register temp,
3671 Register base,
3672 int32_t offset,
3673 Condition cond) {
3674 DCHECK_NE(offset & ~allowed_offset_bits, 0);
3675 int32_t add_to_base, offset_for_load;
3676 if (CanSplitLoadStoreOffset(allowed_offset_bits, offset, &add_to_base, &offset_for_load)) {
3677 AddConstant(temp, base, add_to_base, cond, kCcKeep);
3678 return offset_for_load;
3679 } else {
3680 LoadImmediate(temp, offset, cond);
3681 add(temp, temp, ShifterOperand(base), cond, kCcKeep);
3682 return 0;
3683 }
3684}
Nicolas Geoffray3bcc8ea2014-11-28 15:00:02 +00003685
Dave Allison65fcc2c2014-04-28 13:45:27 -07003686// Implementation note: this method must emit at most one instruction when
3687// Address::CanHoldLoadOffsetThumb.
3688void Thumb2Assembler::LoadFromOffset(LoadOperandType type,
3689 Register reg,
3690 Register base,
3691 int32_t offset,
3692 Condition cond) {
3693 if (!Address::CanHoldLoadOffsetThumb(type, offset)) {
Roland Levillain775ef492014-11-04 17:43:11 +00003694 CHECK_NE(base, IP);
Vladimir Marko6fd0ffe2015-11-19 21:13:52 +00003695 // Inlined AdjustLoadStoreOffset() allows us to pull a few more tricks.
3696 int32_t allowed_offset_bits = GetAllowedLoadOffsetBits(type);
3697 DCHECK_NE(offset & ~allowed_offset_bits, 0);
3698 int32_t add_to_base, offset_for_load;
3699 if (CanSplitLoadStoreOffset(allowed_offset_bits, offset, &add_to_base, &offset_for_load)) {
3700 // Use reg for the adjusted base. If it's low reg, we may end up using 16-bit load.
3701 AddConstant(reg, base, add_to_base, cond, kCcKeep);
3702 base = reg;
3703 offset = offset_for_load;
3704 } else {
3705 Register temp = (reg == base) ? IP : reg;
3706 LoadImmediate(temp, offset, cond);
3707 // TODO: Implement indexed load (not available for LDRD) and use it here to avoid the ADD.
3708 // Use reg for the adjusted base. If it's low reg, we may end up using 16-bit load.
3709 add(reg, reg, ShifterOperand((reg == base) ? IP : base), cond, kCcKeep);
3710 base = reg;
3711 offset = 0;
3712 }
Dave Allison65fcc2c2014-04-28 13:45:27 -07003713 }
Vladimir Marko6fd0ffe2015-11-19 21:13:52 +00003714 DCHECK(Address::CanHoldLoadOffsetThumb(type, offset));
Dave Allison65fcc2c2014-04-28 13:45:27 -07003715 switch (type) {
3716 case kLoadSignedByte:
3717 ldrsb(reg, Address(base, offset), cond);
3718 break;
3719 case kLoadUnsignedByte:
3720 ldrb(reg, Address(base, offset), cond);
3721 break;
3722 case kLoadSignedHalfword:
3723 ldrsh(reg, Address(base, offset), cond);
3724 break;
3725 case kLoadUnsignedHalfword:
3726 ldrh(reg, Address(base, offset), cond);
3727 break;
3728 case kLoadWord:
3729 ldr(reg, Address(base, offset), cond);
3730 break;
3731 case kLoadWordPair:
3732 ldrd(reg, Address(base, offset), cond);
3733 break;
3734 default:
3735 LOG(FATAL) << "UNREACHABLE";
Ian Rogers2c4257b2014-10-24 14:20:06 -07003736 UNREACHABLE();
Dave Allison65fcc2c2014-04-28 13:45:27 -07003737 }
3738}
3739
Dave Allison65fcc2c2014-04-28 13:45:27 -07003740// Implementation note: this method must emit at most one instruction when
3741// Address::CanHoldLoadOffsetThumb, as expected by JIT::GuardedLoadFromOffset.
3742void Thumb2Assembler::LoadSFromOffset(SRegister reg,
3743 Register base,
3744 int32_t offset,
3745 Condition cond) {
3746 if (!Address::CanHoldLoadOffsetThumb(kLoadSWord, offset)) {
3747 CHECK_NE(base, IP);
Vladimir Marko6fd0ffe2015-11-19 21:13:52 +00003748 offset = AdjustLoadStoreOffset(GetAllowedLoadOffsetBits(kLoadSWord), IP, base, offset, cond);
Dave Allison65fcc2c2014-04-28 13:45:27 -07003749 base = IP;
Dave Allison65fcc2c2014-04-28 13:45:27 -07003750 }
Vladimir Marko6fd0ffe2015-11-19 21:13:52 +00003751 DCHECK(Address::CanHoldLoadOffsetThumb(kLoadSWord, offset));
Dave Allison65fcc2c2014-04-28 13:45:27 -07003752 vldrs(reg, Address(base, offset), cond);
3753}
3754
3755
3756// Implementation note: this method must emit at most one instruction when
3757// Address::CanHoldLoadOffsetThumb, as expected by JIT::GuardedLoadFromOffset.
3758void Thumb2Assembler::LoadDFromOffset(DRegister reg,
3759 Register base,
3760 int32_t offset,
3761 Condition cond) {
3762 if (!Address::CanHoldLoadOffsetThumb(kLoadDWord, offset)) {
3763 CHECK_NE(base, IP);
Vladimir Marko6fd0ffe2015-11-19 21:13:52 +00003764 offset = AdjustLoadStoreOffset(GetAllowedLoadOffsetBits(kLoadDWord), IP, base, offset, cond);
Dave Allison65fcc2c2014-04-28 13:45:27 -07003765 base = IP;
Dave Allison65fcc2c2014-04-28 13:45:27 -07003766 }
Vladimir Marko6fd0ffe2015-11-19 21:13:52 +00003767 DCHECK(Address::CanHoldLoadOffsetThumb(kLoadDWord, offset));
Dave Allison65fcc2c2014-04-28 13:45:27 -07003768 vldrd(reg, Address(base, offset), cond);
3769}
3770
3771
3772// Implementation note: this method must emit at most one instruction when
3773// Address::CanHoldStoreOffsetThumb.
3774void Thumb2Assembler::StoreToOffset(StoreOperandType type,
3775 Register reg,
3776 Register base,
3777 int32_t offset,
3778 Condition cond) {
Roland Levillain775ef492014-11-04 17:43:11 +00003779 Register tmp_reg = kNoRegister;
Dave Allison65fcc2c2014-04-28 13:45:27 -07003780 if (!Address::CanHoldStoreOffsetThumb(type, offset)) {
Roland Levillain775ef492014-11-04 17:43:11 +00003781 CHECK_NE(base, IP);
Roland Levillain23f02f32015-08-25 18:23:20 +01003782 if ((reg != IP) &&
3783 ((type != kStoreWordPair) || (reg + 1 != IP))) {
Roland Levillain775ef492014-11-04 17:43:11 +00003784 tmp_reg = IP;
3785 } else {
Roland Levillain4af147e2015-04-07 13:54:49 +01003786 // Be careful not to use IP twice (for `reg` (or `reg` + 1 in
Roland Levillain23f02f32015-08-25 18:23:20 +01003787 // the case of a word-pair store) and `base`) to build the
3788 // Address object used by the store instruction(s) below.
3789 // Instead, save R5 on the stack (or R6 if R5 is already used by
3790 // `base`), use it as secondary temporary register, and restore
3791 // it after the store instruction has been emitted.
3792 tmp_reg = (base != R5) ? R5 : R6;
Roland Levillain775ef492014-11-04 17:43:11 +00003793 Push(tmp_reg);
3794 if (base == SP) {
3795 offset += kRegisterSize;
3796 }
3797 }
Vladimir Marko6fd0ffe2015-11-19 21:13:52 +00003798 // TODO: Implement indexed store (not available for STRD), inline AdjustLoadStoreOffset()
3799 // and in the "unsplittable" path get rid of the "add" by using the store indexed instead.
3800 offset = AdjustLoadStoreOffset(GetAllowedStoreOffsetBits(type), tmp_reg, base, offset, cond);
Roland Levillain775ef492014-11-04 17:43:11 +00003801 base = tmp_reg;
Dave Allison65fcc2c2014-04-28 13:45:27 -07003802 }
Vladimir Marko6fd0ffe2015-11-19 21:13:52 +00003803 DCHECK(Address::CanHoldStoreOffsetThumb(type, offset));
Dave Allison65fcc2c2014-04-28 13:45:27 -07003804 switch (type) {
3805 case kStoreByte:
3806 strb(reg, Address(base, offset), cond);
3807 break;
3808 case kStoreHalfword:
3809 strh(reg, Address(base, offset), cond);
3810 break;
3811 case kStoreWord:
3812 str(reg, Address(base, offset), cond);
3813 break;
3814 case kStoreWordPair:
3815 strd(reg, Address(base, offset), cond);
3816 break;
3817 default:
3818 LOG(FATAL) << "UNREACHABLE";
Ian Rogers2c4257b2014-10-24 14:20:06 -07003819 UNREACHABLE();
Dave Allison65fcc2c2014-04-28 13:45:27 -07003820 }
Roland Levillain23f02f32015-08-25 18:23:20 +01003821 if ((tmp_reg != kNoRegister) && (tmp_reg != IP)) {
3822 CHECK((tmp_reg == R5) || (tmp_reg == R6));
Roland Levillain775ef492014-11-04 17:43:11 +00003823 Pop(tmp_reg);
3824 }
Dave Allison65fcc2c2014-04-28 13:45:27 -07003825}
3826
3827
3828// Implementation note: this method must emit at most one instruction when
3829// Address::CanHoldStoreOffsetThumb, as expected by JIT::GuardedStoreToOffset.
3830void Thumb2Assembler::StoreSToOffset(SRegister reg,
3831 Register base,
3832 int32_t offset,
3833 Condition cond) {
3834 if (!Address::CanHoldStoreOffsetThumb(kStoreSWord, offset)) {
3835 CHECK_NE(base, IP);
Vladimir Marko6fd0ffe2015-11-19 21:13:52 +00003836 offset = AdjustLoadStoreOffset(GetAllowedStoreOffsetBits(kStoreSWord), IP, base, offset, cond);
Dave Allison65fcc2c2014-04-28 13:45:27 -07003837 base = IP;
Dave Allison65fcc2c2014-04-28 13:45:27 -07003838 }
Vladimir Marko6fd0ffe2015-11-19 21:13:52 +00003839 DCHECK(Address::CanHoldStoreOffsetThumb(kStoreSWord, offset));
Dave Allison65fcc2c2014-04-28 13:45:27 -07003840 vstrs(reg, Address(base, offset), cond);
3841}
3842
3843
3844// Implementation note: this method must emit at most one instruction when
3845// Address::CanHoldStoreOffsetThumb, as expected by JIT::GuardedStoreSToOffset.
3846void Thumb2Assembler::StoreDToOffset(DRegister reg,
3847 Register base,
3848 int32_t offset,
3849 Condition cond) {
3850 if (!Address::CanHoldStoreOffsetThumb(kStoreDWord, offset)) {
3851 CHECK_NE(base, IP);
Vladimir Marko6fd0ffe2015-11-19 21:13:52 +00003852 offset = AdjustLoadStoreOffset(GetAllowedStoreOffsetBits(kStoreDWord), IP, base, offset, cond);
Dave Allison65fcc2c2014-04-28 13:45:27 -07003853 base = IP;
Dave Allison65fcc2c2014-04-28 13:45:27 -07003854 }
Vladimir Marko6fd0ffe2015-11-19 21:13:52 +00003855 DCHECK(Address::CanHoldStoreOffsetThumb(kStoreDWord, offset));
Dave Allison65fcc2c2014-04-28 13:45:27 -07003856 vstrd(reg, Address(base, offset), cond);
3857}
3858
3859
3860void Thumb2Assembler::MemoryBarrier(ManagedRegister mscratch) {
3861 CHECK_EQ(mscratch.AsArm().AsCoreRegister(), R12);
Nicolas Geoffray19a19cf2014-10-22 16:07:05 +01003862 dmb(SY);
3863}
3864
3865
3866void Thumb2Assembler::dmb(DmbOptions flavor) {
Nicolas Geoffray19a19cf2014-10-22 16:07:05 +01003867 int32_t encoding = 0xf3bf8f50; // dmb in T1 encoding.
3868 Emit32(encoding | flavor);
Dave Allison65fcc2c2014-04-28 13:45:27 -07003869}
3870
3871
3872void Thumb2Assembler::CompareAndBranchIfZero(Register r, Label* label) {
Nicolas Geoffray2bcb4312015-07-01 12:22:56 +01003873 if (CanRelocateBranches() && IsLowRegister(r) && !label->IsBound()) {
Nicolas Geoffrayd56376c2015-05-21 12:32:34 +00003874 cbz(r, label);
3875 } else {
3876 cmp(r, ShifterOperand(0));
3877 b(label, EQ);
3878 }
3879}
3880
3881
Dave Allison65fcc2c2014-04-28 13:45:27 -07003882void Thumb2Assembler::CompareAndBranchIfNonZero(Register r, Label* label) {
Nicolas Geoffray2bcb4312015-07-01 12:22:56 +01003883 if (CanRelocateBranches() && IsLowRegister(r) && !label->IsBound()) {
Nicolas Geoffrayd126ba12015-05-20 11:25:27 +01003884 cbnz(r, label);
3885 } else {
Nicolas Geoffray1a43dd72014-07-17 15:15:34 +01003886 cmp(r, ShifterOperand(0));
3887 b(label, NE);
Nicolas Geoffray1a43dd72014-07-17 15:15:34 +01003888 }
Dave Allison65fcc2c2014-04-28 13:45:27 -07003889}
Andreas Gampe7cffc3b2015-10-19 21:31:53 -07003890
3891JumpTable* Thumb2Assembler::CreateJumpTable(std::vector<Label*>&& labels, Register base_reg) {
3892 jump_tables_.emplace_back(std::move(labels));
3893 JumpTable* table = &jump_tables_.back();
3894 DCHECK(!table->GetLabel()->IsBound());
3895
3896 bool use32bit = IsForced32Bit() || IsHighRegister(base_reg);
3897 uint32_t location = buffer_.Size();
3898 Fixup::Size size = use32bit ? Fixup::kLiteralAddr4KiB : Fixup::kLiteralAddr1KiB;
3899 FixupId fixup_id = AddFixup(Fixup::LoadLiteralAddress(location, base_reg, size));
3900 Emit16(static_cast<uint16_t>(table->GetLabel()->position_));
3901 table->GetLabel()->LinkTo(fixup_id);
3902 if (use32bit) {
3903 Emit16(0);
3904 }
3905 DCHECK_EQ(location + GetFixup(fixup_id)->GetSizeInBytes(), buffer_.Size());
3906
3907 return table;
3908}
3909
3910void Thumb2Assembler::EmitJumpTableDispatch(JumpTable* jump_table, Register displacement_reg) {
3911 CHECK(!IsForced32Bit()) << "Forced 32-bit dispatch not implemented yet";
3912 // 32-bit ADD doesn't support PC as an input, so we need a two-instruction sequence:
3913 // SUB ip, ip, #0
3914 // ADD pc, ip, reg
3915 // TODO: Implement.
3916
3917 // The anchor's position needs to be fixed up before we can compute offsets - so make it a tracked
3918 // label.
3919 BindTrackedLabel(jump_table->GetAnchorLabel());
3920
3921 add(PC, PC, ShifterOperand(displacement_reg));
3922}
3923
Dave Allison65fcc2c2014-04-28 13:45:27 -07003924} // namespace arm
3925} // namespace art