asmx64.c 24.1 KB
Newer Older
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
/*
 * This file is part of the Micro Python project, http://micropython.org/
 *
 * The MIT License (MIT)
 *
 * Copyright (c) 2013, 2014 Damien P. George
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 */

Markus Siemens's avatar
Markus Siemens committed
27
#include <stdint.h>
Damien's avatar
Damien committed
28
29
30
31
#include <stdio.h>
#include <assert.h>
#include <string.h>

32
#include "py/mpconfig.h"
33
34
35

// wrapper around everything in this file
#if MICROPY_EMIT_X64
Damien's avatar
Damien committed
36

37
#include "py/asmx64.h"
38

Damien's avatar
Damien committed
39
40
41
42
/* all offsets are measured in multiples of 8 bytes */
#define WORD_SIZE                (8)

#define OPCODE_NOP               (0x90)
43
#define OPCODE_PUSH_R64          (0x50) /* +rq */
Damien's avatar
Damien committed
44
45
#define OPCODE_PUSH_I64          (0x68)
#define OPCODE_PUSH_M64          (0xff) /* /6 */
46
#define OPCODE_POP_R64           (0x58) /* +rq */
Damien's avatar
Damien committed
47
48
#define OPCODE_RET               (0xc3)
#define OPCODE_MOV_I8_TO_R8      (0xb0) /* +rb */
49
#define OPCODE_MOV_I64_TO_R64    (0xb8) /* +rq */
Damien's avatar
Damien committed
50
#define OPCODE_MOV_I32_TO_RM32   (0xc7)
51
#define OPCODE_MOV_R8_TO_RM8     (0x88) /* /r */
52
#define OPCODE_MOV_R64_TO_RM64   (0x89) /* /r */
53
54
55
#define OPCODE_MOV_RM64_TO_R64   (0x8b) /* /r */
#define OPCODE_MOVZX_RM8_TO_R64  (0xb6) /* 0x0f 0xb6/r */
#define OPCODE_MOVZX_RM16_TO_R64 (0xb7) /* 0x0f 0xb7/r */
Damien's avatar
Damien committed
56
#define OPCODE_LEA_MEM_TO_R64    (0x8d) /* /r */
57
58
#define OPCODE_AND_R64_TO_RM64   (0x21) /* /r */
#define OPCODE_OR_R64_TO_RM64    (0x09) /* /r */
Damien's avatar
Damien committed
59
#define OPCODE_XOR_R64_TO_RM64   (0x31) /* /r */
60
#define OPCODE_ADD_R64_TO_RM64   (0x01) /* /r */
Damien's avatar
Damien committed
61
62
63
64
65
#define OPCODE_ADD_I32_TO_RM32   (0x81) /* /0 */
#define OPCODE_ADD_I8_TO_RM32    (0x83) /* /0 */
#define OPCODE_SUB_R64_FROM_RM64 (0x29)
#define OPCODE_SUB_I32_FROM_RM64 (0x81) /* /5 */
#define OPCODE_SUB_I8_FROM_RM64  (0x83) /* /5 */
66
67
68
69
70
71
72
73
74
//#define OPCODE_SHL_RM32_BY_I8    (0xc1) /* /4 */
//#define OPCODE_SHR_RM32_BY_I8    (0xc1) /* /5 */
//#define OPCODE_SAR_RM32_BY_I8    (0xc1) /* /7 */
#define OPCODE_SHL_RM64_CL       (0xd3) /* /4 */
#define OPCODE_SAR_RM64_CL       (0xd3) /* /7 */
//#define OPCODE_CMP_I32_WITH_RM32 (0x81) /* /7 */
//#define OPCODE_CMP_I8_WITH_RM32  (0x83) /* /7 */
#define OPCODE_CMP_R64_WITH_RM64 (0x39) /* /r */
//#define OPCODE_CMP_RM32_WITH_R32 (0x3b)
Damien's avatar
Damien committed
75
76
77
78
79
80
81
82
83
84
85
86
#define OPCODE_TEST_R8_WITH_RM8  (0x84) /* /r */
#define OPCODE_JMP_REL8          (0xeb)
#define OPCODE_JMP_REL32         (0xe9)
#define OPCODE_JCC_REL8          (0x70) /* | jcc type */
#define OPCODE_JCC_REL32_A       (0x0f)
#define OPCODE_JCC_REL32_B       (0x80) /* | jcc type */
#define OPCODE_SETCC_RM8_A       (0x0f)
#define OPCODE_SETCC_RM8_B       (0x90) /* | jcc type, /0 */
#define OPCODE_CALL_REL32        (0xe8)
#define OPCODE_CALL_RM32         (0xff) /* /2 */
#define OPCODE_LEAVE             (0xc9)

87
#define MODRM_R64(x)    (((x) & 0x7) << 3)
Damien's avatar
Damien committed
88
89
90
91
#define MODRM_RM_DISP0  (0x00)
#define MODRM_RM_DISP8  (0x40)
#define MODRM_RM_DISP32 (0x80)
#define MODRM_RM_REG    (0xc0)
92
#define MODRM_RM_R64(x) ((x) & 0x7)
Damien's avatar
Damien committed
93

94
95
#define OP_SIZE_PREFIX (0x66)

Damien's avatar
Damien committed
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
#define REX_PREFIX  (0x40)
#define REX_W       (0x08)  // width
#define REX_R       (0x04)  // register
#define REX_X       (0x02)  // index
#define REX_B       (0x01)  // base

#define IMM32_L0(x) ((x) & 0xff)
#define IMM32_L1(x) (((x) >> 8) & 0xff)
#define IMM32_L2(x) (((x) >> 16) & 0xff)
#define IMM32_L3(x) (((x) >> 24) & 0xff)
#define IMM64_L4(x) (((x) >> 32) & 0xff)
#define IMM64_L5(x) (((x) >> 40) & 0xff)
#define IMM64_L6(x) (((x) >> 48) & 0xff)
#define IMM64_L7(x) (((x) >> 56) & 0xff)

#define UNSIGNED_FIT8(x) (((x) & 0xffffffffffffff00) == 0)
#define UNSIGNED_FIT32(x) (((x) & 0xffffffff00000000) == 0)
#define SIGNED_FIT8(x) (((x) & 0xffffff80) == 0) || (((x) & 0xffffff80) == 0xffffff80)

struct _asm_x64_t {
116
    uint pass;
117
118
    mp_uint_t code_offset;
    mp_uint_t code_size;
Damien's avatar
Damien committed
119
120
121
    byte *code_base;
    byte dummy_data[8];

122
123
    mp_uint_t max_num_labels;
    mp_uint_t *label_offsets;
124
    int num_locals;
Damien's avatar
Damien committed
125
126
};

127
asm_x64_t *asm_x64_new(mp_uint_t max_num_labels) {
128
    asm_x64_t *as;
Damien's avatar
Damien committed
129

130
    as = m_new0(asm_x64_t, 1);
131
    as->max_num_labels = max_num_labels;
132
    as->label_offsets = m_new(mp_uint_t, max_num_labels);
Damien's avatar
Damien committed
133
134
135
136

    return as;
}

137
void asm_x64_free(asm_x64_t *as, bool free_code) {
Damien's avatar
Damien committed
138
    if (free_code) {
139
        MP_PLAT_FREE_EXEC(as->code_base, as->code_size);
Damien's avatar
Damien committed
140
    }
141
    m_del(mp_uint_t, as->label_offsets, as->max_num_labels);
142
    m_del_obj(asm_x64_t, as);
Damien's avatar
Damien committed
143
144
}

145
146
void asm_x64_start_pass(asm_x64_t *as, uint pass) {
    if (pass == ASM_X64_PASS_COMPUTE) {
147
        // reset all labels
148
        memset(as->label_offsets, -1, as->max_num_labels * sizeof(mp_uint_t));
149
150
151
    } if (pass == ASM_X64_PASS_EMIT) {
        MP_PLAT_ALLOC_EXEC(as->code_offset, (void**)&as->code_base, &as->code_size);
        if (as->code_base == NULL) {
152
153
            assert(0);
        }
154
        //printf("code_size: %u\n", as->code_size);
Damien's avatar
Damien committed
155
    }
156
157
158
    as->pass = pass;
    as->code_offset = 0;
}
Damien's avatar
Damien committed
159

160
161
void asm_x64_end_pass(asm_x64_t *as) {
    // could check labels are resolved...
162
    (void)as;
Damien's avatar
Damien committed
163
164
165
}

// all functions must go through this one to emit bytes
166
STATIC byte *asm_x64_get_cur_to_write_bytes(asm_x64_t *as, int num_bytes_to_write) {
Damien's avatar
Damien committed
167
    //printf("emit %d\n", num_bytes_to_write);
168
    if (as->pass < ASM_X64_PASS_EMIT) {
Damien's avatar
Damien committed
169
170
171
172
173
174
175
176
177
178
        as->code_offset += num_bytes_to_write;
        return as->dummy_data;
    } else {
        assert(as->code_offset + num_bytes_to_write <= as->code_size);
        byte *c = as->code_base + as->code_offset;
        as->code_offset += num_bytes_to_write;
        return c;
    }
}

179
180
181
182
mp_uint_t asm_x64_get_code_pos(asm_x64_t *as) {
    return as->code_offset;
}

183
mp_uint_t asm_x64_get_code_size(asm_x64_t *as) {
Damien's avatar
Damien committed
184
185
186
    return as->code_size;
}

187
void *asm_x64_get_code(asm_x64_t *as) {
Damien's avatar
Damien committed
188
189
190
    return as->code_base;
}

191
STATIC void asm_x64_write_byte_1(asm_x64_t *as, byte b1) {
Damien's avatar
Damien committed
192
193
194
195
    byte* c = asm_x64_get_cur_to_write_bytes(as, 1);
    c[0] = b1;
}

196
STATIC void asm_x64_write_byte_2(asm_x64_t *as, byte b1, byte b2) {
Damien's avatar
Damien committed
197
198
199
200
201
    byte* c = asm_x64_get_cur_to_write_bytes(as, 2);
    c[0] = b1;
    c[1] = b2;
}

202
STATIC void asm_x64_write_byte_3(asm_x64_t *as, byte b1, byte b2, byte b3) {
Damien's avatar
Damien committed
203
204
205
206
207
208
    byte* c = asm_x64_get_cur_to_write_bytes(as, 3);
    c[0] = b1;
    c[1] = b2;
    c[2] = b3;
}

209
STATIC void asm_x64_write_word32(asm_x64_t *as, int w32) {
Damien's avatar
Damien committed
210
211
212
213
214
215
216
    byte* c = asm_x64_get_cur_to_write_bytes(as, 4);
    c[0] = IMM32_L0(w32);
    c[1] = IMM32_L1(w32);
    c[2] = IMM32_L2(w32);
    c[3] = IMM32_L3(w32);
}

217
STATIC void asm_x64_write_word64(asm_x64_t *as, int64_t w64) {
Damien's avatar
Damien committed
218
219
220
221
222
223
224
225
226
227
228
    byte* c = asm_x64_get_cur_to_write_bytes(as, 8);
    c[0] = IMM32_L0(w64);
    c[1] = IMM32_L1(w64);
    c[2] = IMM32_L2(w64);
    c[3] = IMM32_L3(w64);
    c[4] = IMM64_L4(w64);
    c[5] = IMM64_L5(w64);
    c[6] = IMM64_L6(w64);
    c[7] = IMM64_L7(w64);
}

229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
// align must be a multiple of 2
void asm_x64_align(asm_x64_t* as, mp_uint_t align) {
    // TODO fill unused data with NOPs?
    as->code_offset = (as->code_offset + align - 1) & (~(align - 1));
}

void asm_x64_data(asm_x64_t* as, mp_uint_t bytesize, mp_uint_t val) {
    byte *c = asm_x64_get_cur_to_write_bytes(as, bytesize);
    // machine is little endian
    for (uint i = 0; i < bytesize; i++) {
        *c++ = val;
        val >>= 8;
    }
}

Damien's avatar
Damien committed
244
/* unused
245
STATIC void asm_x64_write_word32_to(asm_x64_t *as, int offset, int w32) {
Damien's avatar
Damien committed
246
247
248
249
250
251
252
253
254
255
    byte* c;
    assert(offset + 4 <= as->code_size);
    c = as->code_base + offset;
    c[0] = IMM32_L0(w32);
    c[1] = IMM32_L1(w32);
    c[2] = IMM32_L2(w32);
    c[3] = IMM32_L3(w32);
}
*/

256
STATIC void asm_x64_write_r64_disp(asm_x64_t *as, int r64, int disp_r64, int disp_offset) {
257
    assert(disp_r64 != ASM_X64_REG_RSP);
Damien's avatar
Damien committed
258

259
260
261
262
263
264
265
    if (disp_r64 == ASM_X64_REG_R12) {
        // special case for r12; not fully implemented
        assert(SIGNED_FIT8(disp_offset));
        asm_x64_write_byte_3(as, MODRM_R64(r64) | MODRM_RM_DISP8 | MODRM_RM_R64(disp_r64), 0x24, IMM32_L0(disp_offset));
        return;
    }

266
    if (disp_offset == 0 && disp_r64 != ASM_X64_REG_RBP) {
Damien's avatar
Damien committed
267
268
269
270
271
272
273
274
275
        asm_x64_write_byte_1(as, MODRM_R64(r64) | MODRM_RM_DISP0 | MODRM_RM_R64(disp_r64));
    } else if (SIGNED_FIT8(disp_offset)) {
        asm_x64_write_byte_2(as, MODRM_R64(r64) | MODRM_RM_DISP8 | MODRM_RM_R64(disp_r64), IMM32_L0(disp_offset));
    } else {
        asm_x64_write_byte_1(as, MODRM_R64(r64) | MODRM_RM_DISP32 | MODRM_RM_R64(disp_r64));
        asm_x64_write_word32(as, disp_offset);
    }
}

276
277
278
279
STATIC void asm_x64_generic_r64_r64(asm_x64_t *as, int dest_r64, int src_r64, int op) {
    asm_x64_write_byte_3(as, REX_PREFIX | REX_W | (src_r64 < 8 ? 0 : REX_R) | (dest_r64 < 8 ? 0 : REX_B), op, MODRM_R64(src_r64) | MODRM_RM_REG | MODRM_RM_R64(dest_r64));
}

280
void asm_x64_nop(asm_x64_t *as) {
Damien's avatar
Damien committed
281
282
283
    asm_x64_write_byte_1(as, OPCODE_NOP);
}

284
void asm_x64_push_r64(asm_x64_t *as, int src_r64) {
285
286
287
288
289
    if (src_r64 < 8) {
        asm_x64_write_byte_1(as, OPCODE_PUSH_R64 | src_r64);
    } else {
        asm_x64_write_byte_2(as, REX_PREFIX | REX_B, OPCODE_PUSH_R64 | (src_r64 & 7));
    }
Damien's avatar
Damien committed
290
291
}

292
/*
293
void asm_x64_push_i32(asm_x64_t *as, int src_i32) {
Damien's avatar
Damien committed
294
295
296
    asm_x64_write_byte_1(as, OPCODE_PUSH_I64);
    asm_x64_write_word32(as, src_i32); // will be sign extended to 64 bits
}
297
*/
Damien's avatar
Damien committed
298

299
/*
300
void asm_x64_push_disp(asm_x64_t *as, int src_r64, int src_offset) {
301
    assert(src_r64 < 8);
Damien's avatar
Damien committed
302
303
304
    asm_x64_write_byte_1(as, OPCODE_PUSH_M64);
    asm_x64_write_r64_disp(as, 6, src_r64, src_offset);
}
305
*/
Damien's avatar
Damien committed
306

307
void asm_x64_pop_r64(asm_x64_t *as, int dest_r64) {
308
309
310
311
312
    if (dest_r64 < 8) {
        asm_x64_write_byte_1(as, OPCODE_POP_R64 | dest_r64);
    } else {
        asm_x64_write_byte_2(as, REX_PREFIX | REX_B, OPCODE_POP_R64 | (dest_r64 & 7));
    }
Damien's avatar
Damien committed
313
314
}

315
STATIC void asm_x64_ret(asm_x64_t *as) {
Damien's avatar
Damien committed
316
317
318
    asm_x64_write_byte_1(as, OPCODE_RET);
}

319
320
void asm_x64_mov_r64_r64(asm_x64_t *as, int dest_r64, int src_r64) {
    asm_x64_generic_r64_r64(as, dest_r64, src_r64, OPCODE_MOV_R64_TO_RM64);
Damien's avatar
Damien committed
321
322
}

323
void asm_x64_mov_r8_to_mem8(asm_x64_t *as, int src_r64, int dest_r64, int dest_disp) {
324
325
326
327
328
329
330
331
332
    assert(dest_r64 < 8);
    if (src_r64 < 8) {
        asm_x64_write_byte_1(as, OPCODE_MOV_R8_TO_RM8);
    } else {
        asm_x64_write_byte_2(as, REX_PREFIX | REX_R, OPCODE_MOV_R8_TO_RM8);
    }
    asm_x64_write_r64_disp(as, src_r64, dest_r64, dest_disp);
}

333
void asm_x64_mov_r16_to_mem16(asm_x64_t *as, int src_r64, int dest_r64, int dest_disp) {
334
    assert(dest_r64 < 8);
335
336
337
338
339
    if (src_r64 < 8) {
        asm_x64_write_byte_2(as, OP_SIZE_PREFIX, OPCODE_MOV_R64_TO_RM64);
    } else {
        asm_x64_write_byte_3(as, OP_SIZE_PREFIX, REX_PREFIX | REX_R, OPCODE_MOV_R64_TO_RM64);
    }
340
341
342
    asm_x64_write_r64_disp(as, src_r64, dest_r64, dest_disp);
}

343
void asm_x64_mov_r64_to_mem64(asm_x64_t *as, int src_r64, int dest_r64, int dest_disp) {
Damien's avatar
Damien committed
344
    // use REX prefix for 64 bit operation
345
    asm_x64_write_byte_2(as, REX_PREFIX | REX_W | (src_r64 < 8 ? 0 : REX_R) | (dest_r64 < 8 ? 0 : REX_B), OPCODE_MOV_R64_TO_RM64);
Damien's avatar
Damien committed
346
347
348
    asm_x64_write_r64_disp(as, src_r64, dest_r64, dest_disp);
}

349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
void asm_x64_mov_mem8_to_r64zx(asm_x64_t *as, int src_r64, int src_disp, int dest_r64) {
    assert(src_r64 < 8);
    if (dest_r64 < 8) {
        asm_x64_write_byte_2(as, 0x0f, OPCODE_MOVZX_RM8_TO_R64);
    } else {
        asm_x64_write_byte_3(as, REX_PREFIX | REX_R, 0x0f, OPCODE_MOVZX_RM8_TO_R64);
    }
    asm_x64_write_r64_disp(as, dest_r64, src_r64, src_disp);
}

void asm_x64_mov_mem16_to_r64zx(asm_x64_t *as, int src_r64, int src_disp, int dest_r64) {
    assert(src_r64 < 8);
    if (dest_r64 < 8) {
        asm_x64_write_byte_2(as, 0x0f, OPCODE_MOVZX_RM16_TO_R64);
    } else {
        asm_x64_write_byte_3(as, REX_PREFIX | REX_R, 0x0f, OPCODE_MOVZX_RM16_TO_R64);
    }
    asm_x64_write_r64_disp(as, dest_r64, src_r64, src_disp);
}

void asm_x64_mov_mem64_to_r64(asm_x64_t *as, int src_r64, int src_disp, int dest_r64) {
Damien's avatar
Damien committed
370
    // use REX prefix for 64 bit operation
371
    asm_x64_write_byte_2(as, REX_PREFIX | REX_W | (dest_r64 < 8 ? 0 : REX_R) | (src_r64 < 8 ? 0 : REX_B), OPCODE_MOV_RM64_TO_R64);
Damien's avatar
Damien committed
372
373
374
    asm_x64_write_r64_disp(as, dest_r64, src_r64, src_disp);
}

375
STATIC void asm_x64_lea_disp_to_r64(asm_x64_t *as, int src_r64, int src_disp, int dest_r64) {
Damien's avatar
Damien committed
376
    // use REX prefix for 64 bit operation
377
378
    assert(src_r64 < 8);
    assert(dest_r64 < 8);
Damien's avatar
Damien committed
379
380
381
382
    asm_x64_write_byte_2(as, REX_PREFIX | REX_W, OPCODE_LEA_MEM_TO_R64);
    asm_x64_write_r64_disp(as, dest_r64, src_r64, src_disp);
}

383
/*
Damien's avatar
Damien committed
384
void asm_x64_mov_i8_to_r8(asm_x64_t *as, int src_i8, int dest_r64) {
385
    assert(dest_r64 < 8);
Damien's avatar
Damien committed
386
387
    asm_x64_write_byte_2(as, OPCODE_MOV_I8_TO_R8 | dest_r64, src_i8);
}
388
*/
Damien's avatar
Damien committed
389

390
STATIC void asm_x64_mov_i32_to_r64(asm_x64_t *as, int src_i32, int dest_r64) {
Damien's avatar
Damien committed
391
    // cpu defaults to i32 to r64, with zero extension
392
393
394
395
396
    if (dest_r64 < 8) {
        asm_x64_write_byte_1(as, OPCODE_MOV_I64_TO_R64 | dest_r64);
    } else {
        asm_x64_write_byte_2(as, REX_PREFIX | REX_B, OPCODE_MOV_I64_TO_R64 | (dest_r64 & 7));
    }
Damien's avatar
Damien committed
397
398
399
    asm_x64_write_word32(as, src_i32);
}

400
void asm_x64_mov_i64_to_r64(asm_x64_t *as, int64_t src_i64, int dest_r64) {
Damien's avatar
Damien committed
401
402
    // cpu defaults to i32 to r64
    // to mov i64 to r64 need to use REX prefix
403
    assert(dest_r64 < 8);
Damien's avatar
Damien committed
404
405
406
407
408
    asm_x64_write_byte_2(as, REX_PREFIX | REX_W, OPCODE_MOV_I64_TO_R64 | dest_r64);
    asm_x64_write_word64(as, src_i64);
}

void asm_x64_mov_i64_to_r64_optimised(asm_x64_t *as, int64_t src_i64, int dest_r64) {
409
    // TODO use movzx, movsx if possible
Damien's avatar
Damien committed
410
411
412
413
414
415
416
417
418
    if (UNSIGNED_FIT32(src_i64)) {
        // 5 bytes
        asm_x64_mov_i32_to_r64(as, src_i64 & 0xffffffff, dest_r64);
    } else {
        // 10 bytes
        asm_x64_mov_i64_to_r64(as, src_i64, dest_r64);
    }
}

419
420
421
422
423
424
425
426
427
// src_i64 is stored as a full word in the code, and aligned to machine-word boundary
void asm_x64_mov_i64_to_r64_aligned(asm_x64_t *as, int64_t src_i64, int dest_r64) {
    // mov instruction uses 2 bytes for the instruction, before the i64
    while (((as->code_offset + 2) & (WORD_SIZE - 1)) != 0) {
        asm_x64_nop(as);
    }
    asm_x64_mov_i64_to_r64(as, src_i64, dest_r64);
}

428
429
430
431
432
433
434
435
void asm_x64_and_r64_r64(asm_x64_t *as, int dest_r64, int src_r64) {
    asm_x64_generic_r64_r64(as, dest_r64, src_r64, OPCODE_AND_R64_TO_RM64);
}

void asm_x64_or_r64_r64(asm_x64_t *as, int dest_r64, int src_r64) {
    asm_x64_generic_r64_r64(as, dest_r64, src_r64, OPCODE_OR_R64_TO_RM64);
}

436
437
void asm_x64_xor_r64_r64(asm_x64_t *as, int dest_r64, int src_r64) {
    asm_x64_generic_r64_r64(as, dest_r64, src_r64, OPCODE_XOR_R64_TO_RM64);
Damien's avatar
Damien committed
438
439
}

440
441
void asm_x64_shl_r64_cl(asm_x64_t* as, int dest_r64) {
    asm_x64_generic_r64_r64(as, dest_r64, 4, OPCODE_SHL_RM64_CL);
Damien's avatar
Damien committed
442
443
}

444
445
void asm_x64_sar_r64_cl(asm_x64_t* as, int dest_r64) {
    asm_x64_generic_r64_r64(as, dest_r64, 7, OPCODE_SAR_RM64_CL);
Damien's avatar
Damien committed
446
447
}

448
449
450
451
452
453
void asm_x64_add_r64_r64(asm_x64_t *as, int dest_r64, int src_r64) {
    asm_x64_generic_r64_r64(as, dest_r64, src_r64, OPCODE_ADD_R64_TO_RM64);
}

void asm_x64_sub_r64_r64(asm_x64_t *as, int dest_r64, int src_r64) {
    asm_x64_generic_r64_r64(as, dest_r64, src_r64, OPCODE_SUB_R64_FROM_RM64);
Damien's avatar
Damien committed
454
455
}

456
/*
457
void asm_x64_sub_i32_from_r32(asm_x64_t *as, int src_i32, int dest_r32) {
Damien's avatar
Damien committed
458
459
460
461
462
463
464
465
466
467
    if (SIGNED_FIT8(src_i32)) {
        // defaults to 32 bit operation
        asm_x64_write_byte_2(as, OPCODE_SUB_I8_FROM_RM64, MODRM_R64(5) | MODRM_RM_REG | MODRM_RM_R64(dest_r32));
        asm_x64_write_byte_1(as, src_i32 & 0xff);
    } else {
        // defaults to 32 bit operation
        asm_x64_write_byte_2(as, OPCODE_SUB_I32_FROM_RM64, MODRM_R64(5) | MODRM_RM_REG | MODRM_RM_R64(dest_r32));
        asm_x64_write_word32(as, src_i32);
    }
}
468
*/
Damien's avatar
Damien committed
469

470
STATIC void asm_x64_sub_r64_i32(asm_x64_t *as, int dest_r64, int src_i32) {
471
    assert(dest_r64 < 8);
Damien's avatar
Damien committed
472
473
474
475
476
477
478
479
480
481
482
    if (SIGNED_FIT8(src_i32)) {
        // use REX prefix for 64 bit operation
        asm_x64_write_byte_3(as, REX_PREFIX | REX_W, OPCODE_SUB_I8_FROM_RM64, MODRM_R64(5) | MODRM_RM_REG | MODRM_RM_R64(dest_r64));
        asm_x64_write_byte_1(as, src_i32 & 0xff);
    } else {
        // use REX prefix for 64 bit operation
        asm_x64_write_byte_3(as, REX_PREFIX | REX_W, OPCODE_SUB_I32_FROM_RM64, MODRM_R64(5) | MODRM_RM_REG | MODRM_RM_R64(dest_r64));
        asm_x64_write_word32(as, src_i32);
    }
}

483
/*
484
void asm_x64_shl_r32_by_imm(asm_x64_t *as, int r32, int imm) {
Damien's avatar
Damien committed
485
486
487
488
    asm_x64_write_byte_2(as, OPCODE_SHL_RM32_BY_I8, MODRM_R64(4) | MODRM_RM_REG | MODRM_RM_R64(r32));
    asm_x64_write_byte_1(as, imm);
}

489
void asm_x64_shr_r32_by_imm(asm_x64_t *as, int r32, int imm) {
Damien's avatar
Damien committed
490
491
492
493
    asm_x64_write_byte_2(as, OPCODE_SHR_RM32_BY_I8, MODRM_R64(5) | MODRM_RM_REG | MODRM_RM_R64(r32));
    asm_x64_write_byte_1(as, imm);
}

494
void asm_x64_sar_r32_by_imm(asm_x64_t *as, int r32, int imm) {
Damien's avatar
Damien committed
495
496
497
    asm_x64_write_byte_2(as, OPCODE_SAR_RM32_BY_I8, MODRM_R64(7) | MODRM_RM_REG | MODRM_RM_R64(r32));
    asm_x64_write_byte_1(as, imm);
}
498
*/
Damien's avatar
Damien committed
499

500
void asm_x64_cmp_r64_with_r64(asm_x64_t *as, int src_r64_a, int src_r64_b) {
501
    asm_x64_generic_r64_r64(as, src_r64_b, src_r64_a, OPCODE_CMP_R64_WITH_RM64);
Damien's avatar
Damien committed
502
503
}

504
/*
505
void asm_x64_cmp_i32_with_r32(asm_x64_t *as, int src_i32, int src_r32) {
Damien's avatar
Damien committed
506
507
508
509
510
511
512
513
    if (SIGNED_FIT8(src_i32)) {
        asm_x64_write_byte_2(as, OPCODE_CMP_I8_WITH_RM32, MODRM_R64(7) | MODRM_RM_REG | MODRM_RM_R64(src_r32));
        asm_x64_write_byte_1(as, src_i32 & 0xff);
    } else {
        asm_x64_write_byte_2(as, OPCODE_CMP_I32_WITH_RM32, MODRM_R64(7) | MODRM_RM_REG | MODRM_RM_R64(src_r32));
        asm_x64_write_word32(as, src_i32);
    }
}
514
*/
Damien's avatar
Damien committed
515

516
void asm_x64_test_r8_with_r8(asm_x64_t *as, int src_r64_a, int src_r64_b) {
Damien's avatar
Damien committed
517
    // TODO implement for other registers
518
519
    assert(src_r64_a == ASM_X64_REG_RAX);
    assert(src_r64_b == ASM_X64_REG_RAX);
Damien's avatar
Damien committed
520
521
522
    asm_x64_write_byte_2(as, OPCODE_TEST_R8_WITH_RM8, MODRM_R64(src_r64_a) | MODRM_RM_REG | MODRM_RM_R64(src_r64_b));
}

523
void asm_x64_setcc_r8(asm_x64_t *as, int jcc_type, int dest_r8) {
524
    assert(dest_r8 < 8);
Damien's avatar
Damien committed
525
526
527
    asm_x64_write_byte_3(as, OPCODE_SETCC_RM8_A, OPCODE_SETCC_RM8_B | jcc_type, MODRM_R64(0) | MODRM_RM_REG | MODRM_RM_R64(dest_r8));
}

528
void asm_x64_label_assign(asm_x64_t *as, mp_uint_t label) {
529
    assert(label < as->max_num_labels);
530
    if (as->pass < ASM_X64_PASS_EMIT) {
531
        // assign label offset
532
        assert(as->label_offsets[label] == (mp_uint_t)-1);
533
        as->label_offsets[label] = as->code_offset;
534
535
    } else {
        // ensure label offset has not changed from PASS_COMPUTE to PASS_EMIT
536
        //printf("l%d: (at %ld=%ld)\n", label, as->label_offsets[label], as->code_offset);
537
        assert(as->label_offsets[label] == as->code_offset);
Damien's avatar
Damien committed
538
539
540
    }
}

541
STATIC mp_uint_t get_label_dest(asm_x64_t *as, mp_uint_t label) {
542
543
544
545
    assert(label < as->max_num_labels);
    return as->label_offsets[label];
}

546
void asm_x64_jmp_label(asm_x64_t *as, mp_uint_t label) {
547
548
    mp_uint_t dest = get_label_dest(as, label);
    mp_int_t rel = dest - as->code_offset;
549
    if (dest != (mp_uint_t)-1 && rel < 0) {
550
551
552
553
554
        // is a backwards jump, so we know the size of the jump on the first pass
        // calculate rel assuming 8 bit relative jump
        rel -= 2;
        if (SIGNED_FIT8(rel)) {
            asm_x64_write_byte_2(as, OPCODE_JMP_REL8, rel & 0xff);
Damien's avatar
Damien committed
555
        } else {
556
557
            rel += 2;
            goto large_jump;
Damien's avatar
Damien committed
558
        }
559
560
561
562
563
564
    } else {
        // is a forwards jump, so need to assume it's large
        large_jump:
        rel -= 5;
        asm_x64_write_byte_1(as, OPCODE_JMP_REL32);
        asm_x64_write_word32(as, rel);
Damien's avatar
Damien committed
565
566
567
    }
}

568
void asm_x64_jcc_label(asm_x64_t *as, int jcc_type, mp_uint_t label) {
569
570
    mp_uint_t dest = get_label_dest(as, label);
    mp_int_t rel = dest - as->code_offset;
571
    if (dest != (mp_uint_t)-1 && rel < 0) {
572
573
574
575
576
        // is a backwards jump, so we know the size of the jump on the first pass
        // calculate rel assuming 8 bit relative jump
        rel -= 2;
        if (SIGNED_FIT8(rel)) {
            asm_x64_write_byte_2(as, OPCODE_JCC_REL8 | jcc_type, rel & 0xff);
Damien's avatar
Damien committed
577
        } else {
578
579
            rel += 2;
            goto large_jump;
Damien's avatar
Damien committed
580
        }
581
582
583
584
585
586
    } else {
        // is a forwards jump, so need to assume it's large
        large_jump:
        rel -= 6;
        asm_x64_write_byte_2(as, OPCODE_JCC_REL32_A, OPCODE_JCC_REL32_B | jcc_type);
        asm_x64_write_word32(as, rel);
Damien's avatar
Damien committed
587
588
589
    }
}

590
void asm_x64_entry(asm_x64_t *as, int num_locals) {
591
    asm_x64_push_r64(as, ASM_X64_REG_RBP);
592
    asm_x64_mov_r64_r64(as, ASM_X64_REG_RBP, ASM_X64_REG_RSP);
Damien's avatar
Damien committed
593
594
595
596
    if (num_locals < 0) {
        num_locals = 0;
    }
    num_locals |= 1; // make it odd so stack is aligned on 16 byte boundary
597
    asm_x64_sub_r64_i32(as, ASM_X64_REG_RSP, num_locals * WORD_SIZE);
598
599
600
    asm_x64_push_r64(as, ASM_X64_REG_RBX);
    asm_x64_push_r64(as, ASM_X64_REG_R12);
    asm_x64_push_r64(as, ASM_X64_REG_R13);
601
    as->num_locals = num_locals;
Damien's avatar
Damien committed
602
603
}

604
void asm_x64_exit(asm_x64_t *as) {
605
606
607
    asm_x64_pop_r64(as, ASM_X64_REG_R13);
    asm_x64_pop_r64(as, ASM_X64_REG_R12);
    asm_x64_pop_r64(as, ASM_X64_REG_RBX);
Damien's avatar
Damien committed
608
609
610
611
    asm_x64_write_byte_1(as, OPCODE_LEAVE);
    asm_x64_ret(as);
}

612
613
614
615
616
// locals:
//  - stored on the stack in ascending order
//  - numbered 0 through as->num_locals-1
//  - RBP points above the last local
//
617
//                          | RBP
618
619
620
621
622
//                          v
//  l0  l1  l2  ...  l(n-1)
//  ^                ^
//  | low address    | high address in RAM
//
623
STATIC int asm_x64_local_offset_from_ebp(asm_x64_t *as, int local_num) {
624
    return (-as->num_locals + local_num) * WORD_SIZE;
Damien's avatar
Damien committed
625
626
}

627
void asm_x64_mov_local_to_r64(asm_x64_t *as, int src_local_num, int dest_r64) {
628
    asm_x64_mov_mem64_to_r64(as, ASM_X64_REG_RBP, asm_x64_local_offset_from_ebp(as, src_local_num), dest_r64);
Damien's avatar
Damien committed
629
630
}

631
void asm_x64_mov_r64_to_local(asm_x64_t *as, int src_r64, int dest_local_num) {
632
    asm_x64_mov_r64_to_mem64(as, src_r64, ASM_X64_REG_RBP, asm_x64_local_offset_from_ebp(as, dest_local_num));
Damien's avatar
Damien committed
633
634
}

635
636
void asm_x64_mov_local_addr_to_r64(asm_x64_t *as, int local_num, int dest_r64) {
    int offset = asm_x64_local_offset_from_ebp(as, local_num);
Damien's avatar
Damien committed
637
    if (offset == 0) {
638
        asm_x64_mov_r64_r64(as, dest_r64, ASM_X64_REG_RBP);
Damien's avatar
Damien committed
639
    } else {
640
        asm_x64_lea_disp_to_r64(as, ASM_X64_REG_RBP, offset, dest_r64);
Damien's avatar
Damien committed
641
642
643
    }
}

644
/*
645
void asm_x64_push_local(asm_x64_t *as, int local_num) {
646
    asm_x64_push_disp(as, ASM_X64_REG_RBP, asm_x64_local_offset_from_ebp(as, local_num));
Damien's avatar
Damien committed
647
648
}

649
void asm_x64_push_local_addr(asm_x64_t *as, int local_num, int temp_r64)
Damien's avatar
Damien committed
650
{
651
    asm_x64_mov_r64_r64(as, temp_r64, ASM_X64_REG_RBP);
652
    asm_x64_add_i32_to_r32(as, asm_x64_local_offset_from_ebp(as, local_num), temp_r64);
Damien's avatar
Damien committed
653
654
    asm_x64_push_r64(as, temp_r64);
}
655
*/
Damien's avatar
Damien committed
656
657
658
659

/*
   can't use these because code might be relocated when resized

660
void asm_x64_call(asm_x64_t *as, void* func)
Damien's avatar
Damien committed
661
{
662
    asm_x64_sub_i32_from_r32(as, 8, ASM_X64_REG_RSP);
Damien's avatar
Damien committed
663
664
    asm_x64_write_byte_1(as, OPCODE_CALL_REL32);
    asm_x64_write_word32(as, func - (void*)(as->code_cur + 4));
665
    asm_x64_mov_r64_r64(as, ASM_X64_REG_RSP, ASM_X64_REG_RBP);
Damien's avatar
Damien committed
666
667
}

668
void asm_x64_call_i1(asm_x64_t *as, void* func, int i1)
Damien's avatar
Damien committed
669
{
670
671
    asm_x64_sub_i32_from_r32(as, 8, ASM_X64_REG_RSP);
    asm_x64_sub_i32_from_r32(as, 12, ASM_X64_REG_RSP);
Damien's avatar
Damien committed
672
673
674
    asm_x64_push_i32(as, i1);
    asm_x64_write_byte_1(as, OPCODE_CALL_REL32);
    asm_x64_write_word32(as, func - (void*)(as->code_cur + 4));
675
    asm_x64_add_i32_to_r32(as, 16, ASM_X64_REG_RSP);
676
    asm_x64_mov_r64_r64(as, ASM_X64_REG_RSP, ASM_X64_REG_RBP);
Damien's avatar
Damien committed
677
678
679
}
*/

680
void asm_x64_call_ind(asm_x64_t *as, void *ptr, int temp_r64) {
681
    assert(temp_r64 < 8);
682
683
684
685
686
687
#ifdef __LP64__
    asm_x64_mov_i64_to_r64_optimised(as, (int64_t)ptr, temp_r64);
#else
    // If we get here, sizeof(int) == sizeof(void*).
    asm_x64_mov_i64_to_r64_optimised(as, (int64_t)(unsigned int)ptr, temp_r64);
#endif
Damien's avatar
Damien committed
688
689
    asm_x64_write_byte_2(as, OPCODE_CALL_RM32, MODRM_R64(2) | MODRM_RM_REG | MODRM_RM_R64(temp_r64));
    // this reduces code size by 2 bytes per call, but doesn't seem to speed it up at all
690
691
    // doesn't work anymore because calls are 64 bits away
    /*
Damien's avatar
Damien committed
692
693
    asm_x64_write_byte_1(as, OPCODE_CALL_REL32);
    asm_x64_write_word32(as, ptr - (void*)(as->code_base + as->code_offset + 4));
694
    */
Damien's avatar
Damien committed
695
}
696
697

#endif // MICROPY_EMIT_X64