Initial revision
[lsystem3d.git] / lsystem3d / src / vector.cpp
CommitLineData
e5247a3b 1// Copyright (C) 2006 Erik Dahlberg
2//
3// This file is part of LSystem3d.
4//
5// LSystem3D is free software; you can redistribute it and/or
6// modify it under the terms of the GNU General Public License
7// as published by the Free Software Foundation; either version 2
8// of the License, or (at your option) any later version.
9//
10// LSystem3D is distributed in the hope that it will be useful,
11// but WITHOUT ANY WARRANTY; without even the implied warranty of
12// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13// GNU General Public License for more details.
14//
15// You should have received a copy of the GNU General Public License
16// along with LSystem3D; if not, write to the Free Software
17// Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
18
19
20
21
22#include <cmath>
23
24#include "vector.h"
25
26
27
28/**
29 * Constructor
30 * @param x the x-coordinate
31 * @param y the y-coordinate
32 * @param z the z-coordinate
33 */
34Vector::Vector(double x, double y, double z)
35{
36 setXYZ(x, y, z);
37}
38
39
40
41/**
42 * Destructor
43 */
44Vector::~Vector()
45{
46}
47
48
49
50/**
51 * Rotate around another vector
52 * @param angle rotation angle
53 * @param vector arbitrary vector to rotate around
54 */
55void Vector::rotate(double angle, Vector vector)
56{
57 double c = cos(angle);
58 double s = sin(angle);
59
60 double x =
61 _x * (vector._x * vector._x * (1.0 - c) + c) +
62 _y * (vector._x * vector._y * (1.0 - c) + vector._z * s) +
63 _z * (vector._x * vector._z * (1.0 - c) - vector._y * s);
64
65 double y =
66 _x * (vector._y * vector._x * (1.0 - c) - vector._z * s) +
67 _y * (vector._y * vector._y * (1.0 - c) + c) +
68 _z * (vector._y * vector._z * (1.0 - c) + vector._x * s);
69
70 double z =
71 _x * (vector._z * vector._x * (1.0 - c) + vector._y * s) +
72 _y * (vector._z * vector._y * (1.0 - c) - vector._x * s) +
73 _z * (vector._z * vector._z * (1.0 - c) + c);
74
75 _x = x;
76 _y = y;
77 _z = z;
78
79 // TODO: call it from outside?
80 normalize();
81}
82
83
84
85/**
86 * Normalize vector
87 */
88void Vector::normalize()
89{
90 double length = sqrt(_x * _x + _y * _y + _z * _z);
91
92 if (length != 0)
93 {
94 _x /= length;
95 _y /= length;
96 _z /= length;
97 }
98}
99
100
101
102/**
103 * Get scalar product of the vectors
104 * @param vector arbitrary vector
105 * @return the scalar product
106 */
107double Vector::getScalarProduct(Vector vector)
108{
109 double scalarProduct = getX() * vector.getX() +
110 getY() * vector.getY() +
111 getZ() * vector.getZ();
112
113 return scalarProduct;
114}
115
116
117
118/**
119 * Get cross product of the vectors
120 * @param vector arbitrary vector
121 * @return the cross product
122 */
123Vector Vector::getCrossProduct(Vector vector)
124{
125 Vector crossProduct(getY() * vector.getZ() - getZ() * vector.getY(),
126 getZ() * vector.getX() - getX() * vector.getZ(),
127 getX() * vector.getY() - getY() * vector.getX());
128
129 return crossProduct;
130}
131
132
133
134/**
135 * Get angle between the vectors
136 * @param vector the second (normalized) vector
137 * @return the angle, in degrees
138 */
139double Vector::getAngle(Vector vector)
140{
141 double scalarProduct = getScalarProduct(vector);
142 double angle = (acos(scalarProduct) / (M_PIl * 2.0)) * 360.0;
143
144 return angle;
145}