summaryrefslogtreecommitdiff
path: root/src/turtle-system.lisp
blob: 48f1f91ec236c49b1482de4a7c7f44b009a013c0 (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
;;;; turtle-system.lisp

(in-package #:l-system)

;;;(matrix* translate rotate scale)

(export '(f j + - & ^ q / [ ]))

(defvar coor-sys (identity-matrix))
(defvar stack '())

(defun turtle-system (fn list)
  (iter (for item in list)
	(case (car item)
	  ;;Move forward one unit,adding data to mesh.
	  ((f)
	   (let ((new-coor-sys (mtranslate coor-sys
					   (vec* (vec 0.0 1.0 0.0)
						 (cadr item)))))
	     (appending (funcall fn coor-sys new-coor-sys (cdr item)))
	     (setf coor-sys new-coor-sys)))
	  ;;Move forward one unit,without adding data to mesh.
	  ((j)
	   (setf coor-sys (mtranslate coor-sys
				      (vec* (vec 0.0 1.0 0.0)
					    (cadr item)))))
	  ;;Rotate left on axis z
	  ((+)
	   (setf coor-sys (mrotate
			   (get-axis coor-sys 2)
			   coor-sys
			   (cadr item))))
	  ;;Rotate right on axis z
	  ((-)
	   (setf coor-sys (mrotate
			   (get-axis coor-sys 2)
			   coor-sys
			   (- (cadr item)))))
	  ;;Rotate left on axis y
	  ((&)
	   (setf coor-sys (mrotate
			   (get-axis coor-sys 1)
			   coor-sys
			   (cadr item))))
	  ;;Rotate right on axis y
	  ((^)
	   (setf coor-sys (mrotate
			   (get-axis coor-sys 1)
			   coor-sys
			   (- (cadr item)))))
	  ;;Rotate left on axis x
	  ((q)
	   (setf coor-sys (mrotate
			   (get-axis coor-sys 0)
			   coor-sys
			   (cadr item))))
	  ;;Rotate right on axis x
	  ((/)
	   (setf coor-sys (mrotate
			   (get-axis coor-sys 0)
			   coor-sys
			   (- (cadr item)))))
	  ;;Push the current turtle state onto a stack
	  (([)
	   (push (copy-seq coor-sys)
		 stack))
	  ;;Pop the turtle stack, restoring an earlier state
	  ((])
	   (setf coor-sys (pop stack))))
	(finally (init))))

;;; Turgle utils

(defun init ()
  (setf coor-sys (identity-matrix)
	stack '()))

(defun list-of-vectors->list (list-of-vectors)
  (iterconcat #'(lambda (vec)
		  (concatenate 'list
			       vec))
	      list-of-vectors))

(defun mtranslate (matrix vec)
  (matrix* matrix
	   (translate vec)))

(defun mrotate (axis matrix radians)
  (matrix* matrix
	   (rotate-around axis radians)))

(defun get-axis (matrix column)
  (vec (mref matrix 0 column)
       (mref matrix 1 column)
       (mref matrix 2 column)))

(defun get-vec (matrix)
  (transform-point (vec 0.0 0.0 0.0)
		   matrix))

;;; Test geometry

(defun cube (matrix0 matrix1)
  (let ((x0 (get-axis matrix0 0))
	(y0 (get-axis matrix0 1))
	(z0 (get-axis matrix0 2))
	(pos0 (get-vec matrix0))
	(x1 (get-axis matrix1 0))
	(y1 (get-axis matrix1 1))
	(z1 (get-axis matrix1 2))
	(pos1 (get-vec matrix1)))
    (list
     pos0 pos1 (vec+ pos0 x0)
     (vec+ pos0 x0) (vec+ pos1 x1) pos1
     
     (vec+ pos0 z0) (vec+ pos0 (vec+ x0 z0)) (vec+ pos1 z1)
     (vec+ pos0 (vec+ x0 z0)) (vec+ pos1 z1) (vec+ pos1 (vec+ x1 z1))

     (vec+ pos0 x0) (vec+ pos1 x1) (vec+ pos0 (vec+ x0 z0))
     (vec+ pos0 (vec+ x0 z0)) (vec+ pos1 x1) (vec+ pos1  (vec+ x1 z1))

     pos0 pos1 (vec+ pos0 z0)
     (vec+ pos0 z0) pos1 (vec+ pos1 z1))))