2 files changed, 49 insertions, 0 deletions
diff --git a/src/setjmp/x86_64/longjmp.s b/src/setjmp/x86_64/longjmp.s
new file mode 100644
index 00000000..c63b0c95
--- /dev/null
+++ b/src/setjmp/x86_64/longjmp.s
@@ -0,0 +1,24 @@
+/* Copyright 2011 Nicholas J. Kain, licensed GNU LGPL 2.1 or later */
+.global _longjmp
+.global longjmp
+.type _longjmp,%function
+.type longjmp,%function
+_longjmp:
+longjmp:
+	mov %rsi,%rax           /* val will be longjmp return */
+	test %rax,%rax
+	jnz .L0
+	inc %rax                /* if val==0, val=1 per longjmp semantics */
+.L0:
+	movq (%rdi),%rbx        /* rdi is the jmp_buf, restore regs from it */
+	movq 8(%rdi),%rbp
+	movq 16(%rdi),%r12
+	movq 24(%rdi),%r13
+	movq 32(%rdi),%r14
+	movq 40(%rdi),%r15
+	movq 48(%rdi),%rdx      /* this ends up being the stack pointer */
+	mov %rdx,%rsp
+	movq 56(%rdi),%rdx      /* this is the instruction pointer */
+	jmp *%rdx               /* goto saved address without altering rsp */
+.size _longjmp,.-_longjmp
+.size longjmp,.-longjmp
diff --git a/src/setjmp/x86_64/setjmp.s b/src/setjmp/x86_64/setjmp.s
new file mode 100644
index 00000000..8f29fa81
--- /dev/null
+++ b/src/setjmp/x86_64/setjmp.s
@@ -0,0 +1,25 @@
+/* Copyright 2011 Nicholas J. Kain, licensed GNU LGPL 2.1 or later */
+.global __setjmp
+.global _setjmp
+.global setjmp
+.type __setjmp,%function
+.type _setjmp,%function
+.type setjmp,%function
+__setjmp:
+_setjmp:
+setjmp:
+	mov %rbx,(%rdi)         /* rdi is jmp_buf, move registers onto it */
+	mov %rbp,8(%rdi)
+	mov %r12,16(%rdi)
+	mov %r13,24(%rdi)
+	mov %r14,32(%rdi)
+	mov %r15,40(%rdi)
+	leaq 8(%rsp),%rdx       /* this is our rsp WITHOUT current ret addr */
+	mov %rdx,48(%rdi)
+	movq (%rsp),%rdx        /* save return addr ptr for new rip */
+	mov %rdx,56(%rdi)
+	xor %rax,%rax           /* always return 0 */
+	ret
+.size __setjmp,.-__setjmp
+.size _setjmp,.-_setjmp
+.size setjmp,.-setjmp