[692] | 1 | |
---|
| 2 | import math |
---|
| 3 | |
---|
| 4 | class Vector: |
---|
| 5 | |
---|
| 6 | rep = None |
---|
| 7 | |
---|
| 8 | def __init__(self, x, y=None, z=None, w=None): |
---|
| 9 | if y == None: |
---|
| 10 | self.rep = tuple(x) |
---|
| 11 | elif z == None: |
---|
| 12 | self.rep = (x, y) |
---|
| 13 | elif w == None: |
---|
| 14 | self.rep = (x, y, z) |
---|
| 15 | else: |
---|
| 16 | self.rep = (x, y, z, w) |
---|
| 17 | |
---|
| 18 | # math functions |
---|
| 19 | |
---|
| 20 | def __add__(self, other): |
---|
| 21 | return Vector(map(lambda a, b: a + b, self.rep, other.rep)) |
---|
| 22 | |
---|
| 23 | def __sub__(self, other): |
---|
| 24 | return Vector(map(lambda a, b: a - b, self.rep, other.rep)) |
---|
| 25 | |
---|
| 26 | def __mul__(self, value): |
---|
| 27 | return Vector(map(lambda x: x * value, self.rep)) |
---|
| 28 | |
---|
| 29 | def __div__(self, value): |
---|
| 30 | return Vector(map(lambda x: x / value, self.rep)) |
---|
| 31 | |
---|
| 32 | def __abs__(self): |
---|
| 33 | "absolute gives the length" |
---|
| 34 | return math.sqrt(self % self) |
---|
| 35 | |
---|
| 36 | def __neg__(self): |
---|
| 37 | return Vector(map(lambda x: -x, self.rep)) |
---|
| 38 | |
---|
| 39 | def __mod__(self, other): |
---|
| 40 | "dot product" |
---|
| 41 | return self.dot(other) |
---|
| 42 | |
---|
| 43 | def __xor__(self, other): |
---|
| 44 | "3d cross product" |
---|
| 45 | return self.cross(other) |
---|
| 46 | |
---|
| 47 | # coord access functions |
---|
| 48 | |
---|
| 49 | def __len__(self): |
---|
| 50 | return len(self.rep) |
---|
| 51 | |
---|
| 52 | def __getitem__(self, index): |
---|
| 53 | return self.rep[index] |
---|
| 54 | |
---|
| 55 | def __getattr__(self, name): |
---|
| 56 | name_indices = {'x':0, 'y':1, 'z':2, 'w': 3, 'u': 0, 'v': 1} |
---|
| 57 | if not name_indices.has_key(name): raise AttributeError(name) |
---|
| 58 | return self.rep[name_indices[name]] |
---|
| 59 | |
---|
| 60 | # other useful basic functions |
---|
| 61 | |
---|
| 62 | def __eq__(self, other): |
---|
| 63 | return 0 not in map(lambda a, b: a == b, self.rep, other.rep) |
---|
| 64 | |
---|
| 65 | def __ne__(self, other): |
---|
| 66 | return 0 in map(lambda a, b: a == b, self.rep, other.rep) |
---|
| 67 | |
---|
| 68 | def __nonzero__(self): |
---|
| 69 | return max(map(lambda x: abs(x), self.rep)) > 0 |
---|
| 70 | |
---|
| 71 | # string conversion functions |
---|
| 72 | |
---|
| 73 | def __str__(self): |
---|
| 74 | s = ",".join(map(lambda x: "%.3f" % x, self.rep)) |
---|
| 75 | return '(' + s + ')' |
---|
| 76 | |
---|
| 77 | def __repr__(self): |
---|
| 78 | s = ",".join(map(lambda x: "%.3f" % x, self.rep)) |
---|
| 79 | return 'Vector(' + s + ')' |
---|
| 80 | |
---|
| 81 | # other functions |
---|
| 82 | |
---|
| 83 | def dot(self, other): |
---|
| 84 | temp = map(lambda x, y: x * y, self.rep, other.rep) |
---|
| 85 | return reduce(lambda a, b: a + b, temp) |
---|
| 86 | |
---|
| 87 | def cross(self, other): |
---|
| 88 | a1, a2, a3 = self |
---|
| 89 | b1, b2, b3 = other |
---|
| 90 | return Vector(a2*b3 - a3*b2, a3*b1 - a1*b3, a1*b2 - a2*b1) |
---|
| 91 | |
---|
| 92 | def normalize(self): |
---|
| 93 | len = abs(self) |
---|
| 94 | if len < 1e-5: raise ValueError('zero vector') |
---|
| 95 | self.rep = tuple(map(lambda x: x / len, self.rep)) |
---|
| 96 | |
---|
| 97 | def unit(self): |
---|
| 98 | len = abs(self) |
---|
| 99 | if len < 1e-5: raise ValueError('zero vector') |
---|
| 100 | return self / len |
---|
| 101 | |
---|
| 102 | # test |
---|
| 103 | if __name__ == "__main__": |
---|
| 104 | a = Vector(0,3,4) |
---|
| 105 | b = Vector(1,2,5) |
---|
| 106 | |
---|
| 107 | print a, b |
---|
| 108 | print a + b |
---|
| 109 | print abs(a) |
---|
| 110 | print a + Vector(1,0,0) |
---|
| 111 | print a ^ b |
---|
| 112 | x, y, z = a |
---|
| 113 | print x, y, z |
---|
| 114 | |
---|