summaryrefslogtreecommitdiff
path: root/src/csky/sysv.S
blob: 962a796f6ca8ad37dd874835d37d9ee6c113a4b7 (plain)
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
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
/* -----------------------------------------------------------------------
   sysv.S

   CSKY Foreign Function Interface

   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.
   ----------------------------------------------------------------------- */

#define LIBFFI_ASM
#include <fficonfig.h>
#include <ffi.h>

.macro	CSKY_FUNC_START name
	.text
	.align 2
	.globl \name
	.type \name, @function
	\name:
.endm

#ifdef __CSKYABIV2__

	/*
	 * a0:   fn
	 * a1:   &ecif
	 * a2:   cif->bytes
	 * a3:   fig->flags
	 * sp+0: ecif.rvalue
	 */
CSKY_FUNC_START ffi_call_SYSV
	/* Save registers */
	.cfi_startproc
	subi	sp, 28
	.cfi_def_cfa_offset 28
	stw	a0, (sp, 0x0)
	.cfi_offset 0, -28
	stw	a1, (sp, 0x4)
	.cfi_offset 1, -24
	stw	a2, (sp, 0x8)
	.cfi_offset 2, -20
	stw	a3, (sp, 0xC)
	.cfi_offset 3, -16
	stw	l0, (sp, 0x10)
	.cfi_offset 4, -12
	stw	l1, (sp, 0x14)
	.cfi_offset 5, -8
	stw	lr, (sp, 0x18)
	.cfi_offset 15, -4

	mov	l0, sp
	.cfi_def_cfa_register 4

	/* Make room for all of the new args. */
	subu	sp, sp, a2

	/* Place all of the ffi_prep_args in position */
	mov	a0, sp
	/*     a1 already set */

	/* Call ffi_prep_args(stack, &ecif) */
	jsri	ffi_prep_args

	/* move first 4 parameters in registers */
	ldw	a0, (sp, 0x0)
	ldw	a1, (sp, 0x4)
	ldw	a2, (sp, 0x8)
	ldw	a3, (sp, 0xC)

	/* and adjust stack */
	subu	lr, l0, sp	/* cif->bytes == l0 - sp */
	cmphsi	lr, 16
	movi	l1, 16
	movt	lr, l1
	addu	sp, sp, lr

	ldw	l1, (l0, 0)	/* load fn() in advance */

	/* call (fn) (...) */
	jsr	l1

	/* Remove the space we pushed for the args */
	mov	sp, l0

	/* Load r2 with the pointer to storage for the return value */
	ldw	a2, (sp, 0x1C)

	/* Load r3 with the return type code */
	ldw	a3, (sp, 0xC)

	/* If the return value pointer is NULL, assume no return value. */
	cmpnei	a2, 0
	bf	.Lepilogue

	cmpnei	a3, FFI_TYPE_STRUCT
	bf	.Lepilogue

	/* return INT64 */
	cmpnei	a3, FFI_TYPE_SINT64
	bt	.Lretint
	/* stw	a0, (a2, 0x0) at .Lretint */
	stw	a1, (a2, 0x4)

.Lretint:
	/* return INT */
	stw	a0, (a2, 0x0)

.Lepilogue:
	ldw	a0, (sp, 0x0)
	ldw	a1, (sp, 0x4)
	ldw	a2, (sp, 0x8)
	ldw	a3, (sp, 0xC)
	ldw	l0, (sp, 0x10)
	ldw	l1, (sp, 0x14)
	ldw	lr, (sp, 0x18)
	addi	sp, sp, 28
	rts
	.cfi_endproc
        .size    ffi_call_SYSV, .-ffi_call_SYSV


	/*
	 * unsigned int FFI_HIDDEN
	 * ffi_closure_SYSV_inner (closure, respp, args)
	 *      ffi_closure *closure;
	 *      void **respp;
	 *      void *args;
	 */
CSKY_FUNC_START ffi_closure_SYSV
	.cfi_startproc
	mov	a2, sp
	addi	a1, sp, 16
	subi	sp, sp, 24
	.cfi_def_cfa_offset 40
	stw	a1, (sp, 0x10)
	.cfi_offset 1, -24
	stw	lr, (sp, 0x14)
	.cfi_offset 15, -20
	stw	sp, (sp, 0x8)
	addi	a1, sp, 8
	jsri	ffi_closure_SYSV_inner
	ldw	a0, (sp, 0x0)
	/*
	 * if FFI_TYPE_SINT64, need a1.
	 * if FFI_TYPE_INT, ignore a1.
	 */
	ldw	a1, (sp, 0x4)

	ldw	lr, (sp, 0x14)
	addi	sp, sp, 40
	rts
	.cfi_endproc
        .size    ffi_closure_SYSV, .-ffi_closure_SYSV

CSKY_FUNC_START ffi_csky_trampoline
	subi	sp, sp, 16
	stw	a0, (sp, 0x0)
	stw	a1, (sp, 0x4)
	stw	a2, (sp, 0x8)
	stw	a3, (sp, 0xC)
	lrw	a0, [.Lctx]
	lrw	a1, [.Lfun]
	jmp	a1
.Lctx:
	mov	a0, a0
	mov	a0, a0
.Lfun:

        .size    ffi_csky_trampoline, .-ffi_csky_trampoline

CSKY_FUNC_START ffi_csky_cacheflush
	mov	t0, r7
	movi	r7, 123
	trap	0
	mov	r7, t0
	rts

        .size    ffi_csky_cacheflush, .-ffi_csky_cacheflush

#else /* !__CSKYABIV2__ */

	/*
	 * a0:   fn
	 * a1:   &ecif
	 * a2:   cif->bytes
	 * a3:   fig->flags
	 * a4:   ecif.rvalue
	 */
CSKY_FUNC_START ffi_call_SYSV
	/* Save registers */
	.cfi_startproc
	subi	sp, 32
	subi	sp, 8
	.cfi_def_cfa_offset 40
	stw	a0, (sp, 0x0)
	.cfi_offset 2, -40
	stw	a1, (sp, 0x4)
	.cfi_offset 3, -36
	stw	a2, (sp, 0x8)
	.cfi_offset 4, -32
	stw	a3, (sp, 0xC)
	.cfi_offset 5, -28
	stw	a4, (sp, 0x10)
	.cfi_offset 6, -24
	stw	a5, (sp, 0x14)
	.cfi_offset 7, -20
	stw	l0, (sp, 0x18)
	.cfi_offset 8, -16
	stw	l1, (sp, 0x1C)
	.cfi_offset 9, -12
	stw	lr, (sp, 0x20)
	.cfi_offset 15, -8

	mov	l0, sp
	.cfi_def_cfa_register 8

	/* Make room for all of the new args. */
	subu	sp, sp, a2

	/* Place all of the ffi_prep_args in position */
	mov	a0, sp
	/*     a1 already set */

	/* Call ffi_prep_args(stack, &ecif) */
	jsri	ffi_prep_args

	/* move first 4 parameters in registers */
	ldw	a0, (sp, 0x0)
	ldw	a1, (sp, 0x4)
	ldw	a2, (sp, 0x8)
	ldw	a3, (sp, 0xC)
	ldw	a4, (sp, 0x10)
	ldw	a5, (sp, 0x14)

	/* and adjust stack */
	mov	lr, l0
	subu	lr, sp		/* cif->bytes == l0 - sp */
	movi	l1, 24
	cmphs	lr, l1
	movt	lr, l1
	addu	sp, sp, lr

	ldw	l1, (l0, 0)	/* load fn() in advance */

	/* call (fn) (...) */
	jsr	l1

	/* Remove the space we pushed for the args */
	mov	sp, l0

	/* Load r2 with the pointer to storage for the return value */
	ldw	a2, (sp, 0x10)

	/* Load r3 with the return type code */
	ldw	a3, (sp, 0xC)

	/* If the return value pointer is NULL, assume no return value. */
	cmpnei	a2, 0
	bf	.Lepilogue

	cmpnei	a3, FFI_TYPE_STRUCT
	bf	.Lepilogue

	/* return INT64 */
	cmpnei	a3, FFI_TYPE_SINT64
	bt	.Lretint
	/* stw	a0, (a2, 0x0) at .Lretint */
	stw	a1, (a2, 0x4)

.Lretint:
	/* return INT */
	stw	a0, (a2, 0x0)

.Lepilogue:
	ldw	a0, (sp, 0x0)
	ldw	a1, (sp, 0x4)
	ldw	a2, (sp, 0x8)
	ldw	a3, (sp, 0xC)
	ldw	a4, (sp, 0x10)
	ldw	a5, (sp, 0x14)
	ldw	l0, (sp, 0x18)
	ldw	l1, (sp, 0x1C)
	ldw	lr, (sp, 0x20)
	addi	sp, sp, 32
	addi	sp, sp, 8
	rts
	.cfi_endproc

        .size    ffi_call_SYSV, .-ffi_call_SYSV


	/*
	 * unsigned int FFI_HIDDEN
	 * ffi_closure_SYSV_inner (closure, respp, args)
	 *      ffi_closure *closure;
	 *      void **respp;
	 *      void *args;
	 */
CSKY_FUNC_START ffi_closure_SYSV
	.cfi_startproc
	mov	a2, sp
	mov	a1, sp
	addi	a1, 24
	subi	sp, sp, 24
	.cfi_def_cfa_offset 48
	stw	a1, (sp, 0x10)
	.cfi_offset 3, -32
	stw	lr, (sp, 0x14)
	.cfi_offset 15, -28
	stw	sp, (sp, 0x8)
	mov	a1, sp
	addi	a1, 8
	jsri	ffi_closure_SYSV_inner
	ldw	a0, (sp, 0x0)
	/*
	 * if FFI_TYPE_SINT64, need a1.
	 * if FFI_TYPE_INT, ignore a1.
	 */
	ldw	a1, (sp, 0x4)

	ldw	lr, (sp, 0x14)
	addi	sp, sp, 24
	addi	sp, sp, 24
	rts
	.cfi_endproc

        .size    ffi_closure_SYSV, .-ffi_closure_SYSV

CSKY_FUNC_START ffi_csky_trampoline
	subi	sp, 24
	stw	a0, (sp, 0x0)
	stw	a1, (sp, 0x4)
	stw	a2, (sp, 0x8)
	stw	a3, (sp, 0xC)
	stw	a4, (sp, 0x10)
	stw	a5, (sp, 0x14)
	lrw	a0, [.Lctx]
	lrw	a1, [.Lfun]
	jmp	a1
.Lctx:
	mov	a0, a0
	mov	a0, a0
.Lfun:

        .size    ffi_csky_trampoline, .-ffi_csky_trampoline

CSKY_FUNC_START ffi_csky_cacheflush
	lrw	r1, 123
	trap	0
	rts

        .size    ffi_csky_cacheflush, .-ffi_csky_cacheflush

#endif /* __CSKYABIV2__ */