def computeCollide(delta, obj1, obj2):
a = obj1.velocity
#b = obj2.velocity
n = a.normalized()
x, y, z = obj1.pos.x, obj1.pos.y, obj1.pos.z
if a.magnitude() > 0: # and obj2.isKinetic: # or b.magnitude > 0:
for tri in obj2.colliderFaces:
#print(obj2.pos.x + "\n")
if math3d.pointInTri(
x + sign(n[0]) * .1, y, z, tri[0][0] + obj2.pos[0],
tri[0][1] + obj2.pos[1], tri[0][2] + obj2.pos[2],
tri[1][0] + obj2.pos[0], tri[1][1] + obj2.pos[1],
tri[1][2] + obj2.pos[2], tri[2][0] + obj2.pos[0],
tri[2][1] + obj2.pos[1], tri[2][2] + obj2.pos[2],
"low_med"):
# set component to 0
obj1.pos[0] += -sign(a.x) * (delta / 10)
a.x = 0
if math3d.pointInTri(
x, y + sign(n[1]) * .2, z, tri[0][0] + obj2.pos[0],
tri[0][1] + obj2.pos[1], tri[0][2] + obj2.pos[2],
tri[1][0] + obj2.pos[0], tri[1][1] + obj2.pos[1],
tri[1][2] + obj2.pos[2], tri[2][0] + obj2.pos[0],
tri[2][1] + obj2.pos[1], tri[2][2] + obj2.pos[2],
"low_med"):
# set component to 0
obj1.pos[1] += -sign(a.y) * (delta / 10)
a.y = 0
obj1.grounded = True
else:
obj1.grounded = False
if math3d.pointInTri(
x, y, z + sign(n[2]) * .1, tri[0][0] + obj2.pos[0],
tri[0][1] + obj2.pos[1], tri[0][2] + obj2.pos[2],
tri[1][0] + obj2.pos[0], tri[1][1] + obj2.pos[1],
tri[1][2] + obj2.pos[2], tri[2][0] + obj2.pos[0],
tri[2][1] + obj2.pos[1], tri[2][2] + obj2.pos[2],
"low_med"):
# set component to 0
obj1.pos[2] += -sign(a.z) * (delta / 10)
a.z = 0
def objectCollide(obj1, obj2):
vector1 = obj1.velocity
vector2 = obj2.velocity
if math3d.normalize(vector1) > 0:
if math3d.pointInTri(x+n[0]/10, y, z,
tri[0][0],tri[0][1],tri[0][2],
tri[1][0],tri[1][1],tri[1][2],
tri[2][0],tri[2][1],tri[2][2],
"low_med"):
def update(self, delta, objects):
if self.isActive:
for o1 in objects:
if o1.isKinetic:
n = math3d.normalize(o1.velocity)
#print(n)
x = o1.pos[0]; y = o1.pos[1]; z = o1.pos[2]
"""
GRAVITY
"""
if o1.useGravity:
o1.velocity[1] += self.gravity*delta
"""
CHECK FOR COLLISIONS, Time will vary
"""
for o2 in objects:
if not o1 is o2:
for face in o2.colliderFaces:
tri = copy.deepcopy(face)
"""
calculate next position from velocity vector
take position, and add velocity/4
to imitate the quarter frame detection in sm640
if math3d.pointInTri()
"""
##
## if math3d.pointInTri(x+n[0]/10, y, z,
## tri[0][0],tri[0][1],tri[0][2],
## tri[1][0],tri[1][1],tri[1][2],
## tri[2][0],tri[2][1],tri[2][2]):
##
if n!=0:
if o1.velocity[0]!=0:
if math3d.pointInTri(x+n[0]/10, y, z,
tri[0][0],tri[0][1],tri[0][2],
tri[1][0],tri[1][1],tri[1][2],
tri[2][0],tri[2][1],tri[2][2],
"low_med"):
o1.velocity[0] = math2d.clamp(o1.velocity[0], 0, -o1.velocity[0])
if o1.velocity[1]!=0:
if math3d.pointInTri(x, y+n[0]/10, z,
tri[0][0],tri[0][1],tri[0][2],
tri[1][0],tri[1][1],tri[1][2],
tri[2][0],tri[2][1],tri[2][2],
"low_med"):
# if velocity is downwards
# when object is collided with,
# then is on a surface; grounded
if n[1] < 0:
o1.grounded = True
#print("grounding")
else:
o1.grounded = False
o1.velocity[1] = math2d.clamp(o1.velocity[1], 0, -o1.velocity[1])
print(math2d.clamp(o1.velocity[1], 0, -o1.velocity[1]))
if o1.velocity[2]!=0:
if math3d.pointInTri(x, y, z+n[0]/10,
tri[0][0],tri[0][1],tri[0][2],
tri[1][0],tri[1][1],tri[1][2],
tri[2][0],tri[2][1],tri[2][2],
"low_med"):
o1.velocity[2] = math2d.clamp(o1.velocity[2], 0, -o1.velocity[2])
"""
FRICTION ON GROUND
might or might not work currently
"""
"""
if o1.grounded:
print("Applying friction")
if isWithin(o1.velocity[0], -.1,.1):
o1.velocity[0] = 0
else:
o1.velocity[0] -= np.sign(o1.velocity[0])*delta
if isWithin(o1.velocity[2], -.1,.1):
o1.velocity[2] = 0
else:
o1.velocity[2] -= np.sign(o1.velocity[2])*delta
"""
"""
MOVE OBJECT BY VELOCITY
"""
if o1.velocity[0]!=0:
o1.pos[0] += .5*(o1.velocity[0])*delta
if o1.velocity[1]!=0:
o1.pos[1] += .5*(o1.velocity[1])*delta
#print(o1.velocity[1])
if o1.velocity[2]!=0:
o1.pos[2] += .5*(o1.velocity[2])*delta
import math3d
"""
print(math3d.pointInTri(
0,0,0,
-1,-1,-1,
-1,-1,1,
1,1,0
)
)
"""
print(math3d.pointInTri(0, .1, 0, -1, 0, -1, -1, 0, 1, 1, 0, 0))
def fixedUpdate(self, delta):
if self.isActive:
for o1 in gl.gameObjects:
if o1.isKinetic:
n = math3d.normalize(o1.velocity)
#print(n)
x = o1.pos[0]
y = o1.pos[1]
z = o1.pos[2]
"""
GRAVITY
"""
if o1.useGravity:
o1.velocity[1] += self.gravity * delta
"""
CHECK FOR COLLISIONS, Time will vary
"""
for o2 in gl.gameObjects:
if o1.name != o2.name:
for face in o2.faces:
tri = copy.deepcopy(face["verts"])
"""
#print(tri)
for v in range(len(tri)):
tri[v][0] += o2.pos[0]
tri[v][1] += o2.pos[1]
tri[v][2] += o2.pos[2]
"""
"""
Lossy Collision detection
loss of precision of area comparison in order to detect apprx. collision
(A pt. will never be exactly in a plane)
"""
#print(n)
if n != 0:
if o1.velocity[0] != 0:
if math3d.pointInTri(
x + n[0] / 10, y, z, tri[0][0],
tri[0][1], tri[0][2],
tri[1][0], tri[1][1],
tri[1][2], tri[2][0],
tri[2][1], tri[2][2]):
o1.velocity[0] = math2d.clamp(
o1.velocity[0], 0,
-o1.velocity[0])
if o1.velocity[1] != 0:
if math3d.pointInTri(
x, y + n[0] / 10, z, tri[0][0],
tri[0][1], tri[0][2],
tri[1][0], tri[1][1],
tri[1][2], tri[2][0],
tri[2][1], tri[2][2]):
# if velocity is downwards
# when object is collided with,
# then is on a surface; grounded
if n[1] < 0:
o1.grounded = True
#print("grounding")
else:
o1.grounded = False
o1.velocity[1] = math2d.clamp(
o1.velocity[1], 0,
-o1.velocity[1])
if o1.velocity[2] != 0:
if math3d.pointInTri(
x, y, z + n[0] / 10, tri[0][0],
tri[0][1], tri[0][2],
tri[1][0], tri[1][1],
tri[1][2], tri[2][0],
tri[2][1], tri[2][2]):
o1.velocity[2] = math2d.clamp(
o1.velocity[2], 0,
-o1.velocity[2])
"""
FRICTION ON GROUND
might or might not work currently
"""
"""
if o1.grounded:
print("Applying friction")
if isWithin(o1.velocity[0], -.1,.1):
o1.velocity[0] = 0
else:
o1.velocity[0] -= np.sign(o1.velocity[0])*delta
if isWithin(o1.velocity[2], -.1,.1):
o1.velocity[2] = 0
else:
o1.velocity[2] -= np.sign(o1.velocity[2])*delta
"""
"""
MOVE OBJECT BY VELOCITY
"""
if o1.velocity[0] != 0:
o1.pos[0] += .5 * (o1.velocity[0]) * delta
if o1.velocity[1] != 0:
#print("move")
o1.pos[1] += .5 * (o1.velocity[1]) * delta
if o1.velocity[2] != 0:
o1.pos[2] += .5 * (o1.velocity[2]) * delta