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
|
(require :unittest "lib/llib/unittest.l")
(init-unit-test)
(deftest coerse
(assert (equal (coerce #f(-2.4 -1.9 -1.1 -0.9 -0.1 0.1 0.9 1.1 1.9 2.4) integer-vector)
#i(-2 -2 -1 -1 0 0 1 1 2 2)) "cerse"))
(deftest operator
(let* ((n 10)
(a (instantiate float-vector n))
(b (instantiate float-vector n))
(c (instantiate float-vector n)) d)
(dotimes (i n)
(setf (elt a i) (- (random 200) 100))
(setf (elt b i) (- (random 200) 100)))
;;
(dotimes (i n)
(setf (elt c i) (+ (elt a i) (elt b i))))
(assert (equal (v+ a b) c) "v+")
(dotimes (i n)
(setf (elt c i) (- (elt a i) (elt b i))))
(assert (equal (v- a b) c) "v-")
(setq d 0)
(dotimes (i n)
(incf d (* (elt a i) (elt b i))))
(assert (equal (v. a b) d) "v.")
(assert (equal (v* #f(1 2 3) #f(4 5 6)) #f(-3 6 -3)) "v*")
))
(deftest func
(let* ((n 10)
(a (instantiate float-vector n))
(b (instantiate float-vector n))
(c (instantiate float-vector n)) d)
(dotimes (i n)
(setf (elt a i) (- (random 200) 100))
(setf (elt b i) (- (random 200) 100)))
(setq d (elt a 0))
(dotimes (i n)
(setf (elt c i) (* d (elt a i))))
(assert (equal (scale d a) c) "scale")
(setq d 0)
(dotimes (i n)
(incf d (* (elt a i) (elt a i))))
(assert (equal (norm2 a) d) "norm2")
(setq d 0)
(dotimes (i n)
(incf d (* (elt a i) (elt a i))))
(setq d (sqrt d))
(assert (equal (norm a) d) "norm")
(assert (eps= (norm (normalize-vector a)) 1.0) "normalize-vector")
(setq d 0)
(dotimes (i n)
(incf d (* (- (elt a i) (elt b i)) (- (elt a i) (elt b i)))))
(setq d (sqrt d))
(assert (equal (distance a b) d) "distance")
(setq d 0)
(dotimes (i n)
(incf d (* (- (elt a i) (elt b i)) (- (elt a i) (elt b i)))))
(assert (equal (distance2 a b) d) "distance2")
(setq a (instantiate float-vector 4))
(dotimes (i 4)
(setf (elt a i) (- (random 200) 100)))
(setq b (geo::homogenize (geo::homo2normal a)))
(assert (eps= (/ (abs (v. a b)) (* (norm a) (norm b))) 1.0))
(setq a (instantiate float-vector 3))
(dotimes (i 3)
(setf (elt a i) (- (random 200) 100)))
(setq b a)
(dotimes (i 360)
(setq a (rotate-vector a (deg2rad 1) :x)))
(assert (eps-v= a b) "rotate-vector")
(assert (eps-v= (vplus (list a b a b)) (scale 2 (v+ a b))) "vplus")
(assert (eps-v= (vector-mean (list a b b a)) (scale 0.5 (v+ a b))) "vector-mean")
))
(deftest reader
(let (a f i a2 f2 i2)
(setq a #a(1 2 3))
(setq f #f(1 2 3))
(setq i #i(1 2 3))
(setq a2 #2a((0 1)(2 3)))
(setq f2 #2f((0 1)(2 3)))
(setq i2 #2i((0 1)(2 3)))
(setq a (make-array (list 2)))
(setq i (make-array (list 2) :element-type :integer))
(setq f (make-array (list 2) :element-type :float))
(setq a2 (make-array (list 2 2)))
(setq i2 (make-array (list 2 2) :element-type :integer))
(setq f2 (make-array (list 2 2) :element-type :float))
))
(deftest nan-inf-read
(let (v1 v2)
(setq v1 (float-vector (/ 1.0 0.0) (/ -1.0 0.0) (/ 0.0 0.0))) ;; v1 is inf -inf nan
(format *error-output* "v1 = ~A~%" v1)
(dump-structure "/tmp/test-v-dump-structure.l" v1)
(with-open-file (f "/tmp/test-v-dump-structure.l" :direction :input)
(setq v2 (read f)))
(format *error-output* "v2 = ~A~%" v2)
(assert (eq (elt v1 0) (elt v2 0))) ;; v1[0] (= inf) is v2[0] (= inf)
(assert (eq (elt v1 1) (elt v2 1))) ;; v2[1] (= -inf) is v2[1] (= -inf)
(assert (not (= (elt v1 2) (elt v1 2)))) ;; check if v1[2] is nan; this is only the way to compare NaN
(assert (not (= (elt v2 2) (elt v2 2)))) ;; check if v2[2] is nan;
t))
(eval-when (load eval)
(run-all-tests)
(exit))
|
