;;; Copyright 2009 Clozure Associates
;;; This file is part of Clozure CL.  
;;;
;;; Clozure CL is licensed under the terms of the Lisp Lesser GNU
;;; Public License , known as the LLGPL and distributed with Clozure
;;; CL as the file "LICENSE".  The LLGPL consists of a preamble and
;;; the LGPL, which is distributed with Clozure CL as the file "LGPL".
;;; Where these conflict, the preamble takes precedence.
;;;
;;; Clozure CL is referenced in the preamble as the "LIBRARY."
;;;
;;; The LLGPL is also available online at
;;; http://opensource.franz.com/preamble.html

(in-package "CCL")

(defx8632lapfunction %fixnum-signum ((number arg_z))
  (mov ($ '-1) (% temp0))
  (mov ($ '1) (% temp1))
  (test (% number) (% number))
  (cmovs (% temp0) (% arg_z))
  (cmovns (% temp1) (% arg_z))
  (single-value-return))

;;; see %logcount.
(defx86lapfunction %ilogcount ((number arg_z))
  (mark-as-imm temp0)
  (let ((rshift imm0)
        (temp temp0))
    (unbox-fixnum number rshift)
    (xor (% arg_z) (% arg_z))
    (test (% rshift) (% rshift))
    (jmp @test)
    @next
    (lea (@ -1 (% rshift)) (% temp))
    (and (% temp) (% rshift))		;sets flags
    (lea (@ '1 (% arg_z)) (% arg_z))    ;doesn't set flags
    @test
    (jne @next))
  (mark-as-node temp0)
  (single-value-return))

;;; might be able to get away with not marking ecx as imm.
(defx8632lapfunction %iash ((number arg_y) (count arg_z))
  (mark-as-imm ecx)			;aka temp0
  (unbox-fixnum count ecx)
  (test (% count) (% count))
  (jge @left)
  (negb (% cl))
  (unbox-fixnum number imm0)
  (sar (% cl) (% imm0))
  (box-fixnum imm0 arg_z)
  (mark-as-node ecx)
  (single-value-return)
  @left
  (shl (% cl) (% number))
  (movl (% number) (% arg_z))
  (mark-as-node ecx)
  (single-value-return))

(defparameter *double-float-zero* 0.0d0)
(defparameter *short-float-zero* 0.0s0)

(defx8632lapfunction %sfloat-hwords ((sfloat arg_z))
  (movl (% esp) (% temp0))
  (movzwl (@ (+ 2 x8632::misc-data-offset) (% sfloat)) (% imm0))
  (box-fixnum imm0 temp1)
  (pushl (% temp1))			;high
  (movzwl (@ x8632::misc-data-offset (% sfloat)) (% imm0))
  (box-fixnum imm0 temp1)
  (pushl (% temp1))			;low
  (set-nargs 2)
  (jmp-subprim .SPvalues))

(defx8632lapfunction %fixnum-intlen ((number arg_z))
  (mark-as-imm temp0)
  (let ((imm1 temp0))
    (unbox-fixnum arg_z imm0)
    (mov (% imm0) (% imm1))
    (not (% imm1))
    (test (% imm0) (% imm0))
    (cmovs (% imm1) (% imm0))
    (bsrl (% imm0) (% imm0))
    (setne (%b imm1))
    (addb (%b imm1) (%b imm0))
    (box-fixnum imm0 arg_z))
  (mark-as-node temp0)
  (single-value-return))

;;; Caller guarantees that result fits in a fixnum.
(defx8632lapfunction %truncate-double-float->fixnum ((arg arg_z))
  (get-double-float arg fp1)
  (cvttsd2si (% fp1) (% imm0))
  (box-fixnum imm0 arg_z)  
  (single-value-return))

(defx8632lapfunction %truncate-short-float->fixnum ((arg arg_z))
  (get-single-float arg fp1)
  (cvttss2si (% fp1) (% imm0))
  (box-fixnum imm0 arg_z)  
  (single-value-return))

;;; DOES round to even
(defx8632lapfunction %round-nearest-double-float->fixnum ((arg arg_z))
  (get-double-float arg fp1)
  (cvtsd2si (% fp1) (% imm0))
  (box-fixnum imm0 arg_z)  
  (single-value-return))

(defx8632lapfunction %round-nearest-short-float->fixnum ((arg arg_z))
  (get-single-float arg fp1)
  (cvtss2si (% fp1) (% imm0))
  (box-fixnum imm0 arg_z)  
  (single-value-return))



;;; We'll get a SIGFPE if divisor is 0.
(defx8632lapfunction %fixnum-truncate ((dividend arg_y) (divisor arg_z))
  (cmpl ($ '-1) (% divisor))
  (je @neg)
  (mark-as-imm temp0)
  (mark-as-imm temp1)
  (let ((imm2 temp0)
	(imm1 temp1))			;edx
    (unbox-fixnum dividend imm0)
    (unbox-fixnum divisor imm2)
    (cltd)				;edx:eax = sign_extend(eax)
    (idivl (% imm2))
    (box-fixnum imm0 arg_z)		;quotient
    (box-fixnum imm1 arg_y))		;remainder
  (mark-as-node temp0)
  (mark-as-node temp1)
  (movl (% esp) (% temp0))
  (push (% arg_z))
  (push (% arg_y))
  (set-nargs 2)
  (jmp-subprim .SPvalues)
  @neg
  (negl (% dividend))
  (load-constant *least-positive-bignum* arg_z)
  (cmovol (@ x8632::symbol.vcell (% arg_z)) (% dividend))
  (movl (% esp) (% temp0))
  (pushl (% dividend))
  (pushl ($ 0))
  (set-nargs 2)
  (jmp-subprim .SPvalues))

(defx8632lapfunction called-for-mv-p ()
  (movl (@ x8632::lisp-frame.return-address (% ebp)) (% imm0))
  (cmpl (% imm0) (@ (+ (target-nil-value) (x8632::kernel-global ret1valaddr))))
  (movl ($ (target-t-value)) (% imm0))
  (movl ($ (target-nil-value)) (% arg_z))
  (cmove (% imm0) (% arg_z))
  (single-value-return))
	
;;; n1 and n2 must be positive (esp non zero)
(defx86lapfunction %fixnum-gcd ((boxed-u arg_y) (boxed-v arg_z))
  (mark-as-imm temp0)
  (mark-as-imm temp1)
  (let ((u imm0)
	(v temp1)
	(k temp0))			;temp0 = ecx
    (xorl (% k) (% k))
    (bsfl (% boxed-u) (% u))
    (bsfl (% boxed-v) (% v))
    (rcmp (% u) (% v))
    (cmovlel (%l u) (%l k))
    (cmovgl (%l v) (%l k))
    (unbox-fixnum boxed-u u)
    (unbox-fixnum boxed-v v)
    (subb ($ x8632::fixnumshift) (%b k))
    (jz @start)
    (shrl (% cl) (% u))
    (shrl (% cl) (% v))
    @start
    ;; At least one of u or v is odd at this point
    @loop
    ;; if u is even, shift it right one bit
    (testb ($ 1) (%b u))
    (jne @u-odd)
    (shrl ($ 1) (% u))
    (jmp @test)
    @u-odd
    ;; if v is even, shift it right one bit
    (testb ($ 1) (%b v))
    (jne @both-odd)
    (shrl ($ 1) (% v))
    (jmp @test-u)
    @both-odd
    (cmpl (% v) (% u))
    (jb @v>u)
    (subl (% v) (% u))
    (shrl ($ 1) (% u))
    (jmp @test)
    @v>u
    (subl (% u) (% v))
    (shrl ($ 1) (% v))
    @test-u
    (testl (% u) (% u))
    @test
    (ja @loop)
    (shll (% cl) (% v))
    (movb ($ 0) (% cl))
    (box-fixnum v arg_z))
  (mark-as-node temp0)
  (mark-as-node temp1)
  (single-value-return))

(defx8632lapfunction %mrg31k3p ((state arg_z))
  (let ((seed temp0)
	(m1 #x7fffffff)
	(m2 #x7fffadb3)
	(negative-m1 #x80000001)
	(negative-m2 #x8000524d)
	(imm1 temp1))
    (mark-as-imm temp1)
    (svref state 1 seed)
    (movl (@ (+ x8632::misc-data-offset (* 4 1)) (% seed)) (% imm0))
    (andl ($ #x1ff) (% imm0))
    (shll ($ 22) (% imm0))
    (movl (@ (+ x8632::misc-data-offset (* 4 1)) (% seed)) (% imm1))
    (shrl ($ 9) (% imm1))
    (addl (% imm1) (% imm0))

    (movl (@ (+ x8632::misc-data-offset (* 4 2)) (% seed)) (% imm1))
    (andl ($ #xffffff) (% imm1))
    (shll ($ 7) (% imm1))
    (addl (% imm1) (% imm0))
    (movl (@ (+ x8632::misc-data-offset (* 4 2)) (% seed)) (% imm1))
    (shrl ($ 24) (% imm1))

    (addl (% imm1) (% imm0))
    (leal (@ negative-m1 (% imm0)) (% imm1))
    (cmpl ($ m1) (% imm0))
    (cmovael (% imm1) (% imm0))

    (addl (@ (+ x8632::misc-data-offset (* 4 2)) (% seed)) (% imm0))
    (leal (@ negative-m1 (% imm0)) (% imm1))
    (cmpl ($ m1) (% imm0))
    (cmovael (% imm1) (% imm0))

    ;; update state
    (movl (@ (+ x8632::misc-data-offset (* 4 1)) (% seed)) (% imm1))
    (movl (% imm1) (@ (+ x8632::misc-data-offset (* 4 2)) (% seed)))
    (movl (@ (+ x8632::misc-data-offset (* 4 0)) (% seed)) (% imm1))
    (movl (% imm1) (@ (+ x8632::misc-data-offset (* 4 1)) (% seed)))
    (movl (% imm0) (@ (+ x8632::misc-data-offset (* 4 0)) (% seed)))

    ;; second component
    (movzwl (@ (+ x8632::misc-data-offset (* 4 3)) (% seed)) (% imm0))
    ;(andl ($ #xffff) (% imm0))
    (shll ($ 15) (% imm0))
    (movl (@ (+ x8632::misc-data-offset (* 4 3)) (% seed)) (% imm1))
    (shrl ($ 16) (% imm1))
    (imull ($ 21069) (% imm1) (% imm1))

    (addl (% imm1) (% imm0))
    (leal (@ negative-m2 (% imm0)) (% imm1))
    (cmpl ($ m2) (% imm0))
    (cmovael (% imm1) (% imm0))
    (movl (% imm0) (:rcontext x8632::tcr.unboxed0))	;stash t1

    (movzwl (@ (+ x8632::misc-data-offset (* 4 5)) (% seed)) (% imm0))
    ;(andl ($ #xffff) (% imm0))
    (shll ($ 15) (% imm0))
    (movl (@ (+ x8632::misc-data-offset (* 4 5)) (% seed)) (% imm1))
    (shrl ($ 16) (% imm1))
    (imull ($ 21069) (% imm1) (% imm1))

    (addl (% imm1) (% imm0))
    (leal (@ negative-m2 (% imm0)) (% imm1))
    (cmpl ($ m2) (% imm0))
    (cmovael (% imm1) (% imm0))

    (addl (@ (+ x8632::misc-data-offset (* 4 5)) (% seed)) (% imm0))
    (leal (@ negative-m2 (% imm0)) (% imm1))
    (cmpl ($ m2) (% imm0))
    (cmovael (% imm1) (% imm0))

    (addl (:rcontext x8632::tcr.unboxed0) (% imm0))	;add in t1
    (leal (@ negative-m2 (% imm0)) (% imm1))
    (cmpl ($ m2) (% imm0))
    (cmovael (% imm1) (% imm0))

    ;; update state
    (movl (@ (+ x8632::misc-data-offset (* 4 4)) (% seed)) (% imm1))
    (movl (% imm1) (@ (+ x8632::misc-data-offset (* 4 5)) (% seed)))
    (movl (@ (+ x8632::misc-data-offset (* 4 3)) (% seed)) (% imm1))
    (movl (% imm1) (@ (+ x8632::misc-data-offset (* 4 4)) (% seed)))
    (movl (% imm0) (@ (+ x8632::misc-data-offset (* 4 3)) (% seed)))

    ;; combination
    (movl (@ (+ x8632::misc-data-offset (* 4 0)) (% seed)) (% imm1))
    (xchgl (% imm1) (% imm0))		;for sanity
    (rcmpl (% imm0) (% imm1))
    (ja @ok)
    (subl (% imm1) (% imm0))
    (mark-as-node temp1)
    (addl ($ m1) (% imm0))
    (box-fixnum imm0 arg_z)
    (andl ($ #x7fffffff) (% arg_z))
    (single-value-return)
    @ok
    (subl (% imm1) (% imm0))
    (mark-as-node temp1)
    (box-fixnum imm0 arg_z)
    (andl ($ #x7fffffff) (% arg_z))
    (single-value-return)))

(defx8632lapfunction %make-complex-double-float ((r arg_y) (i arg_z))
  (movsd (@ target::misc-dfloat-offset (% r)) (% xmm0))
  (movsd (@ target::misc-dfloat-offset (% i)) (% xmm1))
  (unpcklpd (% xmm1) (% xmm0))
  (movl ($ (logior (ash 5 x8632::num-subtag-bits) x8632::subtag-complex-double-float)) (%l imm0))
  (movd (% imm0) (% mm0))
  (movl ($ (- (* 2 8) x8632::fulltag-misc)) (%l imm0))
  (subl (% imm0) (:rcontext x8632::tcr.save-allocptr))
  (movl (:rcontext x8632::tcr.save-allocptr) (% allocptr))
  (cmpl (:rcontext x8632::tcr.save-allocbase) (% allocptr))
  (ja @no-trap)
  (uuo-alloc)
  @no-trap
  (movd (% mm0) (@ x8632::misc-header-offset (% temp0)))
  (andb ($ (lognot x8632::fulltagmask)) (:rcontext x8632::tcr.save-allocptr))
  (movl (% allocptr) (% arg_z))
  (movdqu (% xmm0) (@ x8632::complex-double-float.realpart (% arg_z)))
  (single-value-return))

(defx8632lapfunction %make-complex-single-float ((r arg_y) (i arg_z))
  (movsd (@ target::misc-data-offset (% r)) (% xmm0))
  (movsd (@ target::misc-data-offset (% i)) (% xmm1))
  (unpcklps (% xmm1) (% xmm0))
  (movl ($ (logior (ash 3 x8632::num-subtag-bits) x8632::subtag-complex-single-float)) (%l imm0))
  (movd (% imm0) (% mm0))
  (movl ($ (- (* 2 8) x8632::fulltag-misc)) (%l imm0))
  (subl (% imm0) (:rcontext x8632::tcr.save-allocptr))
  (movl (:rcontext x8632::tcr.save-allocptr) (% allocptr))
  (cmpl (:rcontext x8632::tcr.save-allocbase) (% allocptr))
  (ja @no-trap)
  (uuo-alloc)
  @no-trap
  (movq (% mm0) (@ x8632::misc-header-offset (% temp0)))
  (andb ($ (lognot x8632::fulltagmask)) (:rcontext x8632::tcr.save-allocptr))
  (movl (% allocptr) (% arg_z))
  (movq (% xmm0) (@ x8632::complex-single-float.realpart (% arg_z)))
  (single-value-return))