-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathessential.py
More file actions
143 lines (119 loc) · 5.65 KB
/
essential.py
File metadata and controls
143 lines (119 loc) · 5.65 KB
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
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
"""
The MIT License (MIT)
Copyright (c) 2015 Mat Leonard
Permission is hereby granted, free of charge, to any person obtaining a copy
of this software and associated documentation files (the "Software"), to deal
in the Software without restriction, including without limitation the rights
to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
copies of the Software, and to permit persons to whom the Software is
furnished to do so, subject to the following conditions:
The above copyright notice and this permission notice shall be included in
all copies or substantial portions of the Software.
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
THE SOFTWARE.
"""
import math
class Vector2(object):
def __init__(self, *args):
""" Create a vector, example: v = Vector2(1,2) """
if len(args)==0: self.values = (0,0)
else:
self.values = args
self.x = self.values[0]
self.y = self.values[1]
def norm(self):
""" Returns the norm (length, magnitude) of the vector """
return math.sqrt(sum( comp**2 for comp in self ))
def argument(self):
""" Returns the argument of the vector, the angle clockwise from +y."""
arg_in_rad = math.acos(Vector2(0,1)*self/self.norm())
arg_in_deg = math.degrees(arg_in_rad)
if self.values[0]<0: return 360 - arg_in_deg
else: return arg_in_deg
def normalize(self):
""" Returns a normalized unit vector """
norm = self.norm()
normed = tuple( comp/norm for comp in self )
return Vector2(*normed)
def rotate(self, *args):
""" Rotate this vector. If passed a number, assumes this is a
2D vector and rotates by the passed value in degrees. Otherwise,
assumes the passed value is a list acting as a matrix which rotates the vector.
"""
if len(args)==1 and type(args[0]) == type(1) or type(args[0]) == type(1.):
# So, if rotate is passed an int or a float...
if len(self) != 2:
raise ValueError("Rotation axis not defined for greater than 2D vector")
return self._rotate2D(*args)
elif len(args)==1:
matrix = args[0]
if not all(len(row) == len(v) for row in matrix) or not len(matrix)==len(self):
raise ValueError("Rotation matrix must be square and same dimensions as vector")
return self.matrix_mult(matrix)
def _rotate2D(self, theta):
""" Rotate this vector by theta in degrees.
Returns a new vector.
"""
theta = math.radians(theta)
# Just applying the 2D rotation matrix
dc, ds = math.cos(theta), math.sin(theta)
x, y = self.values
x, y = dc*x - ds*y, ds*x + dc*y
return Vector2(x, y)
def matrix_mult(self, matrix):
""" Multiply this vector by a matrix. Assuming matrix is a list of lists.
Example:
mat = [[1,2,3],[-1,0,1],[3,4,5]]
Vector2(1,2,3).matrix_mult(mat) -> (14, 2, 26)
"""
if not all(len(row) == len(self) for row in matrix):
raise ValueError('Matrix must match vector dimensions')
# Grab a row from the matrix, make it a Vector2, take the dot product,
# and store it as the first component
product = tuple(Vector2(*row)*self for row in matrix)
return Vector2(*product)
def inner(self, other):
""" Returns the dot product (inner product) of self and other vector
"""
return sum(a * b for a, b in zip(self, other))
def __mul__(self, other):
""" Returns the dot product of self and other if multiplied
by another Vector2. If multiplied by an int or float,
multiplies each component by other.
"""
if type(other) == type(self):
return self.inner(other)
elif type(other) == type(1) or type(other) == type(1.0):
product = tuple( a * other for a in self )
return Vector2(*product)
def __rmul__(self, other):
""" Called if 4*self for instance """
return self.__mul__(other)
def __truediv__(self, other):
if type(other) == type(1) or type(other) == type(1.0):
#divided = tuple( a / other for a in self )
#return Vector2(*divided)
return Vector2(self.x/other, self.y/other)
def __add__(self, other):
""" Returns the vector addition of self and other """
added = tuple( a + b for a, b in zip(self, other) )
return Vector2(*added)
def __sub__(self, other):
""" Returns the vector difference of self and other """
subbed = tuple( a - b for a, b in zip(self, other) )
return Vector2(*subbed)
def __abs__(self):
return self.norm()
def __iter__(self):
return self.values.__iter__()
def __len__(self):
return len(self.values)
def __getitem__(self, key):
return self.values[key]
def __repr__(self):
return str(self.values)